skydarc meneldoll
test st7735 on lpc1768 with mbed v5. bug with spi frequency...
Diff: ST7735/ST7735.cpp
- Revision:
- 2:2946f9eefcae
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/ST7735/ST7735.cpp Wed Apr 08 15:00:13 2020 +0000
@@ -0,0 +1,1134 @@
+/***************************************************
+ 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 "ST7735.h"
+
+Serial output1(USBTX, USBRX);
+
+//uint16_t table[1028][18] __attribute__((section("AHBSRAM0")));
+
+inline uint16_t swapcolor(uint16_t x) {
+ return (x << 11) | (x & 0x07E0) | (x >> 11);
+}
+
+// Constructor
+ST7735::ST7735(PinName mosi, PinName miso, PinName sck, PinName cs, PinName rs, PinName rst)
+ : lcdPort(mosi, miso, sck), _cs(cs), _rs(rs), _rst(rst), GFX(ST7735_TFTWIDTH_128, ST7735_TFTHEIGHT_160)
+{ }
+
+
+void ST7735::writecommand(uint8_t c)
+{
+ _rs = 0;
+ _cs = 0;
+ lcdPort.write( c );
+ _cs = 1;
+}
+
+
+void 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, 0x02, // XSTART = 1
+ 0x00, 0x81, // XEND = 160
+ 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:
+ 0xC0, // 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, 0x9F+0x01 }, // XEND = 159
+ 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, 0x9F }, // XEND = 159
+
+ Rcmd2green144[] = { // Init for 7735R, part 2 (green 1.44 tab)
+ 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 = 127
+
+ Rcmd2green160x80[] = { // Init for 7735R, part 2 (mini 160x80)
+ 2, // 2 commands in list:
+ ST7735_CASET , 4 , // 1: Column addr set, 4 args, no delay:
+ 0x00, 0x00, // XSTART = 0
+ 0x00, 0x7F, // XEND = 79
+ ST7735_RASET , 4 , // 2: Row addr set, 4 args, no delay:
+ 0x00, 0x00, // XSTART = 0
+ 0x00, 0x9F+0x01 }, // XEND = 159
+
+ 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
+
+
+// Companion code to the above tables. Reads and issues
+// a series of LCD commands stored in byte array.
+void 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 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(16000000); // Lets try 4MHz
+ lcdPort.frequency(64000000); // Lets try 4MHz
+
+ // toggle RST low to reset; CS low so it'll listen to us
+ _cs = 0;
+ _rst = 1;
+ wait_ms(500);
+ _rst = 0;
+ wait_ms(500);
+ _rst = 1;
+ wait_ms(500);
+
+ if(cmdList) commandList(cmdList);
+}
+
+
+// Initialization for ST7735B screens
+void ST7735::initB(void)
+{
+ commonInit(Bcmd);
+}
+
+
+// Initialization for ST7735R screens (green or red tabs)
+void ST7735::initR(uint8_t options) {
+ commonInit(Rcmd1);
+ if(options == INITR_GREENTAB) {
+ commandList(Rcmd2green);
+ colstart = 2;
+ rowstart = 1;
+ } else if(options == INITR_144GREENTAB) {
+ _height = ST7735_TFTHEIGHT_128;
+ _width = ST7735_TFTWIDTH_128;
+ commandList(Rcmd2green144);
+ colstart = 2;
+ rowstart = 3;
+ } else if(options == INITR_MINI160x80) {
+ _height = ST7735_TFTHEIGHT_160;
+ _width = ST7735_TFTWIDTH_80;
+ commandList(Rcmd2green160x80);
+ colstart = 24;
+ rowstart = 0;
+ } else if(options == INITR_MINI160x80_RS) {
+ _height = ST7735_TFTHEIGHT_160;
+ _width = ST7735_TFTWIDTH_80;
+ commandList(Rcmd2green160x80);
+ writecommand(1 ? ST7735_INVON : ST7735_INVOFF);
+ colstart = 26;
+ rowstart = 1;
+ _tft_type = 2;
+ } else {
+ // colstart, rowstart left at default '0' values
+ commandList(Rcmd2red);
+ }
+ commandList(Rcmd3);
+
+ // if black, change MADCTL color filter
+ if (options == INITR_BLACKTAB) {
+ writecommand(ST7735_MADCTL);
+ writedata(0xC0);
+ }
+
+ tabcolor = options;
+}
+
+void ST7735::setAddrWindow(uint8_t x0, uint8_t y0, uint8_t x1,
+ uint8_t y1)
+{
+
+ writecommand(ST7735_CASET); // Column addr set
+ writedata(0x00);
+ writedata(x0+xstart); // XSTART
+ writedata(0x00);
+ writedata(x1+xstart); // XEND
+
+ writecommand(ST7735_RASET); // Row addr set
+ writedata(0x00);
+ writedata(y0+ystart); // YSTART
+ writedata(0x00);
+ writedata(y1+ystart); // YEND
+
+ writecommand(ST7735_RAMWR); // write to RAM
+}
+
+void ST7735::pushColor(uint16_t color)
+{
+ _rs = 1;
+ _cs = 0;
+
+ lcdPort.write( color >> 8 );
+ lcdPort.write( color );
+ _cs = 1;
+}
+
+
+void ST7735::drawPixel(int16_t x, int16_t y, uint16_t color)
+{
+
+ if((x < 0) ||(x >= _width) || (y < 0) || (y >= _height)) return;
+
+ setAddrWindow(x,y,x+1,y+1);
+
+ _rs = 1;
+ _cs = 0;
+
+ lcdPort.write( color >> 8 );
+ lcdPort.write( color );
+
+ _cs = 1;
+}
+
+
+void 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 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;
+}
+
+
+
+void ST7735::fillScreen(uint16_t color)
+{
+ fillRect(-10, -10, _width+20, _height+20, color);
+}
+
+
+// fill a rectangle
+void 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;
+}
+
+
+// Pass 8-bit (each) R,G,B, get back 16-bit packed color
+uint16_t ST7735::Color565(uint8_t r, uint8_t g, uint8_t b)
+{
+ return ((r & 0xF8) << 8) | ((g & 0xFC) << 3) | (b >> 3);
+}
+
+// Pass 8-bit (each) R,G,B, get back 16-bit packed color
+char* ST7735::Color565string(uint8_t r, uint8_t g, uint8_t b)
+{
+ uint16_t color;
+ char colorString[4];
+
+ color = ((r & 0xF8) << 8) | ((g & 0xFC) << 3) | (b >> 3);
+
+ sprintf(colorString, "%04x", color);
+
+ //output1.printf("0x%04x : %s\n", color, colorString);
+
+ return colorString;
+ //return "test";
+}
+
+
+#define MADCTL_MY 0x80
+#define MADCTL_MX 0x40
+#define MADCTL_MV 0x20
+#define MADCTL_ML 0x10
+#define MADCTL_RGB 0x00
+#define MADCTL_BGR 0x08
+#define MADCTL_MH 0x04
+
+void ST7735::setRotation(uint8_t m) {
+ _orientation = m;
+ writecommand(ST7735_MADCTL);
+ rotation = m % 4; // can't be higher than 3
+ switch (rotation) {
+ case 0:
+ if ((tabcolor == INITR_BLACKTAB) || (tabcolor == INITR_MINI160x80)) {
+ writedata(MADCTL_MX | MADCTL_MY | MADCTL_RGB);
+ } else if (tabcolor == INITR_MINI160x80_RS) {
+ writedata(MADCTL_MX | MADCTL_MY | MADCTL_BGR);
+ } else {
+ writedata(MADCTL_MX | MADCTL_MY | MADCTL_BGR);
+ }
+
+ if (tabcolor == INITR_144GREENTAB) {
+ _height = ST7735_TFTHEIGHT_128;
+ _width = ST7735_TFTWIDTH_128;
+ } else if ((tabcolor == INITR_MINI160x80) || (tabcolor == INITR_MINI160x80_RS)) {
+ _height = ST7735_TFTHEIGHT_160;
+ _width = ST7735_TFTWIDTH_80;
+ } else {
+ _height = ST7735_TFTHEIGHT_160;
+ _width = ST7735_TFTWIDTH_128;
+ }
+ xstart = colstart;
+ ystart = rowstart;
+ break;
+ case 1:
+ if ((tabcolor == INITR_BLACKTAB) || (tabcolor == INITR_MINI160x80)) {
+ writedata(MADCTL_MY | MADCTL_MV | MADCTL_RGB);
+ } else if (tabcolor == INITR_MINI160x80_RS) {
+ writedata(MADCTL_MY | MADCTL_MV | MADCTL_BGR);
+ } else {
+ writedata(MADCTL_MY | MADCTL_MV | MADCTL_BGR);
+ }
+
+ if (tabcolor == INITR_144GREENTAB) {
+ _width = ST7735_TFTHEIGHT_128;
+ _height = ST7735_TFTWIDTH_128;
+ } else if ((tabcolor == INITR_MINI160x80) || (tabcolor == INITR_MINI160x80_RS)) {
+ _width = ST7735_TFTHEIGHT_160;
+ _height = ST7735_TFTWIDTH_80;
+ } else {
+ _width = ST7735_TFTHEIGHT_160;
+ _height = ST7735_TFTWIDTH_128;
+ }
+ ystart = colstart;
+ xstart = rowstart;
+ break;
+ case 2:
+ if ((tabcolor == INITR_BLACKTAB) || (tabcolor == INITR_MINI160x80)) {
+ writedata(MADCTL_RGB);
+ } else if (tabcolor == INITR_MINI160x80_RS) {
+ writedata(MADCTL_BGR);
+ } else {
+ writedata(MADCTL_BGR);
+ }
+
+ if (tabcolor == INITR_144GREENTAB) {
+ _height = ST7735_TFTHEIGHT_128;
+ _width = ST7735_TFTWIDTH_128;
+ } else if ((tabcolor == INITR_MINI160x80) || (tabcolor == INITR_MINI160x80_RS)) {
+ _height = ST7735_TFTHEIGHT_160;
+ _width = ST7735_TFTWIDTH_80;
+ } else {
+ _height = ST7735_TFTHEIGHT_160;
+ _width = ST7735_TFTWIDTH_128;
+ }
+ xstart = colstart;
+ ystart = rowstart;
+ break;
+ case 3:
+ if ((tabcolor == INITR_BLACKTAB) || (tabcolor == INITR_MINI160x80)) {
+ writedata(MADCTL_MX | MADCTL_MV | MADCTL_RGB);
+ } else if (tabcolor == INITR_MINI160x80_RS) {
+ writedata(MADCTL_MX | MADCTL_MV | MADCTL_BGR);
+ } else {
+ writedata(MADCTL_MX | MADCTL_MV | MADCTL_BGR);
+ }
+
+ if (tabcolor == INITR_144GREENTAB) {
+ _width = ST7735_TFTHEIGHT_128;
+ _height = ST7735_TFTWIDTH_128;
+ } else if ((tabcolor == INITR_MINI160x80) || (tabcolor == INITR_MINI160x80_RS)) {
+ _width = ST7735_TFTHEIGHT_160;
+ _height = ST7735_TFTWIDTH_80;
+ } else {
+ _width = ST7735_TFTHEIGHT_160;
+ _height = ST7735_TFTWIDTH_128;
+ }
+ ystart = colstart;
+ xstart = rowstart;
+ break;
+ }
+}
+
+void ST7735::invertDisplay(boolean i)
+{
+ writecommand(i ? ST7735_INVON : ST7735_INVOFF);
+}
+
+void ST7735::DrawBMP(int offsetx, int offsety, FILE *Image)
+{
+ uint32_t index = 0, width = 0, height = 0;
+ int i=0, x, y, byteCour;
+
+ int fpOffset = ftell(Image);
+ //output1.printf("current cursor : %02x\n", ftell(Image));
+ //output1.printf("first bytes bmp : %02x\n", fgetc(Image));
+
+ /* Get bitmap data address offset */
+ fseek(Image, 10+fpOffset , SEEK_SET );
+ index = fgetc(Image);
+ //output1.printf("index : 0x%02x ; ", index);
+
+ /* Read bitmap width */
+ fseek(Image, 18+fpOffset , SEEK_SET );
+ width = fgetc(Image);
+ width += fgetc(Image)<<8;
+ width += fgetc(Image)<<16;
+ width += fgetc(Image)<<24;
+ //output1.printf("width : %d ; ", width);
+
+ /* Read bitmap height */
+ fseek(Image, 22+fpOffset , SEEK_SET );
+ height = fgetc(Image);
+ height += fgetc(Image)<<8;
+ height += fgetc(Image)<<16;
+ height += fgetc(Image)<<24;
+ //output1.printf("height : %d\n", height);
+
+ fseek(Image, index+fpOffset , SEEK_SET );
+
+ byteCour = fgetc(Image);
+ byteCour += fgetc(Image)<<8;
+
+ for (y = height+offsety; offsety < y; y--) {
+ setAddrWindow(offsetx, y, offsetx+width-1, y);
+ _rs = 1;
+ _cs = 0;
+
+ for (x = 0; x < width; x++) {
+ if(x == width-1) fseek(Image, width%2, SEEK_CUR);
+
+ if(x <= width && y >= 0) {
+ lcdPort.write(byteCour>>8); // one line
+ lcdPort.write(byteCour);
+ }
+ _cs = 1;
+ byteCour = fgetc(Image);
+ byteCour += fgetc(Image)<<8;
+ _cs = 0;
+ }
+ }
+ _cs = 1;
+}
+
+// use imageconverter565.exe to generate bitmap array and put it in bitmap.c
+void ST7735::DrawRam(unsigned int x, unsigned int y, unsigned int w, unsigned int h, int *Image) {
+ unsigned int i,j;
+ setAddrWindow(x, y, x+w-1, y+h);
+ _rs = 1;
+ _cs = 0;
+ for (j = 0; j < h; j++) { //Lines
+ for (i = 0; i < w; i++) { // copy pixel data to TFT
+ lcdPort.write(*Image>>8); // one line
+ lcdPort.write(*Image);
+ *Image++;
+ }
+ }
+ _cs = 1;
+}
+
+void ST7735::DrawGIF(int offsetx, int offsety, FILE *Image) {
+
+ uint32_t width = 0, height = 0;
+ uint16_t code, preCode, clearCode, endCode, sizePalette;
+ uint8_t r, v, b, pxl, pxls[256];
+ int i, j;
+ int fpOffset = ftell(Image);
+
+ // palette
+ uint16_t table[750][17];
+ for(int i = 0; i < 750; i++)
+ for(int j = 0; j < 17; j++)
+ table[i][j] = NULL;
+
+ // Read bitmap width
+ fseek(Image, 6+fpOffset , SEEK_SET );
+ width = fgetc(Image);
+ width += fgetc(Image);
+ //output1.printf("width : %d ; ", width);
+
+ // Read bitmap height
+ fseek(Image, 8+fpOffset , SEEK_SET );
+ height = fgetc(Image);
+ height += fgetc(Image);
+ //output1.printf("height : %d\n", height);
+
+ // Get size of palette
+ fseek(Image, 10+fpOffset , SEEK_SET );
+ sizePalette = fgetc(Image)<<5;
+ sizePalette = ((uint8_t) sizePalette)>>5;
+ sizePalette = pow(2, sizePalette+1.0);
+
+ // Get palette
+ uint16_t palette[sizePalette];
+ fseek(Image, 13+fpOffset , SEEK_SET );
+ for(i=0; i < sizePalette; i++) {
+ r = fgetc(Image);
+ v = fgetc(Image);
+ b = fgetc(Image);
+
+ // palette simple
+ palette[i] = Color565(r, v, b);
+ table[i][0] = 1;table[i][1] = i;
+ }
+
+ preCode = i;
+ table[i][0] = i;
+ clearCode = i;
+ table[i+1][0] = i+1;
+ endCode = i+1;
+
+ // Find Image separator
+ while(1) {
+ pxl = fgetc(Image);
+ if(0x2C == pxl) break;
+ }
+
+ // Get minimal size of code
+ fseek(Image, 9 , SEEK_CUR );
+ uint8_t sizeCode = fgetc(Image);sizeCode++;
+
+ // Get size of block
+ uint8_t sizeBlock = fgetc(Image);
+ output1.printf("taille du block : %d\n", sizeBlock);
+
+ setAddrWindow(offsetx, offsety, offsetx+width-1, offsety+height);
+ _rs = 1;
+ _cs = 0;
+
+ // image data
+ uint16_t imgByte = fgetc(Image);
+ int sizeImgByte = 8;
+ int16_t index = sizePalette;
+ for(i=0; i < sizeBlock; ) {
+
+ // ajout d'un octet pour le calcul du prochain code
+ while(sizeImgByte < sizeCode) {
+ pxl = fgetc(Image);
+ i++;
+ if(sizeBlock == 0xff && i == sizeBlock) {
+ i = 0;
+ sizeBlock = pxl;
+ pxl = fgetc(Image);
+ }
+ imgByte = (pxl<<(sizeImgByte)) + bitExtracted(imgByte, sizeImgByte, 1);
+ sizeImgByte += 8;
+ }
+
+ // extraction du code
+ code = bitExtracted(imgByte, sizeCode, 1);
+
+ //output1.printf(">%03x; %03x; %03x; ", code, preCode, index);
+
+ //////////////////////
+ // traitement image //
+ //////////////////////
+
+ if(code == clearCode) index = sizePalette;
+ else if(code == endCode) break;
+ else {
+
+ // sauf si premier code : chargement du "pixel string" du precode
+ if(preCode != clearCode){
+ for(j=0; j < table[preCode][0];j++)
+ pxls[j] = table[preCode][j+1];
+ }
+
+ // si code connu :
+ if(code < index) {
+
+ for(int k=1; k <= table[code][0];k++) {
+ if(k==1) pxls[j] = table[code][k];
+
+ lcdPort.write((uint8_t) (palette[ table[code][k] ]>>8));
+ lcdPort.write((uint8_t) palette[ table[code][k] ]);
+ }
+
+ for(int k=1; k <= j+1; k++)
+ table[index][k] = pxls[k-1];
+
+ table[index][0] = j+1;
+
+
+ } else {
+
+ // add new stream pixel in palette and display
+ pxl = pxls[0];
+ pxls[j] = pxl;
+ for(int k=1; k <= j+1; k++) {
+ table[index][k] = pxls[k-1];
+
+ lcdPort.write((uint8_t) (palette[ pxls[k-1] ]>>8));
+ lcdPort.write((uint8_t) palette[ pxls[k-1] ]);
+
+ }
+ table[index][0] = j+1;
+ }
+
+ // clear buffer string
+ for(int k=0; k < 256; k++) pxls[k] = 0;
+ }
+
+ preCode = code;
+
+ // to compute next code
+ sizeImgByte -= sizeCode;
+ imgByte = bitExtracted(imgByte, sizeImgByte, sizeCode+1);
+
+ if( index == (pow(2, sizeCode*1.0)-1)) sizeCode++;
+
+ index++;
+ }
+
+ _cs = 1;
+
+}
+
+void ST7735::DrawANI(int offsetx, int offsety, FILE *Anim, int frame) {
+
+ int i;
+ char buf[32];
+ char sizeStr[12];
+ char *valExit = "error";
+ char namefile[32];
+ int size, offset = 0;
+
+ sprintf(namefile, "%d.bmp", frame);
+
+ while(!feof(Anim)) {
+ for(i=0; i <= strlen(namefile); i++) buf[i] = fgetc(Anim);
+
+ if(!strcmp(buf, namefile)) {
+ valExit = "";
+ break;
+ }
+
+ fseek(Anim , 124+offset , SEEK_SET);
+ for(i=0; i < 12; i++) sizeStr[i] = fgetc(Anim);
+ //printf("size string: %s; octal: %d; dec.: %x\n", sizeStr, atoi(sizeStr), oct2dec(atoi(sizeStr)) );
+
+ size = oct2dec(atoi(sizeStr));
+ if(offset % 512 != 0) offset += (size/512 + 2)*512;
+ else offset += (size/512 + 1)*512;
+
+ fseek(Anim , offset , SEEK_SET);
+ }
+
+ if(valExit == "error") {
+ printf("file \"%s\" not find in tar\n", namefile);
+ //return NULL;
+ } else {
+ fseek(Anim, offset+512 , SEEK_SET);
+
+ DrawBMP(offsetx, offsety, Anim);
+
+ //return 1;
+ }
+
+
+}
+
+void ST7735::scrollBmp(uint8_t top_fix_height, uint8_t bottom_fix_height, int _scroll_direction, int *bitmap) {
+ unsigned int i, startOffset, endOffset;// line = 0;
+ float a, b;
+
+ a = 7.7142*pow( 162.0-(top_fix_height+bottom_fix_height), -2.0 );
+ b = 8.0717*pow( 162.0-(top_fix_height+bottom_fix_height), -1.0 );
+
+ if(!_orientation) _scroll_direction = !_scroll_direction;
+
+ if((_scroll_direction && _orientation == 2) || (!_scroll_direction && !_orientation)) {
+ for (i = 0; i < 3248; i++) *bitmap++;
+ }
+
+ if((!_scroll_direction && _orientation == 2) || (_scroll_direction && !_orientation)) {
+ startOffset = top_fix_height;
+ endOffset = bottom_fix_height+1;
+ } else {
+ startOffset = bottom_fix_height;
+ endOffset = top_fix_height+1;
+ }
+
+ if((_scroll_direction && _orientation == 2) || (!_scroll_direction && !_orientation)) setScrollDefinition(bottom_fix_height, top_fix_height+1, _scroll_direction);
+ else setScrollDefinition(top_fix_height+1, bottom_fix_height, _scroll_direction);
+
+ for( int scroll = 1+startOffset; scroll <= 162-endOffset ; scroll++){
+
+ VerticalScroll(scroll);
+
+ if(scroll >=(53) && scroll <=109) {
+ if(_orientation == 0){
+ if(_scroll_direction) {
+ drawFastHLine(0, 162-(scroll)-2, 80, ST7735_BLACK);
+
+ for (i = 0; i < 57; i++) {
+ drawPixel(57+11-i, 162-(scroll)-2, *bitmap);
+ *bitmap++;
+ }
+ } else {
+ drawFastHLine(0, scroll-2, 80, ST7735_BLACK);
+
+ for (i = 0; i < 57; i++) {
+ drawPixel(12+i, scroll-2, *bitmap);
+ *bitmap--;
+ }
+ }
+ } else if(_orientation == 2) {
+ if(_scroll_direction) {
+ drawFastHLine(0, 162-scroll-1, 80, ST7735_BLACK);
+
+ for (i = 0; i < 57; i++) {
+ drawPixel(57+10-i,162-scroll-1, *bitmap);
+ *bitmap--;
+ }
+ } else {
+ drawFastHLine(0, scroll-1, 80, ST7735_BLACK);
+
+ for (i = 0; i < 57; i++) {
+ drawPixel(11+i,scroll-1, *bitmap);
+ *bitmap++;
+ }
+ }
+ }
+ }
+
+ float tempo = (a*scroll*scroll)-b*scroll+2.9408;
+ wait_ms(tempo);
+ //wait(0.1);
+ }
+ if(!_orientation) setRotation(0);
+ VerticalScroll(0);
+}
+
+int ST7735::oct2dec(int n) /* Function to convert octal to decimal */
+{
+ int decimal=0, i=0, rem;
+ while (n!=0)
+ {
+ rem = n%10;
+ n/=10;
+ decimal += rem*pow(8.0,i);
+ ++i;
+ }
+ return decimal;
+}
+
+int ST7735::bitExtracted(int number, int k, int p)
+{
+ return (((1 << k) - 1) & (number >> (p - 1)));
+}
+
+void ST7735::makeTable(void) {
+ remove("/sd/table.csv");
+ remove("/sd/pointers.csv");
+ FILE *table = fopen("/sd/table.csv", "w");
+ FILE *pointers = fopen("/sd/pointers.csv", "w");
+ fclose(table);
+ fclose(pointers);
+}
+
+uint16_t ST7735::readTable(unsigned int y, unsigned int x) {
+
+ FILE *table = fopen("/sd/table.csv", "r");
+ FILE *pointers = fopen("/sd/pointers.csv", "r");
+ char out[3];
+ char ptr[17];
+
+ fseek(pointers , y*17 , SEEK_SET);
+ //output1.printf("%d: ", y);
+ for(int i=0; i < 17; i++) {
+ ptr[i] = fgetc(pointers);
+ //output1.printf("%c", ptr[i]);
+ }
+ //output1.printf("\n%s>>%d\n", ptr, atoi(ptr));
+
+ // utiliser pointers
+ //for(int i=0; i < y;)
+ //if(fgetc(table) == 0x0A) i++;
+ fseek(table , atoi(ptr) , SEEK_SET);
+
+ for(int i=0; i < x;)
+ if(fgetc(table) == 0x3B) i++;
+
+ out[0] = fgetc(table);
+ out[1] = fgetc(table);
+ out[2] = fgetc(table);
+
+ //output1.printf("%s>>%x ", out, atoi(out));
+
+ fclose(table);
+ fclose(pointers);
+ return atoi(out);
+}
+
+void ST7735::addrowTable(uint16_t *row) {
+
+ int size;
+
+ FILE *table = fopen("/sd/table.csv", "r");
+ fseek(table , 0 , SEEK_END);
+ size = ftell(table);
+ fclose(table);
+
+ table = fopen("/sd/table.csv", "a");
+ for(int i = 0; i< row[0]+1; i++)
+ fprintf(table, "%03d;", row[i]);
+ fprintf(table, "\n");
+
+ FILE *pointers = fopen("/sd/pointers.csv", "a");
+ fprintf(pointers, "%16d\n", size);
+
+ fclose(table);
+ fclose(pointers);
+}
+
+void ST7735::init_star(STAR* star, int i)
+ {
+ /* randomly init stars, generate them around the center of the screen */
+
+ star->xpos = -10.0 + (20.0 * (rand()/(RAND_MAX+1.0)));
+ star->ypos = -10.0 + (20.0 * (rand()/(RAND_MAX+1.0)));
+
+ star->xpos *= 3072.0; /*change viewpoint */
+ star->ypos *= 3072.0;
+
+ star->zpos = i;
+ star->speed = 2 + (int)(2.0 * (rand()/(RAND_MAX+1.0)));
+
+ star->color = i*ST7735_WHITE >> 2; /*the closer to the viewer the brighter*/
+ }
+
+void ST7735::DrawStarfield(int centerx, int centery, int acc, int color, int NbrsStars, int duration)
+{
+ int i, j=0, tempx, tempy;
+ STAR stars[NbrsStars];
+ Timer timerStars;
+
+ timerStars.start();
+ while(timerStars.read() < duration) {
+
+ j++;
+
+ // move and draw stars
+
+ for (i = 0; i < NbrsStars; i++) {
+ tempx = (stars[i].xpos / stars[i].zpos) + centerx;
+ tempy = (stars[i].ypos / stars[i].zpos) + centery;
+ drawPixel(tempx,tempy, ST7735_BLACK);
+
+
+ stars[i].zpos -= stars[i].speed*acc;
+
+ if (stars[i].zpos <= 0) {
+ init_star(stars + i, i + 1);
+ }
+
+ //compute 3D position
+ tempx = (stars[i].xpos / stars[i].zpos) + centerx;
+ tempy = (stars[i].ypos / stars[i].zpos) + centery;
+
+ if (tempx < 0 || tempx > _width - 1 || tempy < 0 || tempy > _height - 1) { //check if a star leaves the screen
+
+ init_star(stars + i, i + 1);
+ continue;
+ }
+
+ if(color) drawPixel(tempx,tempy,color);
+ else drawPixel(tempx,tempy,stars[i].color);
+
+ }
+ }
+
+ timerStars.stop();
+}
+
+void ST7735::setScrollDefinition(uint8_t top_fix_height, uint8_t bottom_fix_height, int _scroll_direction){
+ uint8_t scroll_height;
+ scroll_height = _height - top_fix_height - bottom_fix_height;
+ writecommand(ST7735_VSCRDEF);
+ writedata(0x00);
+ writedata(top_fix_height);
+ writedata(0x00);
+ writedata(scroll_height);
+ writedata(0x00);
+ writedata(bottom_fix_height);
+ writecommand(ST7735_MADCTL);
+ if(_scroll_direction){
+ if(_tft_type == 0){
+ writedata(0xD8);
+ }
+ if(_tft_type == 1){
+ writedata(0xD0);
+ }
+ if(_tft_type == 2){
+ writedata(0x18);
+ }
+ }
+ else{
+ if(_tft_type == 0){
+ writedata(0xC8);
+ }
+ if(_tft_type == 1){
+ writedata(0xC0);
+ }
+ if(_tft_type == 2){
+ writedata(0x08);
+ }
+ }
+}
+void ST7735::VerticalScroll(uint8_t _vsp) {
+ writecommand(ST7735_VSCRSADD);
+ writedata(0x00);
+ writedata(_vsp);
+}
+
+//void ST7735::read_area(unsigned int x, unsigned int y, unsigned int w, unsigned int h, unsigned char *buffer) {
+void ST7735::read_area(unsigned int x, unsigned int y, unsigned int w, unsigned int h) {
+ // BEWARE !
+ // DOES NOT WORK CORRECTLY YET !!!
+ int val;
+ setAddrWindow2(x,y,w,h);
+ writecommand(ST7735_RAMRD); // write to RAM
+ _cs = 0;
+ _rs = 1;
+ lcdPort.write(0); /* Dummy read 1 */
+
+ val = lcdPort.write(0); /* Read D8..D15 */
+ val <<= 8;
+ val |= lcdPort.write(0); /* Read D0..D7 */
+ _cs = 1;
+ output1.printf("%d ", val);
+
+
+
+}
+
+
+void ST7735::setAddrWindow2(uint8_t x0, uint8_t y0, uint8_t x1,
+ uint8_t y1)
+{
+
+ writecommand(ST7735_CASET); // Column addr set
+ writedata(0x00);
+ writedata(x0+xstart); // XSTART
+ writedata(0x00);
+ writedata(x1+xstart); // XEND
+
+ writecommand(ST7735_RASET); // Row addr set
+ writedata(0x00);
+ writedata(y0+ystart); // YSTART
+ writedata(0x00);
+ writedata(y1+ystart); // YEND
+
+ //writecommand(ST7735_RAMWR); // write to RAM
+}
+
+