Diff: SO1602A/SO1602A.cpp

Revision:

0:cb29cf2767cd

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/SO1602A/SO1602A.cpp	Thu Nov 07 11:07:51 2019 +0000
@@ -0,0 +1,149 @@
+#include "SO1602A.h"
+
+SO1602A::SO1602A (PinName sda, PinName scl, char address)
+    : p_i2c(new I2C(sda, scl)), i2c(*p_i2c), addr(address)
+{
+    init();
+}
+SO1602A::SO1602A (I2C &_i2c, char address)
+    : p_i2c(NULL), i2c(_i2c), addr(address)
+{
+    init();
+}
+SO1602A::~SO1602A()
+{
+    if(p_i2c != NULL)
+    delete p_i2c;
+}
+
+bool SO1602A::cmd(char chr)
+{
+    buf[0]= 0x00;
+    buf[1]= chr;
+    // if write success:0, other: err code.
+    int status= i2c.write(addr, buf, 2);
+    wait_ms(3);
+
+    if(status == 0)
+        return true;
+    else
+        return false;
+}
+
+int SO1602A::_putc(int val)     // for printf()
+{
+    if (val == '\n') {
+        col = 0;
+        row = (row + 1) % 2;
+    } else {
+        locate(col, row);
+        buf[0]= 0x40;
+        buf[1]= val;
+        i2c.write(addr, buf, 2);
+
+        col++;
+        if (col >= 16) {
+            col = 0;
+            row = (row + 1) % 2;
+        }
+    }
+    wait_ms(1);
+    return val;
+}
+
+// for "Stream"
+int SO1602A::_getc()
+{
+    return -1;
+}
+
+void SO1602A::locate(int _col, int _row)
+{
+    col= _col;
+    row= _row;
+    cmd(0x80 + row * 0x20 + col);
+    return;
+}
+
+void SO1602A::init()
+{
+    col= row= 0;
+    buf[0]= 0x00;
+    buf[1]= 0x00;
+    buf[2]= 0x00;
+
+    wait_ms(10);
+    this->clear();
+    this->cmd(0x02);    //Return Home.
+    this->setDispFlag(true, true, true);
+    
+    return;
+}
+
+void SO1602A::setContrast(char val)
+{
+    // Cmd of Contrast-setting must be setted Ext-Func-Register RE & SD.
+    this->setRE();
+    this->setSD();
+    // Double Byte Command. The contrast has 256 steps, and increase as the value.
+    this->cmd(0x81);
+    this->cmd(val);
+    this->clearSD();
+    this->clearRE();
+    wait_ms(100);
+    return;
+}
+
+void SO1602A::setDispFlag(bool disp, bool cursor, bool blink)
+{
+    // set On/Off. b3=1, b2:Disp, b1:Cursor, b0:blink.
+    char tmp=  0x08;
+    if(disp)
+        tmp += 0x04;
+    if(cursor)
+        tmp += 0x02;
+    if(blink)
+        tmp += 0x01;
+    this->cmd(tmp);
+    this->cmd(0x01);    //Clear Disp.
+    wait_ms(20);
+    return;
+}
+
+void SO1602A::clear()
+{
+    this->cmd(0x01);
+    locate(0, 0);
+    wait_ms(5);
+    return;
+}
+
+// ******************** FUNCTION SET **********************
+// RE & IS func-set -> b7-4: 001*.
+//                      b3: dispLine; 1(2&4), 0(1&3).
+//                      RE: b1, IS: b0.
+void SO1602A::setRE()
+{
+    this->cmd(0x2a);
+    return;
+}
+void SO1602A::clearRE()
+{
+    this->cmd(0x28);
+    return;
+}
+// Extention Register; SD.
+// RE setted, 0b 0111 100F. F= Flag; 0: OLED-cmd is disable.
+//                                   1:             enable.
+void SO1602A::setSD()
+{
+    this->cmd(0x79);
+    return;
+}
+void SO1602A::clearSD()
+{
+    this->cmd(0x78);
+    return;
+}
+
+// EOF
\ No newline at end of file