Imayan chan
aitendo T18003T01-V2,TFT1.8,SPI,FRDM-KL25Z
Dependents: FRDM_SPI18TFT_demo
Fork of
ST7735_TFT
by 
Jonne Valola
Diff: ST7735_TFT.cpp
- Revision:
- 2:047ca9682450
- Parent:
- 1:967235e6fd48
--- a/ST7735_TFT.cpp Sun Dec 11 21:18:21 2011 +0000
+++ /dev/null Thu Jan 01 00:00:00 1970 +0000
@@ -1,814 +0,0 @@
- /* mbed library for 128*160 pixel display TFT based on ST7735 LCD Controller
- * ST7735 specific routines (initialization, window addressing, pixel output)
- * Copyright (c) 2011 Jonne Valola
- *
- * WARNING !! WORK IN PROGRESS !!!
- *
- * Graphics routines and SPI routines derived work used with permission from:
- * mbed library for 240*320 pixel display TFT based on HX8347D LCD Controller
- * Copyright (c) 2011 Peter Drescher - DC2PD
- *
- * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
- * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
- * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
- * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
- * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
- * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
- * THE SOFTWARE.
- */
-
-
-#include "ST7735_TFT.h"
-#include "mbed.h"
-
-#define BPP 16 // Bits per pixel
-
-ST7735_TFT::ST7735_TFT(PinName mosi, PinName miso, PinName sclk, PinName cs, PinName rs, PinName reset, const char *name)
- : _spi(mosi, miso, sclk), _cs(cs), _rs(rs), _reset(reset),GraphicsDisplay(name) {
- tft_reset();
- orientation = 2;
- char_x = 0;
-}
-
-
-int ST7735_TFT::width() {
- if (orientation == 0 || orientation == 2) return 128;
- else return 160;
-}
-
-
-int ST7735_TFT::height() {
- if (orientation == 0 || orientation == 2) return 160;
- else return 128;
-}
-
-
-void ST7735_TFT::set_orientation(unsigned int o) {
- orientation = o;
- switch (orientation) {
- case 0:
- wr_reg(ST7735_MADCTL, 0x0008);
- break;
- case 1:
- wr_reg(ST7735_MADCTL, 0x0068);
- break;
- case 2:
- wr_reg(ST7735_MADCTL, 0x00C8);
- break;
- case 3:
- wr_reg(ST7735_MADCTL, 0x00A8);
- break;
- }
-}
-
-
-
-void ST7735_TFT::wr_cmd(int cmd) {
- _rs = 0; // rs low, cs low for transmitting command
- _cs = 0;
- _spi.write(cmd);
- _cs = 1;
-}
-
-
-
-void ST7735_TFT::wr_dat(int dat) {
- _rs = 1; // rs high, cs low for transmitting data
- _cs = 0;
- _spi.write(dat);
- _cs = 1;
-}
-
-
-
-void ST7735_TFT::wr_dat_start(void) {
- _rs = 1; // rs high, cs low for transmitting data
- _cs = 0;
-}
-
-
-
-void ST7735_TFT::wr_dat_stop (void) {
- _cs = 1;
-}
-
-
-
-void ST7735_TFT::wr_dat_only (unsigned short dat) {
- _spi.write(dat);
-}
-
-
-unsigned short ST7735_TFT::rd_dat (void) {
- unsigned short val = 0;
- _cs = 0;
- _spi.write(0); /* Dummy read 1 */
- val = _spi.write(0); /* Read D8..D15 */
- val <<= 8;
- val |= _spi.write(0); /* Read D0..D7 */
- _cs = 1;
- return (val);
-}
-
-void ST7735_TFT::wr_reg (unsigned char reg, unsigned short val) {
-
- wr_cmd(reg);
- wr_dat(val);
-}
-
-
-unsigned short ST7735_TFT::rd_reg (unsigned char reg) {
-
- wr_cmd(reg);
- return(rd_dat());
-}
-
-void ST7735_TFT::read_area(unsigned int x, unsigned int y, unsigned int w, unsigned int h,unsigned char *buffer) {
- // BEWARE !
- // DOES NOT WORK CORRECTLY YET !!!
- int val;
- window(x,y,w,h);
- wr_cmd(ST7735_RAMRD); // write to RAM
- _cs = 0;
- _rs = 1;
- _spi.write(0); /* Dummy read 1 */
-
- val = _spi.write(0); /* Read D8..D15 */
- val <<= 8;
- val |= _spi.write(0); /* Read D0..D7 */
- _cs = 1;
-}
-
-int ST7735_TFT::getpixel(unsigned int x, unsigned int y) {
- // BEWARE !
- // DOES NOT WORK CORRECTLY YET !!!
- int val;
- _spi.format(8,3);
- wr_cmd(ST7735_CASET); // column addr set
- wr_dat(0x00);
- wr_dat(x+2); // XSTART
- wr_dat(0x00);
- wr_dat(x+2+2); // XEND
-
- wr_cmd(ST7735_RASET); // row addr set
- wr_dat(0x00);
- wr_dat(y+1); // YSTART
- wr_dat(0x00);
- wr_dat(y+1+1); // YEND
-
- _rs = 0; // rs low, cs low for transmitting command
- _cs = 0;
- _spi.write(0x2E);
- _rs = 1;
- _spi.write(0x00); /* Dummy read 1 */
-
- val = _spi.write(0x00); /* Read D8..D15 */
- val <<= 8;
- val |= _spi.write(0x00); /* Read D0..D7 */
-
- _cs = 1;
- return val;
-}
-
-
-void ST7735_TFT::tft_reset() {
- static unsigned short driverCode;
-
- // init SPI
- _spi.format(8,3); // 8 bit spi mode 3
- _spi.frequency(16000000); // 16Mhz SPI clock ... 15Mhz is maximum for display, but it seems to work
-
- // reset exactly like in Arduino version
- _cs = 0;
- _reset = 1; // reset
- wait_ms(500);
- _reset = 0; // reset
- wait_ms(500);
- _reset = 1; // reset
- wait_ms(500);
-
- /* Start Initial Sequence ----------------------------------------------------*/
- wr_cmd(ST7735_SWRESET); /* SW Reset */
- wait_ms(150);
- wr_cmd(ST7735_SLPOUT); /* Out of sleepmode */
- wait_ms(500);
-
- wr_cmd(ST7735_FRMCTR1); /* Frame rate in normal mode */
- wr_dat(0x01);
- wr_dat(0x2C);
- wr_dat(0x2D);
-
- wr_cmd(ST7735_FRMCTR2); /* Frame rate in idle mode */
- wr_dat(0x01);
- wr_dat(0x2C);
- wr_dat(0x2D);
-
- wr_cmd(ST7735_FRMCTR3); /* Frame rate in partial mode */
- wr_dat(0x01);
- wr_dat(0x2C);
- wr_dat(0x2D);
- wr_dat(0x01); // inversion mode settings
- wr_dat(0x2C);
- wr_dat(0x2D);
-
- wr_cmd(ST7735_INVCTR); // Inverted mode off
- wr_dat(0x07);
-
- wr_cmd(ST7735_PWCTR1); // POWER CONTROL 1
- wr_dat(0xA2);
- wr_dat(0x02); // -4.6V
- wr_dat(0x84); // AUTO mode
-
- wr_cmd(ST7735_PWCTR2); // POWER CONTROL 2
- wr_dat(0xC5); // VGH25 = 2.4C VGSEL =-10 VGH = 3*AVDD
-
- wr_cmd(ST7735_PWCTR3); // POWER CONTROL 3
- wr_dat(0x0A); // Opamp current small
- wr_dat(0x00); // Boost freq
-
- wr_cmd(ST7735_PWCTR4); // POWER CONTROL 4
- wr_dat(0x8A); // BCLK/2, Opamp current small / medium low
- wr_dat(0x2A); //
-
- wr_cmd(ST7735_PWCTR5); // POWER CONTROL 5
- wr_dat(0x8A); // BCLK/2, Opamp current small / medium low
- wr_dat(0xEE); //
-
- wr_cmd(ST7735_VMCTR1); // POWER CONTROL 6
- wr_dat(0x0E); //
-
- wr_cmd(ST7735_INVOFF); // INVOFF
-
- wr_cmd(ST7735_MADCTL); // ORIENTATION
- wr_dat(0xC8); //
-
- wr_cmd(ST7735_COLMOD); // COLOR MODE
- wr_dat(0x05); //
-
- wr_cmd(ST7735_CASET); // COLUMN ADDR SET
- wr_dat(0x00); //
- wr_dat(0x00); // xstart = 0
- wr_dat(0x00); //
- wr_dat(0x7F); // xend = 127
-
- wr_cmd(ST7735_RASET); // ROW ADDR SET
- wr_dat(0x00); //
- wr_dat(0x00); // ystart = 0
- wr_dat(0x00); //
- wr_dat(0x9F); // yend = 159
-
- /* Gamma settings -----------------------------------------------------------*/
-
- wr_cmd(0xE0); // GMCTRP1
- wr_dat(0x02);
- wr_dat(0x1c);
- wr_dat(0x07);
- wr_dat(0x12);
- wr_dat(0x37);
- wr_dat(0x32);
- wr_dat(0x29);
- wr_dat(0x2d);
- wr_dat(0x29);
- wr_dat(0x25);
- wr_dat(0x2B);
- wr_dat(0x39);
- wr_dat(0x00);
- wr_dat(0x01);
- wr_dat(0x03);
- wr_dat(0x10);
- wr_cmd(0xE1); // GMCTRN1
- wr_dat(0x03);
- wr_dat(0x1d);
- wr_dat(0x07);
- wr_dat(0x06);
- wr_dat(0x2E);
- wr_dat(0x2C);
- wr_dat(0x29);
- wr_dat(0x2D);
- wr_dat(0x2E);
- wr_dat(0x2E);
- wr_dat(0x37);
- wr_dat(0x3F);
- wr_dat(0x00);
- wr_dat(0x00);
- wr_dat(0x02);
- wr_dat(0x10);
-
- wr_cmd(ST7735_DISPON); // display ON
- wait_ms(100);
-
- wr_cmd(ST7735_NORON); // normal display on
- wait_ms(10);
-
- switch (orientation) {
- case 0:
- wr_reg(0xC8, 0x0008);
- break;
- case 1:
- wr_reg(0xC8, 0x0068);
- break;
- case 2:
- wr_reg(0xC8, 0x00C8);
- break;
- case 3:
- wr_reg(0xC8, 0x00A8);
- break;
- }
- WindowMax ();
-}
-
-
-void ST7735_TFT::pixel(int x, int y, int color) {
- if ((x >= width()) || (y >= height())) return;
-
- window(x,y,x+1,y+1);
-
- // setup for data
- _rs = 1;
- _cs = 0;
- _spi.format(16,3);
- _spi.write(color);
- _cs = 1;
- _spi.format(8,3);
-}
-
-void ST7735_TFT::window (unsigned int x, unsigned int y, unsigned int w, unsigned int h) {
- wr_cmd(ST7735_CASET); // column addr set
- wr_dat(0x00);
- wr_dat(x+2); // XSTART
- wr_dat(0x00);
- wr_dat(x+w+1); // XEND
-
- wr_cmd(ST7735_RASET); // row addr set
- wr_dat(0x00);
- wr_dat(y+1); // YSTART
- wr_dat(0x00);
- wr_dat(y+h+1); // YEND
-
- wr_cmd(ST7735_RAMWR); // write to RAM
-}
-
-
-void ST7735_TFT::WindowMax (void) {
- window (0, 0, width(), height());
-}
-
-
-void ST7735_TFT::cls (void) {
- unsigned int i;
- WindowMax();
- wr_dat_start();
- _spi.format(16,3);
- for (i = 0; i < ( (width()+1) * (height()+3)); i++) {
- _spi.write(_background);
- }
- _spi.format(8,3);
- wr_dat_stop();
-}
-
-
-void ST7735_TFT::circle(int x0, int y0, int r, int color) {
-
- int draw_x0, draw_y0;
- int draw_x1, draw_y1;
- int draw_x2, draw_y2;
- int draw_x3, draw_y3;
- int draw_x4, draw_y4;
- int draw_x5, draw_y5;
- int draw_x6, draw_y6;
- int draw_x7, draw_y7;
- int xx, yy;
- int di;
- WindowMax();
- if (r == 0) { /* no radius */
- return;
- }
-
- draw_x0 = draw_x1 = x0;
- draw_y0 = draw_y1 = y0 + r;
- if (draw_y0 < height()) {
- pixel(draw_x0, draw_y0, color); /* 90 degree */
- }
-
- draw_x2 = draw_x3 = x0;
- draw_y2 = draw_y3 = y0 - r;
- if (draw_y2 >= 0) {
- pixel(draw_x2, draw_y2, color); /* 270 degree */
- }
-
- draw_x4 = draw_x6 = x0 + r;
- draw_y4 = draw_y6 = y0;
- if (draw_x4 < width()) {
- pixel(draw_x4, draw_y4, color); /* 0 degree */
- }
-
- draw_x5 = draw_x7 = x0 - r;
- draw_y5 = draw_y7 = y0;
- if (draw_x5>=0) {
- pixel(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) ) {
- pixel(draw_x0, draw_y0, color);
- }
-
- if ( (draw_x1 >= 0) && (draw_y1 >= 0) ) {
- pixel(draw_x1, draw_y1, color);
- }
-
- if ( (draw_x2 <= width()) && (draw_y2 <= height()) ) {
- pixel(draw_x2, draw_y2, color);
- }
-
- if ( (draw_x3 >=0 ) && (draw_y3 <= height()) ) {
- pixel(draw_x3, draw_y3, color);
- }
-
- if ( (draw_x4 <= width()) && (draw_y4 >= 0) ) {
- pixel(draw_x4, draw_y4, color);
- }
-
- if ( (draw_x5 >= 0) && (draw_y5 >= 0) ) {
- pixel(draw_x5, draw_y5, color);
- }
- if ( (draw_x6 <=width()) && (draw_y6 <= height()) ) {
- pixel(draw_x6, draw_y6, color);
- }
- if ( (draw_x7 >= 0) && (draw_y7 <= height()) ) {
- pixel(draw_x7, draw_y7, color);
- }
- }
- return;
-}
-
-void ST7735_TFT::fillcircle(int x, int y, int r, int color) {
- int i;
- for (i = 0; i <= r; i++)
- circle(x,y,i,color);
-}
-
-
-
-void ST7735_TFT::hline(int x0, int x1, int y, int color) {
- int w;
- w = x1 - x0 + 1;
- window(x0,y,w,1);
- wr_cmd(0x2C);
- wr_dat_start();
- for (int x=0; x<w; x++) {
- _spi.write(color);
- _spi.write(color >> 8);
- }
- wr_dat_stop();
- return;
-}
-
-
-
-void ST7735_TFT::vline(int x, int y0, int y1, int color) {
- int h;
- h = y1 - y0 + 1;
- window(x,y0,1,h);
- wr_cmd(0x2C);
- wr_dat_start();
- for (int y=0; y<h; y++) {
- _spi.write(color);
- _spi.write(color >> 8);
- }
- wr_dat_stop();
- return;
-}
-
-
-
-void ST7735_TFT::line(int x0, int y0, int x1, int y1, int color) {
- WindowMax();
- int dx = 0, dy = 0;
- int dx_sym = 0, dy_sym = 0;
- int dx_x2 = 0, dy_x2 = 0;
- int di = 0;
-
- dx = x1-x0;
- dy = y1-y0;
-
- if (dx == 0) { /* vertical line */
- if (y1 > y0) vline(x0,y0,y1,color);
- else vline(x0,y1,y0,color);
- return;
- }
-
- if (dx > 0) {
- dx_sym = 1;
- } else {
- dx_sym = -1;
- }
- if (dy == 0) { /* horizontal line */
- if (x1 > x0) hline(x0,x1,y0,color);
- else hline(x1,x0,y0,color);
- return;
- }
-
- if (dy > 0) {
- dy_sym = 1;
- } else {
- dy_sym = -1;
- }
-
- dx = dx_sym*dx;
- dy = dy_sym*dy;
-
- dx_x2 = dx*2;
- dy_x2 = dy*2;
-
- if (dx >= dy) {
- di = dy_x2 - dx;
- while (x0 != x1) {
-
- pixel(x0, y0, color);
- x0 += dx_sym;
- if (di<0) {
- di += dy_x2;
- } else {
- di += dy_x2 - dx_x2;
- y0 += dy_sym;
- }
- }
- pixel(x0, y0, color);
- } else {
- di = dx_x2 - dy;
- while (y0 != y1) {
- pixel(x0, y0, color);
- y0 += dy_sym;
- if (di < 0) {
- di += dx_x2;
- } else {
- di += dx_x2 - dy_x2;
- x0 += dx_sym;
- }
- }
- pixel(x0, y0, color);
- }
- return;
-}
-
-
-
-
-void ST7735_TFT::rect(int x0, int y0, int x1, int y1, int color) {
-
- if (x1 > x0) hline(x0,x1,y0,color);
- else hline(x1,x0,y0,color);
-
- if (y1 > y0) vline(x0,y0,y1,color);
- else vline(x0,y1,y0,color);
-
- if (x1 > x0) hline(x0,x1,y1,color);
- else hline(x1,x0,y1,color);
-
- if (y1 > y0) vline(x1,y0,y1,color);
- else vline(x1,y1,y0,color);
-
- return;
-}
-
-
-
-void ST7735_TFT::fillrect(int x0, int y0, int x1, int y1, int color) {
-
- int h = y1 - y0 + 1;
- int w = x1 - x0 + 1;
- int pixel = h * w;
- window(x0,y0,w,h);
- wr_cmd(0x2C);
- wr_dat_start();
- for (int p=0; p<pixel; p++) {
- _spi.write(color);
- _spi.write(color >> 8);
- }
- wr_dat_stop();
- return;
-}
-
-
-
-void ST7735_TFT::locate(int x, int y) {
- char_x = x;
- char_y = y;
-}
-
-
-
-int ST7735_TFT::columns() {
- return width() / font[1];
-}
-
-
-
-int ST7735_TFT::rows() {
- return height() / font[2];
-}
-
-
-
-int ST7735_TFT::_putc(int value) {
- if (value == '\n') { // new line
- char_x = 0;
- char_y = char_y + font[2];
- if (char_y >= height() - font[2]) {
- char_y = 0;
- }
- } else {
- character(char_x, char_y, value);
- }
- return value;
-}
-
-
-
-
-void ST7735_TFT::character(int x, int y, int c) {
- unsigned int hor,vert,offset,bpl,j,i,b;
- unsigned char* zeichen;
- unsigned char z,w;
-
- if ((c < 31) || (c > 127)) return; // test char range
-
- // read font parameter from start of array
- offset = font[0]; // bytes / char
- hor = font[1]; // get hor size of font
- vert = font[2]; // get vert size of font
- bpl = font[3]; // bytes per line
-
- if (char_x + hor > width()) {
- char_x = 0;
- char_y = char_y + vert;
- if (char_y >= height() - font[2]) {
- char_y = 0;
- }
- }
-
- window(char_x, char_y,hor,vert); // char box
- wr_cmd(0x2C);
- wr_dat_start();
- zeichen = &font[((c -32) * offset) + 4]; // start of char bitmap
- w = zeichen[0]; // width of actual char
- _spi.format(16,3); // pixel are 16 bit
-
- for (j=0; j<vert; j++) { // vert line
- for (i=0; i<hor; i++) { // horz line
- z = zeichen[bpl * i + ((j & 0xF8) >> 3)+1];
- b = 1 << (j & 0x07);
- if (( z & b ) == 0x00) {
- _spi.write(_background);
- } else {
- _spi.write(_foreground);
- }
- }
- }
- _spi.format(8,3); // 8 bit
- wr_dat_stop();
- if ((w + 2) < hor) { // x offset to next char
- char_x += w + 2;
- } else char_x += hor;
-}
-
-
-
-
-
-void ST7735_TFT::set_font(unsigned char* f) {
- font = f;
-}
-
-
-
-void ST7735_TFT::Bitmap(unsigned int x, unsigned int y, unsigned int w, unsigned int h,unsigned char *bitmap) {
- unsigned int i,j,value;
- unsigned short *bitmap_ptr = (unsigned short *)bitmap;
- window(x, y, w, h);
- wr_cmd(0x2C);
- wr_dat_start();
- for (j = 0; j < h; j++) { //Lines
- for (i = 0; i < w; i++) { // copy pixel data to TFT
- _spi.write(*bitmap_ptr); // one line
- _spi.write(*bitmap_ptr >> 8);
- bitmap_ptr++;
- }
- }
- wr_dat_stop();
-}
-
-
-int ST7735_TFT::BMP_16(unsigned int x, unsigned int y, const char *Name_BMP) {
-// BEWARE !
-// NOT TESTED
-#define OffsetPixelWidth 18
-#define OffsetPixelHeigh 22
-#define OffsetFileSize 34
-#define OffsetPixData 10
-#define OffsetBPP 28
-
- char filename[50];
- unsigned char BMP_Header[54];
- unsigned short BPP_t;
- unsigned int PixelWidth,PixelHeigh,start_data;
- unsigned int i,off;
- int padd,j;
- unsigned short *line;
-
- // get the filename
- LocalFileSystem local("local");
- sprintf(&filename[0],"/local/");
- i=7;
- while (*Name_BMP!='\0') {
- filename[i++]=*Name_BMP++;
- }
- FILE *Image = fopen((const char *)&filename[0], "r"); // open the bmp file
- if (!Image) {
- return(0); // error file not found !
- }
-
- fread(&BMP_Header[0],1,54,Image); // get the BMP Header
-
- if (BMP_Header[0] != 0x42 || BMP_Header[1] != 0x4D) { // check magic byte
- fclose(Image);
- return(-1); // error no BMP file
- }
-
- BPP_t = BMP_Header[OffsetBPP] + (BMP_Header[OffsetBPP + 1] << 8);
- if (BPP_t != 0x0010) {
- fclose(Image);
- return(-2); // error no 16 bit BMP
- }
-
- PixelHeigh = BMP_Header[OffsetPixelHeigh] + (BMP_Header[OffsetPixelHeigh + 1] << 8) + (BMP_Header[OffsetPixelHeigh + 2] << 16) + (BMP_Header[OffsetPixelHeigh + 3] << 24);
- PixelWidth = BMP_Header[OffsetPixelWidth] + (BMP_Header[OffsetPixelWidth + 1] << 8) + (BMP_Header[OffsetPixelWidth + 2] << 16) + (BMP_Header[OffsetPixelWidth + 3] << 24);
- if (PixelHeigh > height() + y || PixelWidth > width() + x) {
- fclose(Image);
- return(-3); // to big
- }
-
- start_data = BMP_Header[OffsetPixData] + (BMP_Header[OffsetPixData + 1] << 8) + (BMP_Header[OffsetPixData + 2] << 16) + (BMP_Header[OffsetPixData + 3] << 24);
-
- line = (unsigned short *) malloc (PixelWidth); // we need a buffer for a line
- if (line == NULL) {
- return(-4); // error no memory
- }
-
- // the lines are padded to multiple of 4 bytes
- padd = -1;
- do {
- padd ++;
- } while ((PixelWidth * 2 + padd)%4 != 0);
-
- window(x, y,PixelWidth,PixelHeigh);
- wr_cmd(0x2C);
- wr_dat_start();
- _spi.format(16,3);
- for (j = PixelHeigh - 1; j >= 0; j--) { //Lines bottom up
- off = j * (PixelWidth * 2 + padd) + start_data; // start of line
- fseek(Image, off ,SEEK_SET);
- fread(line,1,PixelWidth * 2,Image); // read a line - slow !
- for (i = 0; i < PixelWidth; i++) { // copy pixel data to TFT
- _spi.write(line[i]); // one 16 bit pixel
- }
- }
- _spi.format(8,3);
- wr_dat_stop();
- free (line);
- fclose(Image);
- return(1);
-}
\ No newline at end of file