Diff: Adafruit_ST7735.cpp

Revision:

0:1e675eea5267

Child:

1:643bda4b6ced

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Adafruit_ST7735.cpp	Tue Aug 25 20:29:42 2015 +0000
@@ -0,0 +1,690 @@
+/***************************************************
+  This is a library for the Adafruit 1.8" SPI display.
+  This library works with the Adafruit 1.8" TFT Breakout w/SD card
+  ----> http://www.adafruit.com/products/358
+  as well as Adafruit raw 1.8" TFT display
+  ----> http://www.adafruit.com/products/618
+
+  Check out the links above for our tutorials and wiring diagrams
+  These displays use SPI to communicate, 4 or 5 pins are required to
+  interface (RST is optional)
+  Adafruit invests time and resources providing this open source code,
+  please support Adafruit and open-source hardware by purchasing
+  products from Adafruit!
+
+  Written by Limor Fried/Ladyada for Adafruit Industries.
+  MIT license, all text above must be included in any redistribution
+ ****************************************************/
+
+#include "mbed.h"
+#include "Adafruit_ST7735.h"
+
+
+// Constructor 
+Adafruit_ST7735::Adafruit_ST7735(PinName mosi, PinName miso, PinName clk, PinName cs, PinName rs): lcdPort(mosi,miso,clk), _cs(cs), _rs(rs),Adafruit_GFX(ST7735_TFTWIDTH, ST7735_TFTHEIGHT)
+{
+    lcdPort.format(8,3);
+    lcdPort.frequency(10000000);
+    initR();
+    setRotation(0);
+    fillScreen(0x0000);
+    setTextColor(0xFFFF);
+}
+
+
+void Adafruit_ST7735::writecommand(uint8_t c)
+{
+    _rs = 0;
+    _cs = 0;
+    lcdPort.write( c );
+    _cs = 1;
+}
+
+
+void Adafruit_ST7735::writedata(uint8_t c)
+{
+    _rs = 1;
+    _cs = 0;
+    lcdPort.write( c );
+
+    _cs = 1;
+}
+
+
+// Rather than a bazillion writecommand() and writedata() calls, screen
+// initialization commands and arguments are organized in these tables
+// stored in PROGMEM.  The table may look bulky, but that's mostly the
+// formatting -- storage-wise this is hundreds of bytes more compact
+// than the equivalent code.  Companion function follows.
+#define DELAY 0x80
+static unsigned char
+Bcmd[] = {                  // Initialization commands for 7735B screens
+    18,                       // 18 commands in list:
+    ST7735_SWRESET,   DELAY,  //  1: Software reset, no args, w/delay
+    50,                     //     50 ms delay
+    ST7735_SLPOUT ,   DELAY,  //  2: Out of sleep mode, no args, w/delay
+    255,                    //     255 = 500 ms delay
+    ST7735_COLMOD , 1+DELAY,  //  3: Set color mode, 1 arg + delay:
+    0x05,                   //     16-bit color
+    10,                     //     10 ms delay
+    ST7735_FRMCTR1, 3+DELAY,  //  4: Frame rate control, 3 args + delay:
+    0x00,                   //     fastest refresh
+    0x06,                   //     6 lines front porch
+    0x03,                   //     3 lines back porch
+    10,                     //     10 ms delay
+    ST7735_MADCTL , 1      ,  //  5: Memory access ctrl (directions), 1 arg:
+    0x08,                   //     Row addr/col addr, bottom to top refresh
+    ST7735_DISSET5, 2      ,  //  6: Display settings #5, 2 args, no delay:
+    0x15,                   //     1 clk cycle nonoverlap, 2 cycle gate
+    //     rise, 3 cycle osc equalize
+    0x02,                   //     Fix on VTL
+    ST7735_INVCTR , 1      ,  //  7: Display inversion control, 1 arg:
+    0x0,                    //     Line inversion
+    ST7735_PWCTR1 , 2+DELAY,  //  8: Power control, 2 args + delay:
+    0x02,                   //     GVDD = 4.7V
+    0x70,                   //     1.0uA
+    10,                     //     10 ms delay
+    ST7735_PWCTR2 , 1      ,  //  9: Power control, 1 arg, no delay:
+    0x05,                   //     VGH = 14.7V, VGL = -7.35V
+    ST7735_PWCTR3 , 2      ,  // 10: Power control, 2 args, no delay:
+    0x01,                   //     Opamp current small
+    0x02,                   //     Boost frequency
+    ST7735_VMCTR1 , 2+DELAY,  // 11: Power control, 2 args + delay:
+    0x3C,                   //     VCOMH = 4V
+    0x38,                   //     VCOML = -1.1V
+    10,                     //     10 ms delay
+    ST7735_PWCTR6 , 2      ,  // 12: Power control, 2 args, no delay:
+    0x11, 0x15,
+    ST7735_GMCTRP1,16      ,  // 13: Magical unicorn dust, 16 args, no delay:
+    0x09, 0x16, 0x09, 0x20, //     (seriously though, not sure what
+    0x21, 0x1B, 0x13, 0x19, //      these config values represent)
+    0x17, 0x15, 0x1E, 0x2B,
+    0x04, 0x05, 0x02, 0x0E,
+    ST7735_GMCTRN1,16+DELAY,  // 14: Sparkles and rainbows, 16 args + delay:
+    0x0B, 0x14, 0x08, 0x1E, //     (ditto)
+    0x22, 0x1D, 0x18, 0x1E,
+    0x1B, 0x1A, 0x24, 0x2B,
+    0x06, 0x06, 0x02, 0x0F,
+    10,                     //     10 ms delay
+    ST7735_CASET  , 4      ,  // 15: Column addr set, 4 args, no delay:
+    0x00, 0x02,             //     XSTART = 2
+    0x00, 0x81,             //     XEND = 129
+    ST7735_RASET  , 4      ,  // 16: Row addr set, 4 args, no delay:
+    0x00, 0x01,             //     XSTART = 1
+    0x00, 0x80,             //     XEND = 160 or '128' /*sarvesh*/
+    ST7735_NORON  ,   DELAY,  // 17: Normal display on, no args, w/delay
+    10,                     //     10 ms delay
+    ST7735_DISPON ,   DELAY,  // 18: Main screen turn on, no args, w/delay
+    255
+},                  //     255 = 500 ms delay
+
+Rcmd1[] = {                 // Init for 7735R, part 1 (red or green tab)
+    15,                       // 15 commands in list:
+    ST7735_SWRESET,   DELAY,  //  1: Software reset, 0 args, w/delay
+    150,                    //     150 ms delay
+    ST7735_SLPOUT ,   DELAY,  //  2: Out of sleep mode, 0 args, w/delay
+    255,                    //     500 ms delay
+    ST7735_FRMCTR1, 3      ,  //  3: Frame rate ctrl - normal mode, 3 args:
+    0x01, 0x2C, 0x2D,       //     Rate = fosc/(1x2+40) * (LINE+2C+2D)
+    ST7735_FRMCTR2, 3      ,  //  4: Frame rate control - idle mode, 3 args:
+    0x01, 0x2C, 0x2D,       //     Rate = fosc/(1x2+40) * (LINE+2C+2D)
+    ST7735_FRMCTR3, 6      ,  //  5: Frame rate ctrl - partial mode, 6 args:
+    0x01, 0x2C, 0x2D,       //     Dot inversion mode
+    0x01, 0x2C, 0x2D,       //     Line inversion mode
+    ST7735_INVCTR , 1      ,  //  6: Display inversion ctrl, 1 arg, no delay:
+    0x07,                   //     No inversion
+    ST7735_PWCTR1 , 3      ,  //  7: Power control, 3 args, no delay:
+    0xA2,
+    0x02,                   //     -4.6V
+    0x84,                   //     AUTO mode
+    ST7735_PWCTR2 , 1      ,  //  8: Power control, 1 arg, no delay:
+    0xC5,                   //     VGH25 = 2.4C VGSEL = -10 VGH = 3 * AVDD
+    ST7735_PWCTR3 , 2      ,  //  9: Power control, 2 args, no delay:
+    0x0A,                   //     Opamp current small
+    0x00,                   //     Boost frequency
+    ST7735_PWCTR4 , 2      ,  // 10: Power control, 2 args, no delay:
+    0x8A,                   //     BCLK/2, Opamp current small & Medium low
+    0x2A,
+    ST7735_PWCTR5 , 2      ,  // 11: Power control, 2 args, no delay:
+    0x8A, 0xEE,
+    ST7735_VMCTR1 , 1      ,  // 12: Power control, 1 arg, no delay:
+    0x0E,
+    ST7735_INVOFF , 0      ,  // 13: Don't invert display, no args, no delay
+    ST7735_MADCTL , 1      ,  // 14: Memory access control (directions), 1 arg:
+    0xC8,                   //     row addr/col addr, bottom to top refresh
+    ST7735_COLMOD , 1      ,  // 15: set color mode, 1 arg, no delay:
+    0x05
+},                 //     16-bit color
+
+Rcmd2green[] = {            // Init for 7735R, part 2 (green tab only)
+    2,                        //  2 commands in list:
+    ST7735_CASET  , 4      ,  //  1: Column addr set, 4 args, no delay:
+    0x00, 0x02,             //     XSTART = 0
+    0x00, 0x7F+0x02,        //     XEND = 127
+    ST7735_RASET  , 4      ,  //  2: Row addr set, 4 args, no delay:
+    0x00, 0x01,             //     XSTART = 0
+    0x00, 0x7F+0x01 //     XEND = not 159 but 127 /*sarvesh*/
+},      
+Rcmd2red[] = {              // Init for 7735R, part 2 (red tab only)
+    2,                        //  2 commands in list:
+    ST7735_CASET  , 4      ,  //  1: Column addr set, 4 args, no delay:
+    0x00, 0x00,             //     XSTART = 0
+    0x00, 0x7F,             //     XEND = 127
+    ST7735_RASET  , 4      ,  //  2: Row addr set, 4 args, no delay:
+    0x00, 0x00,             //     XSTART = 0
+    0x00, 0x7F          //     XEND = not 159 but 127 /*sarvesh*/
+},           
+
+Rcmd3[] = {                 // Init for 7735R, part 3 (red or green tab)
+    4,                        //  4 commands in list:
+    ST7735_GMCTRP1, 16      , //  1: Magical unicorn dust, 16 args, no delay:
+    0x02, 0x1c, 0x07, 0x12,
+    0x37, 0x32, 0x29, 0x2d,
+    0x29, 0x25, 0x2B, 0x39,
+    0x00, 0x01, 0x03, 0x10,
+    ST7735_GMCTRN1, 16      , //  2: Sparkles and rainbows, 16 args, no delay:
+    0x03, 0x1d, 0x07, 0x06,
+    0x2E, 0x2C, 0x29, 0x2D,
+    0x2E, 0x2E, 0x37, 0x3F,
+    0x00, 0x00, 0x02, 0x10,
+    ST7735_NORON  ,    DELAY, //  3: Normal display on, no args, w/delay
+    10,                     //     10 ms delay
+    ST7735_DISPON ,    DELAY, //  4: Main screen turn on, no args w/delay
+    100
+};                  //     100 ms delay
+
+static unsigned char Scmd[] = {                  // Initialization commands for S6D02A1 screens
+    29,
+    0xf0,   2,  0x5a, 0x5a,             // Excommand2
+    0xfc,   2,  0x5a, 0x5a,             // Excommand3
+    0x26,   1,  0x01,                   // Gamma set
+    0xfa,   15, 0x02, 0x1f, 0x00, 0x10, 0x22, 0x30, 0x38, 0x3A, 0x3A, 0x3A, 0x3A, 0x3A, 0x3d, 0x02, 0x01,   // Positive gamma control
+    0xfb,   15, 0x21, 0x00, 0x02, 0x04, 0x07, 0x0a, 0x0b, 0x0c, 0x0c, 0x16, 0x1e, 0x30, 0x3f, 0x01, 0x02,   // Negative gamma control
+    0xfd,   11, 0x00, 0x00, 0x00, 0x17, 0x10, 0x00, 0x01, 0x01, 0x00, 0x1f, 0x1f,                           // Analog parameter control
+    0xf4,   15, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3f, 0x3f, 0x07, 0x00, 0x3C, 0x36, 0x00, 0x3C, 0x36, 0x00,   // Power control
+    0xf5,   13, 0x00, 0x70, 0x66, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x6d, 0x66, 0x06,               // VCOM control
+    0xf6,   11, 0x02, 0x00, 0x3f, 0x00, 0x00, 0x00, 0x02, 0x00, 0x06, 0x01, 0x00,                           // Source control
+    0xf2,   17, 0x00, 0x01, 0x03, 0x08, 0x08, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, 0x00, 0x00, 0x04, 0x08, 0x08,   //Display control
+    0xf8,   1,  0x11,                   // Gate control
+    0xf7,   4, 0xc8, 0x20, 0x00, 0x00,  // Interface control
+    0xf3,   2, 0x00, 0x00,              // Power sequence control
+    0x11,   DELAY, 50,                  // Wake
+    0xf3,   2+DELAY, 0x00, 0x01, 50,    // Power sequence control
+    0xf3,   2+DELAY, 0x00, 0x03, 50,    // Power sequence control
+    0xf3,   2+DELAY, 0x00, 0x07, 50,    // Power sequence control
+    0xf3,   2+DELAY, 0x00, 0x0f, 50,    // Power sequence control
+    0xf4,   15+DELAY, 0x00, 0x04, 0x00, 0x00, 0x00, 0x3f, 0x3f, 0x07, 0x00, 0x3C, 0x36, 0x00, 0x3C, 0x36, 0x00, 50, // Power control
+    0xf3,   2+DELAY, 0x00, 0x1f, 50,    // Power sequence control
+    0xf3,   2+DELAY, 0x00, 0x7f, 50,    // Power sequence control
+    0xf3,   2+DELAY, 0x00, 0xff, 50,    // Power sequence control
+    0xfd,   11, 0x00, 0x00, 0x00, 0x17, 0x10, 0x00, 0x00, 0x01, 0x00, 0x16, 0x16,                           // Analog parameter control
+    0xf4,   15, 0x00, 0x09, 0x00, 0x00, 0x00, 0x3f, 0x3f, 0x07, 0x00, 0x3C, 0x36, 0x00, 0x3C, 0x36, 0x00,   // Power control
+    0x36,   1, 0x08,                    // Memory access data control
+    0x35,   1, 0x00,                    // Tearing effect line on
+    0x3a,   1+DELAY, 0x05, 150,         // Interface pixel control
+    0x29,   0,                          // Display on
+    0x2c,   0                           // Memory write    
+};
+
+// Companion code to the above tables.  Reads and issues
+// a series of LCD commands stored in byte array.
+void Adafruit_ST7735::commandList(uint8_t *addr)
+{
+
+    uint8_t  numCommands, numArgs;
+    uint16_t ms;
+
+    numCommands = *addr++;   // Number of commands to follow
+    while(numCommands--) {                 // For each command...
+        writecommand(*addr++); //   Read, issue command
+        numArgs  = *addr++;    //   Number of args to follow
+        ms       = numArgs & DELAY;          //   If hibit set, delay follows args
+        numArgs &= ~DELAY;                   //   Mask out delay bit
+        while(numArgs--) {                   //   For each argument...
+            writedata(*addr++);  //     Read, issue argument
+        }
+
+        if(ms) {
+            ms = *addr++; // Read post-command delay time (ms)
+            if(ms == 255) ms = 500;     // If 255, delay for 500 ms
+            wait_ms(ms);
+        }
+    }
+}
+
+
+// Initialization code common to both 'B' and 'R' type displays
+void Adafruit_ST7735::commonInit(uint8_t *cmdList)
+{
+
+    colstart  = rowstart = 0; // May be overridden in init func
+
+    _rs = 1;
+    _cs = 1;
+
+    // use default SPI format
+    //lcdPort.format(8,0);
+    //lcdPort.frequency(4000000);     // Lets try 4MHz
+
+    // toggle RST low to reset; CS low so it'll listen to us
+    _cs = 0;
+    wait_ms(500);
+    if(cmdList) commandList(cmdList);
+    
+}
+
+
+// Initialization for ST7735B screens
+void Adafruit_ST7735::initB(void)
+{
+    commonInit(Bcmd);
+}
+
+
+// Initialization for ST7735R screens (green or red tabs)
+void Adafruit_ST7735::initR(uint8_t options)
+{
+    commonInit(Rcmd1);
+    if(options == INITR_GREENTAB) {
+        commandList(Rcmd2green);
+        colstart = 2;
+        rowstart = 3;
+    } else {
+        // colstart, rowstart left at default '0' values
+        commandList(Rcmd2red);
+    }
+    commandList(Rcmd3);
+}
+
+// Initialization for ST7735B screens
+void Adafruit_ST7735::initS(void)
+{
+    commonInit(Scmd);
+}
+
+void Adafruit_ST7735::setAddrWindow(uint8_t x0, uint8_t y0, uint8_t x1,
+                                    uint8_t y1)
+{
+
+    writecommand(ST7735_CASET); // Column addr set
+    writedata(0x00);
+    writedata(x0+colstart);     // XSTART
+    writedata(0x00);
+    writedata(x1+colstart);     // XEND
+
+    writecommand(ST7735_RASET); // Row addr set
+    writedata(0x00);
+    writedata(y0+rowstart);     // YSTART
+    writedata(0x00);
+    writedata(y1+rowstart);     // YEND
+
+    writecommand(ST7735_RAMWR); // write to RAM
+}
+
+
+void Adafruit_ST7735::fillScreen(uint16_t color)
+{
+
+    uint8_t x, y, hi = color >> 8, lo = color;
+
+    setAddrWindow(0, 0, _width-1, _height-1);
+
+    _rs = 1;
+    _cs = 0;
+
+    for(y=_height; y>0; y--) 
+    {
+        for(x=_width; x>0; x--) 
+        {
+            lcdPort.write( hi );
+            lcdPort.write( lo );
+        }
+    }
+
+    _cs = 1;
+}
+
+
+void Adafruit_ST7735::pushColor(uint16_t color)
+{
+    _rs = 1;
+    _cs = 0;
+
+    lcdPort.write( color >> 8 );
+    lcdPort.write( color );
+    _cs = 1;
+}
+
+
+void Adafruit_ST7735::drawPixel(int16_t x, int16_t y, uint16_t color)
+{
+
+    if((x < 0) ||(x >= _width+1) || (y < 0) || (y >= _height+1)) return;
+
+    setAddrWindow(x,y,x+1,y+1);
+
+    _rs = 1;
+    _cs = 0;
+
+    lcdPort.write( color >> 8 );
+    lcdPort.write( color );
+
+    _cs = 1;
+}
+
+
+void Adafruit_ST7735::drawFastVLine(int16_t x, int16_t y, int16_t h,
+                                    uint16_t color)
+{
+
+    // Rudimentary clipping
+    if((x >= _width) || (y >= _height)) return;
+    if((y+h-1) >= _height) h = _height-y;
+    setAddrWindow(x, y, x, y+h-1);
+
+    uint8_t hi = color >> 8, lo = color;
+    _rs = 1;
+    _cs = 0;
+    while (h--) {
+        lcdPort.write( hi );
+        lcdPort.write( lo );
+    }
+    _cs = 1;
+}
+
+
+void Adafruit_ST7735::drawFastHLine(int16_t x, int16_t y, int16_t w,
+                                    uint16_t color)
+{
+
+    // Rudimentary clipping
+    if((x >= _width) || (y >= _height)) return;
+    if((x+w-1) >= _width)  w = _width-x;
+    setAddrWindow(x, y, x+w-1, y);
+
+    uint8_t hi = color >> 8, lo = color;
+    _rs = 1;
+    _cs = 0;
+    while (w--) {
+        lcdPort.write( hi );
+        lcdPort.write( lo );
+    }
+    _cs = 1;
+}
+
+/*To draw rectangle - by Sarvesh*/
+void Adafruit_ST7735::drawRect(int16_t x0, int16_t y0, int16_t x1,int16_t y1,uint16_t color)
+{
+    int16_t w=abs(x1-x0);
+    int16_t h=abs(y1-y0);
+    if (x1 > x0) drawFastHLine(x0,y0,w,color);
+    else  drawFastHLine(x1,y1,w,color);
+
+    if (y1 > y0) drawFastVLine(x0,y0,h,color);
+    else drawFastVLine(x1,y1,h,color);
+
+    if (x1 > x0) drawFastHLine(x0,y1,w,color);
+    else  drawFastHLine(x1,y0,w,color);
+
+    if (y1 > y0) drawFastVLine(x1,y0,h,color);
+    else drawFastVLine(x0,y1,h,color);
+
+    return;
+}
+
+// fill a rectangle
+void Adafruit_ST7735::fillRect(int16_t x, int16_t y, int16_t w, int16_t h,
+                               uint16_t color)
+{
+
+    // rudimentary clipping (drawChar w/big text requires this)
+    if((x >= _width) || (y >= _height)) return;
+    if((x + w - 1) >= _width)  w = _width  - x;
+    if((y + h - 1) >= _height) h = _height - y;
+
+    setAddrWindow(x, y, x+w-1, y+h-1);
+
+    uint8_t hi = color >> 8, lo = color;
+    _rs = 1;
+    _cs = 0;
+    for(y=h; y>0; y--) {
+        for(x=w; x>0; x--) {
+            lcdPort.write( hi );
+            lcdPort.write( lo );
+        }
+    }
+
+    _cs = 1;
+}
+/*To draw circle - by Sarvesh*/
+void Adafruit_ST7735::drawCircle(int16_t x0, int16_t y0,int16_t r,uint16_t color) 
+{
+    int16_t draw_x0, draw_y0;
+    int16_t draw_x1, draw_y1;
+    int16_t draw_x2, draw_y2;
+    int16_t draw_x3, draw_y3;
+    int16_t draw_x4, draw_y4;
+    int16_t draw_x5, draw_y5;
+    int16_t draw_x6, draw_y6;
+    int16_t draw_x7, draw_y7;
+    int16_t xx, yy;
+    int16_t di;
+    setAddrWindow(1, 1, _width, _height);
+    if (r == 0) {       /* no radius */
+        return;
+    }
+
+    draw_x0 = draw_x1 = x0;
+    draw_y0 = draw_y1 = y0 + r;
+    if (draw_y0 < height()) {
+        drawPixel(draw_x0, draw_y0, color);     /* 90 degree */
+    }
+
+    draw_x2 = draw_x3 = x0;
+    draw_y2 = draw_y3 = y0 - r;
+    if (draw_y2 >= 0) {
+        drawPixel(draw_x2, draw_y2, color);    /* 270 degree */
+    }
+
+    draw_x4 = draw_x6 = x0 + r;
+    draw_y4 = draw_y6 = y0;
+    if (draw_x4 < width()) {
+        drawPixel(draw_x4, draw_y4, color);     /* 0 degree */
+    }
+
+    draw_x5 = draw_x7 = x0 - r;
+    draw_y5 = draw_y7 = y0;
+    if (draw_x5>=0) {
+        drawPixel(draw_x5, draw_y5, color);     /* 180 degree */
+    }
+
+    if (r == 1) {
+        return;
+    }
+
+    di = 3 - 2*r;
+    xx = 0;
+    yy = r;
+    while (xx < yy) {
+
+        if (di < 0) {
+            di += 4*xx + 6;
+        } else {
+            di += 4*(xx - yy) + 10;
+            yy--;
+            draw_y0--;
+            draw_y1--;
+            draw_y2++;
+            draw_y3++;
+            draw_x4--;
+            draw_x5++;
+            draw_x6--;
+            draw_x7++;
+        }
+        xx++;
+        draw_x0++;
+        draw_x1--;
+        draw_x2++;
+        draw_x3--;
+        draw_y4++;
+        draw_y5++;
+        draw_y6--;
+        draw_y7--;
+
+        if ( (draw_x0 <= width()) && (draw_y0>=0) ) {
+            drawPixel(draw_x0, draw_y0, color);
+        }
+
+        if ( (draw_x1 >= 0) && (draw_y1 >= 0) ) {
+            drawPixel(draw_x1, draw_y1, color);
+        }
+
+        if ( (draw_x2 <= width()) && (draw_y2 <= height()) ) {
+            drawPixel(draw_x2, draw_y2, color);
+        }
+
+        if ( (draw_x3 >=0 ) && (draw_y3 <= height()) ) {
+            drawPixel(draw_x3, draw_y3, color);
+        }
+
+        if ( (draw_x4 <= width()) && (draw_y4 >= 0) ) {
+            drawPixel(draw_x4, draw_y4, color);
+        }
+
+        if ( (draw_x5 >= 0) && (draw_y5 >= 0) ) {
+            drawPixel(draw_x5, draw_y5, color);
+        }
+        if ( (draw_x6 <=width()) && (draw_y6 <= height()) ) {
+            drawPixel(draw_x6, draw_y6, color);
+        }
+        if ( (draw_x7 >= 0) && (draw_y7 <= height()) ) {
+            drawPixel(draw_x7, draw_y7, color);
+        }
+    }
+    return;
+}
+
+
+// Pass 8-bit (each) R,G,B, get back 16-bit packed color
+uint16_t Adafruit_ST7735::Color565(uint8_t r, uint8_t g, uint8_t b)
+{
+    return ((r & 0xF8) << 8) | ((g & 0xFC) << 3) | (b >> 3);
+}
+
+
+#define MADCTL_MY  0x80
+#define MADCTL_MX  0x40
+#define MADCTL_MV  0x20
+#define MADCTL_ML  0x10
+#define MADCTL_RGB 0x08
+#define MADCTL_MH  0x04
+
+void Adafruit_ST7735::setRotation(uint8_t m)
+{
+
+    writecommand(ST7735_MADCTL);
+    rotation = m % 4; // can't be higher than 3
+    switch (rotation) {
+        case 0:
+            writedata(MADCTL_MX | MADCTL_MY | MADCTL_RGB);
+            _width  = ST7735_TFTWIDTH;
+            _height = ST7735_TFTHEIGHT;
+            break;
+        case 1:
+            writedata(MADCTL_MY | MADCTL_MV | MADCTL_RGB);
+            _width  = ST7735_TFTHEIGHT;
+            _height = ST7735_TFTWIDTH;
+            break;
+        case 2:
+            writedata(MADCTL_RGB);
+            _width  = ST7735_TFTWIDTH;
+            _height = ST7735_TFTHEIGHT;
+            break;
+        case 3:
+            writedata(MADCTL_MX | MADCTL_MV | MADCTL_RGB);
+            _width  = ST7735_TFTHEIGHT;
+            _height = ST7735_TFTWIDTH;
+            break;
+    }
+}
+
+
+void Adafruit_ST7735::invertDisplay(boolean i)
+{
+    writecommand(i ? ST7735_INVON : ST7735_INVOFF);
+}
+/*
+void Adafruit_ST7735::display(void)
+{
+    writecommand(ST7735_CASET | 0x0);  // low col = 0
+    writecommand(ST7735_RASET | 0x0);  // hi col = 0
+    writecommand(ST7735_RAMWR | 0x0); // line #0
+
+    _cs = 1;
+    _rs = 1;
+    _cs = 0;
+    setAddrWindow(0,0,3,3);
+    for (uint16_t i=0; i<(ST7735_TFTWIDTH*ST7735_TFTHEIGHT/8); i++)
+        lcdPort.write(buffer[i]);
+
+    // i wonder why we have to do this (check datasheet)
+    if (ST7735_TFTHEIGHT == 64)
+    {
+        
+        for (uint16_t i=0; i<(ST7735_TFTWIDTH*ST7735_TFTHEIGHT/8); i++)
+            lcdPort.write(0);
+    }
+    
+    _cs = 1;
+} */
+/*
+void Adafruit_ST7735::drawChar(int16_t x, int16_t y, unsigned char c, uint16_t color, uint16_t bg, uint8_t size)
+{
+    if(
+        (x >= _width) || // Clip right
+        (y >= _height) || // Clip bottom
+        ((x + 5 * size - 1) < 0) || // Clip left
+        ((y + 8 * size - 1) < 0) // Clip top
+        )
+    return;
+    
+    for (int8_t i=0; i<6; i++ )
+    {
+        uint8_t line = 0;
+
+        if (i == 5) 
+            line = 0x0;
+        else 
+            line = font[(c*5)+i];
+            
+        for (int8_t j = 0; j<8; j++)
+        {
+            if (line & 0x1)
+            {
+                if (size == 1) // default size
+                    drawPixel(x+i, y+j, color);
+#ifdef WANT_ABSTRACTS
+                else // big size
+                    fillRect(x+(i*size), y+(j*size), size, size, color);
+#endif
+            }
+            else if (bg != color)
+            {
+                if (size == 1) // default size
+                    drawPixel(x+i, y+j, bg);
+#ifdef WANT_ABSTRACTS
+                else // big size
+                    fillRect(x+i*size, y+j*size, size, size, bg);
+#endif
+            }
+            line >>= 1;
+        }
+    }
+}*/
+/*
+void Adafruit_ST7735::drawTriangle(int16_t x0, int16_t y0, int16_t x1, int16_t y1, int16_t x2, int16_t y2, uint16_t color)
+{
+    drawLine(x0, y0, x1, y1, color);
+    drawLine(x1, y1, x2, y2, color);
+    drawLine(x2, y2, x0, y0, color);
+}*/
\ No newline at end of file