This library is for Arduino TFT LCD Screen module.(for new LCD driver IC)
Dependents: ArduinoTFTLCDScreenSample_SPI18TFT
Fork of ST7735_TFT by
いきさつ
Arduino TFT LCD ScreenというLCD moduleをmbedで使用しました。(module詳細 switch science web)
このLCD moduleのLCD driver ICはST7735 ですが、複数のバージョンがあり、libraryとICのバージョンが合わないと正常に表示しません。
mbedにはこのICに対応したlibrary(ST7735_TFT)がありますが、私が入手したLCD moduleではICの種類が違うためか正常に動作しませんでした。幸い、switch scienceのwebにarduino用の対応libraryがあったので、これを元にmbedのlibrary(ST7735_TFT)に移植しました。
libraryの移植
移植元のArduino library
移植元はswitch science webにある置き換え用TFTライブラリ(Arduino IDE1.0.5用)を使用します。このファイルを解凍してできる、"Adfruit_ST7735.cpp"の230行目以降のGcmd[]配列が該当するdriver ICの設定データになります。
Adfruit_ST7735.cpp
・ ・ ・ Gcmd[] = { // Initialization commands for 7735B screens 19, // 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 100, // 255 = 500 ms delay 0x26 , 1, // 3: Set default gamma 0x04, // 16-bit color 0xb1, 2, // 4: Frame Rate 0x0b, 0x14, 0xc0, 2, // 5: VRH1[4:0] & VC[2:0] 0x08, 0x00, 0xc1, 1, // 6: BT[2:0] 0x05, 0xc5, 2, // 7: VMH[6:0] & VML[6:0] 0x41, 0x30, 0xc7, 1, // 8: LCD Driving control 0xc1, 0xEC, 1, // 9: Set pumping color freq 0x1b, 0x3a , 1 + DELAY, // 10: Set color format 0x55, // 16-bit color 100, 0x2a, 4, // 11: Set Column Address 0x00, 0x00, 0x00, 0x7f, 0x2b, 4, // 12: Set Page Address 0x00, 0x00, 0x00, 0x9f, 0x36, 1, // 12+1: Set Scanning Direction 0xc8, 0xb7, 1, // 14: Set Source Output Direciton 0x00, 0xf2, 1, // 15: Enable Gamma bit 0x00, 0xe0, 15 + DELAY, // 16: magic 0x28, 0x24, 0x22, 0x31, 0x2b, 0x0e, 0x53, 0xa5, 0x42, 0x16, 0x18, 0x12, 0x1a, 0x14, 0x03, 50, 0xe1, 15 + DELAY, // 17: more magic 0x17, 0x1b, 0x1d, 0x0e, 0x14, 0x11, 0x2c, 0xa5, 0x3d, 0x09, 0x27, 0x2d, 0x25, 0x2b, 0x3c, 50, 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 ・ ・ ・
移植先のmbed library
移植先となるmbed libraryはST7735_TFT libraryとなります。この中のST7735_TFT.cppのtft_reset() にIC設定データを追加します。追加したコードを区別するため"ST7735B"というdefine定義で条件コンパイルするようにしました。
追加したコードの最後にある"switch(orientation)"の節はarduinoのlibraryにはなく、mbedのlibraryから修正したものです。
ST7735_TFT.cpp
・ ・ ・ 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); #ifdef ST7735B //@ss /* Start Initial Sequence ----------------------------------------------------*/ wr_cmd(ST7735_SWRESET); /* SW Reset */ wait_ms(150); wr_cmd(ST7735_SLPOUT); /* Out of sleepmode */ wait_ms(500); wr_cmd(0x26); // 3: Set default gamma wr_dat(0x04); // 16-bit color wr_cmd(ST7735_FRMCTR1); /*4 Frame rate in normal mode */ wr_dat(0x0b); wr_dat(0x14); wr_cmd(0xc0); // 5 POWER CONTROL 1 wr_dat(0x08); wr_dat(0x00); wr_cmd(0xc1); // 6 POWER CONTROL 2 wr_dat(0x05); wr_cmd(0xC5); // POWER CONTROL 6 wr_dat(0x41); // wr_dat(0x30); wr_cmd(0xc7); // 8:LCD Driving control wr_dat(0xc1); wr_cmd(0xec); // 9:Set color format wr_dat(0x1b); // 16-bit color wr_cmd(0x3A); // COLOR MODE wr_dat(0x55); // wait_ms(100); wr_cmd(0x2a); // 11 COLUMN ADDR SET wr_dat(0x00); // wr_dat(0x00); // xstart = 0 wr_dat(0x00); // wr_dat(0x7F); // xend = 127 wr_cmd(0x2b); // ROW ADDR SET wr_dat(0x00); // wr_dat(0x00); // ystart = 0 wr_dat(0x00); // wr_dat(0x9F); // yend = 159 wr_cmd(0x36); // 13 Set Scanning Direction wr_dat(0xc8); wr_cmd(0xb7); // 14 Set Source Output Direction wr_dat(0x00); /* Gamma settings -----------------------------------------------------------*/ wr_cmd(0xE0); // GMCTRP1 wr_dat(0x28); wr_dat(0x24); wr_dat(0x22); wr_dat(0x31); wr_dat(0x2b); wr_dat(0x0e); wr_dat(0x53); wr_dat(0xa5); wr_dat(0x42); wr_dat(0x16); wr_dat(0x18); wr_dat(0x12); wr_dat(0x1a); wr_dat(0x14); wr_dat(0x03); wait_ms(50); wr_cmd(0xE1); // GMCTRN1 wr_dat(0x17); wr_dat(0x1b); wr_dat(0x1d); wr_dat(0x0e); wr_dat(0x14); wr_dat(0x11); wr_dat(0x2c); wr_dat(0xa5); wr_dat(0x3d); wr_dat(0x09); wr_dat(0x27); wr_dat(0x2d); wr_dat(0x25); wr_dat(0x2b); wr_dat(0x3c); wait_ms(50); wr_cmd(0x13); // 18 Normal display on no args. wait_ms(10); wr_cmd(0x29); // 19 Main screen turn on, no args.normal display on wait_ms(500); switch (orientation) { case 0: wr_reg(0x36, 0x0008); //originalでの0xc8は間違いで、ST7735_MADCTL(0x36)ではないか break; case 1: wr_reg(0x36, 0x0068); break; case 2: wr_reg(0x36, 0x00C8); break; case 3: wr_reg(0x36, 0x00A8); break; } #else //@ss ~ST7735B (original) /* Start Initial Sequence ----------------------------------------------------*/ wr_cmd(ST7735_SWRESET); /* SW Reset */ wait_ms(150); wr_cmd(ST7735_SLPOUT); /* Out of sleepmode */ wait_ms(500); ・ ・ ・
mbed library自体の修正
上記のdriver IC設定値の修正だけでは、LCDの表示領域がずれるなどの不具合がありました。この修正も行います。この不具合の原因が、driver ICの種類の違いよるものなのか、コードそのものの不具合なのかはわかりません。
修正コードは"@ss"のコメントをつけた行になります。
1.driver ICへの画像データバッファアドレス指示の修正
pixel()関数で使用しているwindow()関数の引数が間違っています。元のコードは、終点のx,yが絶対座標形式のようになっていますが、視点からの相対座標を設定しないといけません。
ST7735_TFT.cpp
・ ・ ・ void ST7735_TFT::pixel(int x, int y, int color) { if ((x >= width()) || (y >= height())) return; window(x,y,1,1); //@ss //@ss window(x,y,x+1,y+1); // setup for data ・ ・ ・
2.window()関数の座標原点のずれ
driver ICの仕様かもしれませんが、driver ICの画像データバッファの原点が、x=2, y=1となっています。このlibraryで使用される原点はx=0, y=0なので、offsetを追加します。
ST7735_TFT.cpp
・ ・ ・ void ST7735_TFT::window (unsigned int x, unsigned int y, unsigned int w, unsigned int h) { //@ss なぜか CASET(X軸)で2, RASET(Y軸)で1 が最小値になっており、これがLCDDisplayのx,y原点になっていない(LCDの原点を設定するためには(-2,-1)を指示する必要がある //@ss プログラム上はLCD原点を0,0にするために、この関数でoffsetをかける。 x-=2; //@ss y-=1; //@ss wr_cmd(ST7735_CASET); // column addr set wr_dat(0x00); ・ ・ ・
3.端子定義処理での"orientation"変数の初期値設定タイミングの変更
"ST7735_TFT()"関数内の"orientation"変数の初期値設定がtft_reset()の後になっていますが、tft_reset()内でこの変数を使用しているので、tft_reset()実行前に、変数値を設定する必要があります。
ST7735_TFT.cpp
・ ・ ・ 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) { orientation = 1; //@ss tft_reset(); //@ss orientation = 2; char_x = 0; ・ ・ ・
補足:LCD 表示原点の設定
今回使用したmoduleのLCDは160*128ピクセルのものです。画像データの送信によって、x,y軸を入れ替える(横長、縦長)ことができます。これを設定するのが、上記"3"のorientation変数になります。この変数は"set_orientation()"関数の引数として与えることで変更することができます。引数は0,1,2,3となります。
<縦横選択>
0,2 : 縦長(x=0-127, y=0-159)
1,3 : 横長(x=0-159, y=0-127)
<縦(y軸)座標値増加方向>
0,1を基準にした場合、2,3は上下が逆転する
<表示例>
orientation = 0
orientation = 1
orientation =2
orientation=3
以上
ST7735_TFT.cpp
- Committer:
- suupen
- Date:
- 2014-09-20
- Revision:
- 2:9a62e159e30c
- Parent:
- 1:967235e6fd48
File content as of revision 2:9a62e159e30c:
/* この Libraryは Arduino TFT LCD Screenを使うために"ST7735_TFT"Libraryを改造したものです。 original library からの変更箇所はcomment"//@ss"の行になります。 */ /* 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) { orientation = 1; //@ss tft_reset(); //@ss 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); #ifdef ST7735B //@ss /* Start Initial Sequence ----------------------------------------------------*/ wr_cmd(ST7735_SWRESET); /* SW Reset */ wait_ms(150); wr_cmd(ST7735_SLPOUT); /* Out of sleepmode */ wait_ms(500); wr_cmd(0x26); // 3: Set default gamma wr_dat(0x04); // 16-bit color wr_cmd(ST7735_FRMCTR1); /*4 Frame rate in normal mode */ wr_dat(0x0b); wr_dat(0x14); wr_cmd(0xc0); // 5 POWER CONTROL 1 wr_dat(0x08); wr_dat(0x00); wr_cmd(0xc1); // 6 POWER CONTROL 2 wr_dat(0x05); wr_cmd(0xC5); // POWER CONTROL 6 wr_dat(0x41); // wr_dat(0x30); wr_cmd(0xc7); // 8:LCD Driving control wr_dat(0xc1); wr_cmd(0xec); // 9:Set color format wr_dat(0x1b); // 16-bit color wr_cmd(0x3A); // COLOR MODE wr_dat(0x55); // wait_ms(100); wr_cmd(0x2a); // 11 COLUMN ADDR SET wr_dat(0x00); // wr_dat(0x00); // xstart = 0 wr_dat(0x00); // wr_dat(0x7F); // xend = 127 wr_cmd(0x2b); // ROW ADDR SET wr_dat(0x00); // wr_dat(0x00); // ystart = 0 wr_dat(0x00); // wr_dat(0x9F); // yend = 159 wr_cmd(0x36); // 13 Set Scanning Direction wr_dat(0xc8); wr_cmd(0xb7); // 14 Set Source Output Direction wr_dat(0x00); /* Gamma settings -----------------------------------------------------------*/ wr_cmd(0xE0); // GMCTRP1 wr_dat(0x28); wr_dat(0x24); wr_dat(0x22); wr_dat(0x31); wr_dat(0x2b); wr_dat(0x0e); wr_dat(0x53); wr_dat(0xa5); wr_dat(0x42); wr_dat(0x16); wr_dat(0x18); wr_dat(0x12); wr_dat(0x1a); wr_dat(0x14); wr_dat(0x03); wait_ms(50); wr_cmd(0xE1); // GMCTRN1 wr_dat(0x17); wr_dat(0x1b); wr_dat(0x1d); wr_dat(0x0e); wr_dat(0x14); wr_dat(0x11); wr_dat(0x2c); wr_dat(0xa5); wr_dat(0x3d); wr_dat(0x09); wr_dat(0x27); wr_dat(0x2d); wr_dat(0x25); wr_dat(0x2b); wr_dat(0x3c); wait_ms(50); wr_cmd(0x13); // 18 Normal display on no args. wait_ms(10); wr_cmd(0x29); // 19 Main screen turn on, no args.normal display on wait_ms(500); switch (orientation) { case 0: wr_reg(0x36, 0x0008); //originalでの0xc8は間違いで、ST7735_MADCTL(0x36)ではないか break; case 1: wr_reg(0x36, 0x0068); break; case 2: wr_reg(0x36, 0x00C8); break; case 3: wr_reg(0x36, 0x00A8); break; } #else //@ss ~ST7735B (original) /* 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; } #endif // ST7735B WindowMax (); } void ST7735_TFT::pixel(int x, int y, int color) { if ((x >= width()) || (y >= height())) return; window(x,y,1,1); //@ss //@ss 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) { //@ss なぜか CASET(X軸)で2, RASET(Y軸)で1 が最小値になっており、これがLCDDisplayのx,y原点になっていない(LCDの原点を設定するためには(-2,-1)を指示する必要がある //@ss プログラム上はLCD原点を0,0にするために、この関数でoffsetをかける。 x-=2; //@ss y-=1; //@ss 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); }