OSDN Git Service

[SCHEMATIC] Add symbol: SA612 , NXP's mixer IC.
[openi2cradio/OpenI2CRadio.git] / lcd_acm1602.c
index bf88a52..d33af14 100644 (file)
@@ -1,6 +1,6 @@
 /*
  * OpenI2CRADIO
- * I2C-LCD ACM1602 Handler
+ * I2C/Parallel LCD ACM1602 Handler, variant of ST7066U.
  * Copyright (C) 2013-06-10 K.Ohta <whatisthis.sowhat ai gmail.com>
  * License: GPL2+LE
  *
 #include "lcd_acm1602.h"
 
 #ifdef _USE_I2C_1602
-static void sendcmd(unsigned char addr, unsigned char cmd)
+static unsigned char lcd_busychk(addr)
 {
+    unsigned char b, d;
     i2c_idle();
     OPENASMASTER();
-    i2c_writechar(addr);
+    i2c_writechar(addr | 0x01); // Read
+    i2c_writechar(0x00);
+    d = i2c_readchar();
+    CLOSEASMASTER();
+    _ACM1602_I2C_WAIT(); // 5.5ms
+    if((d & _LCDPORT_BUSYMASK) != 0){
+        d = 0xff; // BUSY
+    } else {
+        d = 0;
+    }
+    return d;
+}
+
+void lcd_waitbusy(unsigned char addr, unsigned char flag)
+{
+    unsigned char f,ff;
+    ff = flag;
+    if(ff != 0) ff = 0xff;
+    do {
+        f = lcd_busychk(addr);
+        _ACM1602_SHORT_WAIT(); // Wait 0.1ms
+    } while(f != ff);
+}
+
+
+static void sendcmd(unsigned char addr, unsigned char cmd, unsigned char busyflag)
+{
+    i2c_idle();
+    OPENASMASTER();
+    i2c_writechar(addr & 0xfe);
     i2c_writechar(0x00);
     i2c_writechar(cmd);
     CLOSEASMASTER();
-    delay1ktcy(1); // 0.1ms
+    _ACM1602_I2C_WAIT(); // 5.5ms
 }
 
-static void delay_lcd(void)
+static void sendonce(unsigned char addr, unsigned char cmd)
 {
-    _ACM1602_LONG_WAIT(); // Wait 0.1ms
+    sendcmd(addr, cmd, 0x00);
 }
 
-static void acm1602_ioinit(addr)
+static void acm1602_ioinit(unsigned char addr)
 {
+    _ACM1602_LONG_LONG_WAIT();
     return;
 }
 
@@ -55,144 +86,477 @@ void acm1602_putchar(unsigned char addr, unsigned char c)
 {
     i2c_idle();
     OPENASMASTER();
-    i2c_writechar(addr);
+    i2c_writechar(addr & 0xfe);
     i2c_writechar(0x80); //Data
     i2c_writechar(c); // Putchar
     CLOSEASMASTER();
-    _ACM1602_SHORT_WAIT(); // Wait 0.1ms
+    _ACM1602_I2C_WAIT(); // Wait 50us
 }
 
+
+unsigned char acm1602_getchar(unsigned char addr)
+{
+    unsigned char d;
+    i2c_idle();
+    OPENASMASTER();
+    i2c_writechar(addr | 0x01); // Read
+    i2c_writechar(0x80);
+    d = i2c_readchar();
+    CLOSEASMASTER();
+    _ACM1602_I2C_WAIT(); // 5.5ms
+    return d;
+}
 #else // Parallel
-/*
- * Default values, You should re-define in iodef.h if you need.
- */
-#ifndef _LCDPORT_DATA
-#define _LCDPORT_DATA PORTD
-#define _LCDPORT_TRIS_DATA TRISD
-#define _LCDPORT_LATCH_DATA LATD
+static void _ACM1602_TC_WAIT(void)
+{
+#ifdef __SDCC
+   delay10tcy(4);
+#else
+   __delay_us(5);
 #endif
+}
 
-#ifndef _LCDPORT_CONT
-#define _LCDPORT_CONT PORTE
-#define _LCDPORT_TRIS_CONT TRISE
-#define _LCDPORT_CONT_RS _PORTE_RE0
-#define _LCDPORT_CONT_RW _PORTE_RE1
-#define _LCDPORT_CONT_EN _PORTE_RE2
-#define _LCDPORT_CONT_LATCH LATE
-#endif
+static unsigned char lcd_busychk(unsigned char addr)
+{
+    unsigned char b, d;
+
+    // Set mask for Tristate.
+    b = _LCDPORT_TRIS_DATA;
+    b |= _LCDPORT_READMASK;// Set mask for Tristate, direction = read.
+    _LCDPORT_TRIS_DATA = b;
+
+//    b = _LCDPORT_CONT_LATCH;
+    _LCDPORT_CONT_RS = 0;
+    _LCDPORT_CONT_RW = 1;
+//    _LCDPORT_CONT_LATCH = b;
+    _ACM1602_TC_WAIT(); // Wait 2.5?us
+
+    _LCDPORT_CONT_EN = 1; // Send CMD
+//    _LCDPORT_CONT_LATCH = b;
+    _ACM1602_TC_WAIT(); // Wait 2.5?us
+
+    d = _LCDPORT_DATA;
+    _ACM1602_TC_WAIT(); // Wait 2.5?us
+
+    _LCDPORT_CONT_EN = 0; // Disable EN
+//    _LCDPORT_CONT_LATCH = b;
+    _ACM1602_TC_WAIT(); // Wait 2.5?us
+
+    _LCDPORT_CONT_EN = 1; // Disable EN
+//    _LCDPORT_CONT_LATCH = b;
+    _ACM1602_TC_WAIT(); // Wait 2.5?us
+
+    _LCDPORT_CONT_EN = 0;; // Disable EN
+//    _LCDPORT_CONT_LATCH = b;
+    _ACM1602_TC_WAIT(); // Wait 2.5?us
+
+    b = _LCDPORT_TRIS_DATA;
+    b &= ~_LCDPORT_READMASK; // Clear mask for Tristate, direction = write.
+    _LCDPORT_TRIS_DATA = b;
+    _ACM1602_TC_WAIT(); // Wait 2.5?us
+
+    if((d & _LCDPORT_BUSYMASK) != 0){
+        d = 0xff; // BUSY
+    } else {
+        d = 0;
+    }
+    return d;
+}
 
-static void delay_lcd(void)
+void lcd_waitbusy(unsigned char addr, unsigned char flag)
 {
-    _ACM1602_LONG_WAIT();
+    unsigned char f,ff;
+    ff = flag;
+    if(ff != 0) ff = 0xff;
+    do {
+        f = lcd_busychk(addr);
+        _ACM1602_SHORT_WAIT(); // Wait 0.1ms
+    } while(f != ff);
 }
 
-static void acm1602_ioinit(unsigned char addr)
+static void sendcmd(unsigned char addr, unsigned char cmd,unsigned char busyflag)
 {
-    unsigned char b;
-    b = _LCDPORT_TRIS_CONT;
-    b &= ~(_LCDPORT_CONT_RS | _LCDPORT_CONT_RW | _LCDPORT_CONT_EN);
-    _LCDPORT_TRIS_CONT = b; // Clear Tristate bits, output.
-    b = _LCDPORT_CONT;
-    b &= ~(_LCDPORT_CONT_RS | _LCDPORT_CONT_RW | _LCDPORT_CONT_EN);
+#ifdef _LCD_IF_4BIT
+    unsigned char b, d;
+    unsigned char h,l;
+
+    h = cmd & 0xf0; // Higher bit is used.
+    l = (cmd & 0x0f) << 4; // Higher bit is used.
+    // Higher NIBBLE
+    if(busyflag != 0) lcd_waitbusy(addr, 0);
+    d = _LCDPORT_TRIS_CONT;
+    d &= ~_LCDPORT_READMASK; // Clear mask for Tristate, direction = write.
+    _LCDPORT_TRIS_CONT = d;
+
+    _LCDPORT_CONT_RW = 0;
+    _LCDPORT_CONT_EN = 0;
+    _LCDPORT_CONT_RS = 0;
+    _LCDPORT_CONT_LATCH &= 0x0f; // Upper
+//    b &= ~(_LCDPORT_CONT_RW | 0xf0 | _LCDPORT_CONT_EN | _LCDPORT_CONT_RS); // DATA=blank,RW='0',RS='0"
+    _LCDPORT_CONT_LATCH |= h;
+//    _LCDPORT_CONT_LATCH = b;
+    _ACM1602_TC_WAIT(); // Wait 2.5?us
+
+    _LCDPORT_CONT_EN = 1;
+    //_LCDPORT_CONT_LATCH = b;
+    _ACM1602_TC_WAIT(); // Wait 2.5?us
+
+    _LCDPORT_CONT_EN = 0; // Disable EN
+//    _LCDPORT_CONT_LATCH = b;
+    _ACM1602_TC_WAIT();
+
+    // Lower NIBBLE
+//    if(busyflag != 0) lcd_waitbusy(addr, 0);
+//    d = _LCDPORT_TRIS_CONT;
+//    d &= ~_LCDPORT_READMASK; // Clear mask for Tristate, direction = write.
+//    _LCDPORT_TRIS_CONT = d;
+
+    _LCDPORT_CONT_RW = 0;
+    _LCDPORT_CONT_EN = 0;
+    _LCDPORT_CONT_RS = 0;
+    _LCDPORT_CONT_LATCH &= 0x0f; // Lower
+
+    _LCDPORT_CONT_LATCH |= l;
+    _ACM1602_TC_WAIT(); // Wait 2.5?us
+    _LCDPORT_CONT_EN = 1;
+//    _LCDPORT_CONT_LATCH = b;
+
+    _ACM1602_TC_WAIT(); // Wait 2.5?us
+    _LCDPORT_CONT_EN = 0; // Disable EN
+//    _LCDPORT_CONT_LATCH = b;
+
+//    d = _LCDPORT_TRIS_CONT;
+ //   d &= ~_LCDPORT_READMASK; // Clear mask for Tristate, direction = write.
+  //  _LCDPORT_TRIS_CONT = d;
+
+#else
+    unsigned char b,d;
+
+    if(busyflag != 0) lcd_waitbusy(addr, 0);
+    d = _LCDPORT_TRIS_DATA;
+    d &= ~_LCDPORT_READMASK; // Clear mask for Tristate, direction = write.
+    _LCDPORT_TRIS_DATA = d;
+
+    b = _LCDPORT_CONT_LATCH;
+    b &= ~(_LCDPORT_CONT_RS | _LCDPORT_CONT_RW | _LCDPORT_CONT_EN); // RS='0',RW='0'
     _LCDPORT_CONT_LATCH = b;
-    _LCDPORT_TRIS_DATA = 0x00; // OUT
-    _LCDPORT_LATCH_DATA = 0x00;
+
+    _LCDPORT_LATCH_DATA = cmd;
+
+    b |= _LCDPORT_CONT_EN; // Send CMD
+    _LCDPORT_CONT_LATCH = b;
+    _ACM1602_TC_WAIT(); // Wait 2.5?us
+
+    b &= ~_LCDPORT_CONT_EN; // Disable EN
+    _LCDPORT_CONT_LATCH = b;
+
+    d = _LCDPORT_TRIS_DATA;
+    d &= ~_LCDPORT_READMASK; // Clear mask for Tristate, direction = write.
+    _LCDPORT_TRIS_DATA = d;
+
+#endif
+    // End of Command.
+    _ACM1602_SHORT_WAIT(); // Wait 50us
 }
 
-static void sendcmd(unsigned char addr, unsigned char cmd)
+static void sendonce(unsigned char addr, unsigned char cmd)
 {
-    unsigned char b;
-    b = _LCDPORT_CONT;
-    b &= ~(_LCDPORT_CONT_RS | _LCDPORT_CONT_RW); // RS='0',RW='0'
+#ifdef _LCD_IF_4BIT
+    unsigned char b, d;
+    unsigned char h;
+
+    h = cmd & 0xf0; // Higher bit is used.
+    // Higher NIBBLE
+    //d = _LCDPORT_TRIS_CONT;
+//    d = TRIS_D_VAL; // Clear mask for Tristate, direction = write.
+//    _LCDPORT_TRIS_CONT = d;
+    d = _LCDPORT_TRIS_CONT;
+    d &= ~_LCDPORT_READMASK; // Clear mask for Tristate, direction = write.
+    _LCDPORT_TRIS_CONT = d;
+
+    _LCDPORT_CONT_RS = 0;
+    _LCDPORT_CONT_RW = 0;
+    _LCDPORT_CONT_EN = 0; // RS='0',RW='0'
+    _LCDPORT_CONT_LATCH &= 0x0f;
+    _LCDPORT_CONT_LATCH |= h;
+    _ACM1602_TC_WAIT(); // Wait 2.5?us
+
+    _LCDPORT_CONT_EN = 1; // Send CMD
+    _ACM1602_TC_WAIT(); // Wait 2.5?us
+
+    _LCDPORT_CONT_EN = 0; // Disable EN
+    _ACM1602_TC_WAIT();
+
+//    d = _LCDPORT_TRIS_CONT;
+//    d &= ~_LCDPORT_READMASK; // Clear mask for Tristate, direction = write.
+//    _LCDPORT_TRIS_CONT = d;
+
+#else
+    unsigned char b, d;
+
+    d = _LCDPORT_TRIS_DATA;
+    d &= ~_LCDPORT_READMASK; // Clear mask for Tristate, direction = write.
+    _LCDPORT_TRIS_DATA = d;
+
+    b = _LCDPORT_CONT_LATCH;
+    b &= ~(_LCDPORT_CONT_RS | _LCDPORT_CONT_RW | _LCDPORT_CONT_EN); // RS='0',RW='0'
     _LCDPORT_CONT_LATCH = b;
+
     _LCDPORT_LATCH_DATA = cmd;
+
     b |= _LCDPORT_CONT_EN; // Send CMD
     _LCDPORT_CONT_LATCH = b;
     _ACM1602_TC_WAIT(); // Wait 2.5?us
+
     b &= ~_LCDPORT_CONT_EN; // Disable EN
     _LCDPORT_CONT_LATCH = b;
-    // End of Command.
+//    _ACM1602_TC_WAIT();
+#endif
+    _ACM1602_SHORT_WAIT(); // Wait 50us
 }
 
-void acm1602_putchar(unsigned char addr, unsigned char c)
+static void acm1602_ioinit(unsigned char addr)
 {
     unsigned char b;
-    b = _LCDPORT_CONT;
+
+//    lcd_waitbusy(0);
+    _ACM1602_LONG_LONG_WAIT();
+#ifdef _LCD_IF_4BIT
+    _LCDPORT_TRIS_CONT = TRIS_D_VAL;
+
+    _LCDPORT_CONT_RS = 0;
+    _LCDPORT_CONT_RW = 0;
+    _LCDPORT_CONT_EN = 0;
+    _LCDPORT_CONT_LATCH &= ~0xf0;
+//    _LCDPORT_CONT_LATCH = b;
+  //  _LCDPORT_TRIS_DATA = 0x00; // OUT
+  //  _LCDPORT_LATCH_DATA = 0x00;
+#else
+    b = _LCDPORT_TRIS_CONT;
+    b &= ~(_LCDPORT_CONT_RS | _LCDPORT_CONT_RW | _LCDPORT_CONT_EN);
+    _LCDPORT_TRIS_CONT = b; // Clear Tristate bits, output.
+    b = _LCDPORT_CONT_LATCH;
+    b &= ~(_LCDPORT_CONT_RS | _LCDPORT_CONT_RW | _LCDPORT_CONT_EN);
+    _LCDPORT_CONT_LATCH = b;
+    _LCDPORT_TRIS_DATA = 0x00; // OUT
+    _LCDPORT_LATCH_DATA = 0x00;
+#endif
+}
+
+
+void acm1602_putchar(unsigned char addr, unsigned char c)
+{
+    unsigned char b, d;
+#ifdef _LCD_IF_4BIT
+    unsigned char h, l;
+    h = c & 0xf0;
+    l = (c & 0x0f)<<4;
+
+    lcd_waitbusy(addr, 0);
+//    d = _LCDPORT_TRIS_CONT;
+//    d &= 0x00; // Clear mask for Tristate, direction = write.
+    d = TRIS_D_VAL; // ALL OUT
+    _LCDPORT_TRIS_CONT = d;
+    _ACM1602_TC_WAIT(); // Wait 2.5?us
+
+    // Send high nibble
+    //b = _LCDPORT_CONT_LATCH;
+    _LCDPORT_CONT_RW = 0;
+    _LCDPORT_CONT_EN = 0; // DATA=blank,RW='0'
+    _LCDPORT_CONT_LATCH &= ~0xf0;
+    _LCDPORT_CONT_RS = 1; // RS='1"
+//    _LCDPORT_CONT_LATCH = b;
+    _ACM1602_TC_WAIT(); // Wait 2.5?us
+
+    _LCDPORT_CONT_EN = 1; // Do high write.
+//    b |= h;
+    _LCDPORT_CONT_LATCH |= h;
+    _ACM1602_TC_WAIT(); // Wait 2.5?us
+
+    _LCDPORT_CONT_EN = 0; // Disable EN
+//    _LCDPORT_CONT_LATCH = b;
+    _ACM1602_SHORT_WAIT();
+
+//    lcd_waitbusy(addr, 0);
+    _LCDPORT_CONT_LATCH &= ~0xf0;
+    _LCDPORT_CONT_RS = 1; // RS='1"
+    _ACM1602_TC_WAIT(); // Wait 2.5?us
+
+    _LCDPORT_CONT_LATCH |= l; // Do low write.
+    _LCDPORT_CONT_EN = 1;
+    _ACM1602_TC_WAIT(); // Wait 2.5?us
+
+    _LCDPORT_CONT_EN = 0; // Disable EN
+    _ACM1602_SHORT_WAIT();
+
+
+#else
+    lcd_waitbusy(addr, 0);
+    d = _LCDPORT_TRIS_DATA;
+    d &= ~_LCDPORT_READMASK; // Clear mask for Tristate, direction = write.
+    _LCDPORT_TRIS_DATA = d;
+
+    b = _LCDPORT_CONT_LATCH;
     b &= ~_LCDPORT_CONT_RW; // ,RW='0'
     b |= _LCDPORT_CONT_RS; // RS='1"
-    _LCDPORT_CONT_LATCH = b;
     _LCDPORT_LATCH_DATA = c;
+    _LCDPORT_CONT_LATCH = b;
+    _ACM1602_TC_WAIT(); // Wait 2.5?us
+
     b |= _LCDPORT_CONT_EN; // Send character
     _LCDPORT_CONT_LATCH = b;
     _ACM1602_TC_WAIT(); // Wait 2.5?us
+
     b &= ~_LCDPORT_CONT_EN; // Disable EN
     _LCDPORT_CONT_LATCH = b;
     _ACM1602_SHORT_WAIT(); // Wait 0.1ms
+#endif
 }
 
 #endif
 
 void acm1602_cls(unsigned char addr)
 {
-    sendcmd(addr, 0x01);
-    delay_lcd();
+    sendcmd(addr, 0x01, 0xff);
+    _ACM1602_LONG_WAIT(); // Wait 5ms
+}
+
+void acm1602_setdataramaddress(unsigned char addr, unsigned char pos)
+{
+    unsigned char cmd = (pos & 0x7f) | 0x80;
+    sendcmd(addr, cmd, 0xff);
 }
 
-void acm1602_locate(unsigned char addr, char x, char y)
+
+void acm1602_locate_16x2(unsigned char addr, unsigned char x, unsigned char y)
 {
     unsigned char ramaddr;
-    if((x < 0) || (x > 15)) return;
-    if((y < 0) || (y > 1)) return;
-    if(y == 0){
-        ramaddr = 0x80 | (x & 0x0f);
-    } else {
-        ramaddr = 0xc0 | (x & 0x0f);
-    }
-    sendcmd(addr, ramaddr);
+    if(x > 16) return;
+    if(y > 1) return;
+    ramaddr = (y == 0)? x  : (x  | 0x40);
+    acm1602_setdataramaddress(addr, ramaddr);
+}
+
+/*
+ * For using
+ */
+void acm1602_locate_8x2(unsigned char addr, unsigned char x, unsigned char y)
+{
+    unsigned char ramaddr;
+    if(x > 8) return;
+    if(y > 1) return;
+    ramaddr = (y == 0)? x : x | 0x40;
+    acm1602_setdataramaddress(addr, ramaddr);
 }
 
 void acm1602_home(unsigned char addr)
 {
-    sendcmd(addr, 0x02);
-    delay_lcd();
+    sendcmd(addr, 0x02, 0xff);
+    _ACM1602_LONG_WAIT(); // Wait 5ms
 }
 
-void acm1602_printf(unsigned char addr, const char *fmt, ...)
+
+void acm1602_cursordir(unsigned char addr, unsigned char right)
 {
-    char strbuf[32]; // Max 32 bytes.
-    va_list args;
-    int i;
-    int l;
+    unsigned char cmd;
 
-    strbuf[0] = '\0';
-    va_start(args, fmt );
-    sprintf(strbuf, args);
-    l = strlen(strbuf);
-    if((l >= 32) || (l <= 0))return;
-    for(i = 0; i < l; i++) {
-        acm1602_putchar(addr, strbuf[i]);
+    cmd = 0x14;
+    if(right == 0)  {
+        cmd = 0x10;
     }
+    sendcmd(addr, cmd, 0xff);
 }
 
-void acm1602_cursordir(unsigned char addr, unsigned char right)
+void acm1602_dispcursor(unsigned char addr, unsigned char flag)
 {
     unsigned char cmd;
-    if(right == 0) {
-        cmd = 0x18;
-    } else {
-        cmd=0x1c;
+    cmd = 0x0d; // Cursor ON
+    if(flag == 0x00) {
+        cmd = 0x0c; // Cursor off
     }
-    sendcmd(addr, cmd);
+    sendcmd(addr, cmd, 0xff);
+}
+
+void acm1602_setcgramaddress(unsigned char addr, unsigned char pos)
+{
+    unsigned char cmd = (pos & 0x3f) | 0x40;
+    sendcmd(addr, cmd, 0xff);
 }
 
 void acm1602_init(unsigned char addr, unsigned char cls)
 {
     acm1602_ioinit(addr);
-    sendcmd(addr, 0x38); // 2lines, 8x10dot fonts.
-    sendcmd(addr, 0x0f); // Display ON.
-    if(cls == 0){
+#ifdef _USE_I2C_1602
+    sendcmd(addr,0x01,0x00);
+    sendcmd(addr, 0x38, 0x00); // 2lines, 8x10dot fonts.
+//    sendcmd(addr, 0x38, 0x00); // 2lines, 8x10dot fonts.
+#else
+  #ifndef _LCD_IF_4BIT
+    sendonce(addr, 0x38); // 2lines, 8x10dot fonts.
+    sendcmd(addr, 0x38, 0x00); // 2lines, 8x10dot fonts.
+  #else // 4Bit
+    _ACM1602_LONG_LONG_WAIT();
+    sendonce(addr, 0x30); // 2lines, 8x10dot fonts.
+//    _ACM1602_SHORT_WAIT();
+    sendonce(addr, 0x30); // 2lines, 8x10dot fonts.
+//    _ACM1602_SHORT_WAIT();
+    sendonce(addr, 0x30); // 2lines, 8x10dot fonts.
+//    _ACM1602_SHORT_WAIT();
+    sendonce(addr, 0x20); // 2lines, 8x10dot fonts.
+//    _ACM1602_SHORT_WAIT();
+    // Send twice on 4Bit Mode.
+//    sendonce(addr, 0x30); // 2lines, 8x10dot fonts.
+    sendcmd(addr, 0x28, 0xff); // 2lines, 8x5dot fonts.
+  #endif
+#endif
+//    sendcmd(addr, 0x08, 0xff); // Display OFF.
+    sendcmd(addr, 0x0c, 0xff); // Display ON.
+//    sendcmd(addr, 0x06, 0xff); // Cursor increment,not shift.
+   if(cls == 0){
         acm1602_home(addr);
     } else {
         acm1602_cls(addr);
     }
-}
\ No newline at end of file
+//    _ACM1602_LONG_WAIT();
+    sendcmd(addr, 0x06, 0xff);
+}
+
+/*
+ * Suspend lcd
+ */
+void acm1602_suspend(unsigned char addr)
+{
+    sendcmd(addr, 0x08, 0xff);
+    _ACM1602_LONG_WAIT();
+}
+
+void acm1602_resume(unsigned char addr)
+{
+    sendcmd(addr, 0x0c, 0xff);
+    _ACM1602_LONG_WAIT();
+}
+
+
+#ifdef _USE_I2C_1602
+/*
+ * st7032 extensions.
+ */
+void st7032_extcmd(unsigned char addr, unsigned char mode, 
+        unsigned char cmd, unsigned char busyf)
+{
+    unsigned char m = mode & 0x1c;
+    m = m | 0x21;
+    sendcmd(addr, m, busyf); // Shift to IS1
+    sendcmd(addr, cmd, busyf);
+    m &= 0xfe; // Shift to IS0
+    sendcmd(addr, m, busyf);
+}
+
+void st7032_setcontrast(unsigned char addr, unsigned char value,
+        unsigned char busyf)
+{
+    unsigned char val = value & 0x0f;
+    val |= 0x70;
+    st7032_extcmd(addr, 0x38, val, busyf);
+}
+#endif