skydarc meneldoll
/
test_TFT_11_v5
test st7735 on lpc1768 with mbed v5. bug with spi frequency...
ST7735/ST7735.cpp
- Committer:
- skydarc
- Date:
- 2020-04-08
- Revision:
- 2:2946f9eefcae
File content as of revision 2:2946f9eefcae:
/*************************************************** 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 }