Roland Kamp / ST7735

Library for 1.8 inch 160*180 TFT Display. Nice fonts in different formats.

ST7735.cpp@1:6a6d8d2b19f1, 2015-08-15 (annotated)

Committer:
rolo644u
Date:
Sat Aug 15 11:59:03 2015 +0000
Revision:
1:6a6d8d2b19f1
Parent:
0:3015b613b20d
Child:
2:291ac9fb4d64
Delay power-up improved

Who changed what in which revision?

UserRevisionLine numberNew contents of line
rolo644u 0:3015b613b20d 1 #include "mbed.h"
rolo644u 0:3015b613b20d 2 #include "ST7735.h"
rolo644u 0:3015b613b20d 3
rolo644u 0:3015b613b20d 4 #ifdef LOAD_FONT2
rolo644u 0:3015b613b20d 5 #include "Font16.h"
rolo644u 0:3015b613b20d 6 #endif
rolo644u 0:3015b613b20d 7
rolo644u 0:3015b613b20d 8 #ifdef LOAD_FONT4
rolo644u 0:3015b613b20d 9 #include "Font32.h"
rolo644u 0:3015b613b20d 10 #endif
rolo644u 0:3015b613b20d 11
rolo644u 0:3015b613b20d 12 #ifdef LOAD_FONT6
rolo644u 0:3015b613b20d 13 #include "Font64.h"
rolo644u 0:3015b613b20d 14 #endif
rolo644u 0:3015b613b20d 15
rolo644u 0:3015b613b20d 16 #ifdef LOAD_FONT7
rolo644u 0:3015b613b20d 17 #include "Font7s.h"
rolo644u 0:3015b613b20d 18 #endif
rolo644u 0:3015b613b20d 19
rolo644u 0:3015b613b20d 20 #ifdef LOAD_FONT8
rolo644u 0:3015b613b20d 21 #include "Font72.h"
rolo644u 0:3015b613b20d 22 #endif
rolo644u 0:3015b613b20d 23
rolo644u 0:3015b613b20d 24
rolo644u 0:3015b613b20d 25 ST7735::ST7735(PinName cePin, PinName dcPin, PinName mosiPin, PinName sclkPin)
rolo644u 0:3015b613b20d 26 {
rolo644u 0:3015b613b20d 27 spi = new SPI(mosiPin, NC, sclkPin); // create new SPI instance and initialise
rolo644u 1:6a6d8d2b19f1 28 initSPI();
rolo644u 0:3015b613b20d 29
rolo644u 0:3015b613b20d 30 // set up other pins as required
rolo644u 0:3015b613b20d 31 ce = new DigitalOut(cePin,1);
rolo644u 0:3015b613b20d 32 dc = new DigitalOut(dcPin,0);
rolo644u 0:3015b613b20d 33
rolo644u 1:6a6d8d2b19f1 34 // Defaults after power-up
rolo644u 1:6a6d8d2b19f1 35 textsize = 1;
rolo644u 1:6a6d8d2b19f1 36 textcolor = ST7735_GREEN;
rolo644u 1:6a6d8d2b19f1 37 textbgcolor = ST7735_BLACK;
rolo644u 1:6a6d8d2b19f1 38 }
rolo644u 0:3015b613b20d 39
rolo644u 0:3015b613b20d 40 // function to initialise SPI peripheral
rolo644u 0:3015b613b20d 41 void ST7735::initSPI()
rolo644u 0:3015b613b20d 42 {
rolo644u 0:3015b613b20d 43 spi->format(8,0); // 8 bits, Mode 0
rolo644u 0:3015b613b20d 44 spi->frequency(12000000); // SPI clock frequency
rolo644u 0:3015b613b20d 45 //spi->frequency(4000000); // SPI clock frequency
rolo644u 0:3015b613b20d 46 //spi->frequency(22000000); // SPI clock frequency 20.83 Mhz
rolo644u 0:3015b613b20d 47 }
rolo644u 0:3015b613b20d 48
rolo644u 0:3015b613b20d 49 // Write data word
rolo644u 0:3015b613b20d 50 void ST7735::writecommand(char c)
rolo644u 0:3015b613b20d 51 {
rolo644u 0:3015b613b20d 52 dc->write(0);
rolo644u 0:3015b613b20d 53 ce->write(0);
rolo644u 0:3015b613b20d 54 spi->write(c);
rolo644u 0:3015b613b20d 55 ce->write(1);
rolo644u 0:3015b613b20d 56 }
rolo644u 0:3015b613b20d 57
rolo644u 0:3015b613b20d 58 // Write command word
rolo644u 0:3015b613b20d 59 void ST7735::writedata(char c)
rolo644u 0:3015b613b20d 60 {
rolo644u 0:3015b613b20d 61 dc->write(1);
rolo644u 0:3015b613b20d 62 ce->write(0);
rolo644u 0:3015b613b20d 63 spi->write(c);
rolo644u 0:3015b613b20d 64 ce->write(1);
rolo644u 0:3015b613b20d 65 }
rolo644u 0:3015b613b20d 66
rolo644u 0:3015b613b20d 67
rolo644u 0:3015b613b20d 68 // Rather than a bazillion writecommand() and writedata() calls, screen
rolo644u 0:3015b613b20d 69 // initialization commands and arguments are organized in these tables
rolo644u 0:3015b613b20d 70 // stored in PROGMEM. The table may look bulky, but that's mostly the
rolo644u 0:3015b613b20d 71 // formatting -- storage-wise this is hundreds of bytes more compact
rolo644u 0:3015b613b20d 72 // than the equivalent code. Companion function follows.
rolo644u 0:3015b613b20d 73 #define DELAY 0x80
rolo644u 0:3015b613b20d 74 static const uint8_t Bcmd[] = { // Initialization commands for 7735B screens
rolo644u 0:3015b613b20d 75 18, // 18 commands in list:
rolo644u 0:3015b613b20d 76 ST7735_SWRESET, DELAY, // 1: Software reset, no args, w/delay
rolo644u 0:3015b613b20d 77 50, // 50 ms delay
rolo644u 0:3015b613b20d 78 ST7735_SLPOUT , DELAY, // 2: Out of sleep mode, no args, w/delay
rolo644u 0:3015b613b20d 79 255, // 255 = 500 ms delay
rolo644u 0:3015b613b20d 80 ST7735_COLMOD , 1+DELAY, // 3: Set color mode, 1 arg + delay:
rolo644u 0:3015b613b20d 81 0x05, // 16-bit color
rolo644u 0:3015b613b20d 82 10, // 10 ms delay
rolo644u 0:3015b613b20d 83 ST7735_FRMCTR1, 3+DELAY, // 4: Frame rate control, 3 args + delay:
rolo644u 0:3015b613b20d 84 0x00, // fastest refresh
rolo644u 0:3015b613b20d 85 0x06, // 6 lines front porch
rolo644u 0:3015b613b20d 86 0x03, // 3 lines back porch
rolo644u 0:3015b613b20d 87 10, // 10 ms delay
rolo644u 0:3015b613b20d 88 ST7735_MADCTL , 1 , // 5: Memory access ctrl (directions), 1 arg:
rolo644u 0:3015b613b20d 89 0x08, // Row addr/col addr, bottom to top refresh
rolo644u 0:3015b613b20d 90 ST7735_DISSET5, 2 , // 6: Display settings #5, 2 args, no delay:
rolo644u 0:3015b613b20d 91 0x15, // 1 clk cycle nonoverlap, 2 cycle gate
rolo644u 0:3015b613b20d 92 // rise, 3 cycle osc equalize
rolo644u 0:3015b613b20d 93 0x02, // Fix on VTL
rolo644u 0:3015b613b20d 94 ST7735_INVCTR , 1 , // 7: Display inversion control, 1 arg:
rolo644u 0:3015b613b20d 95 0x0, // Line inversion
rolo644u 0:3015b613b20d 96 ST7735_PWCTR1 , 2+DELAY, // 8: Power control, 2 args + delay:
rolo644u 0:3015b613b20d 97 0x02, // GVDD = 4.7V
rolo644u 0:3015b613b20d 98 0x70, // 1.0uA
rolo644u 0:3015b613b20d 99 10, // 10 ms delay
rolo644u 0:3015b613b20d 100 ST7735_PWCTR2 , 1 , // 9: Power control, 1 arg, no delay:
rolo644u 0:3015b613b20d 101 0x05, // VGH = 14.7V, VGL = -7.35V
rolo644u 0:3015b613b20d 102 ST7735_PWCTR3 , 2 , // 10: Power control, 2 args, no delay:
rolo644u 0:3015b613b20d 103 0x01, // Opamp current small
rolo644u 0:3015b613b20d 104 0x02, // Boost frequency
rolo644u 0:3015b613b20d 105 ST7735_VMCTR1 , 2+DELAY, // 11: Power control, 2 args + delay:
rolo644u 0:3015b613b20d 106 0x3C, // VCOMH = 4V
rolo644u 0:3015b613b20d 107 0x38, // VCOML = -1.1V
rolo644u 0:3015b613b20d 108 10, // 10 ms delay
rolo644u 0:3015b613b20d 109 ST7735_PWCTR6 , 2 , // 12: Power control, 2 args, no delay:
rolo644u 0:3015b613b20d 110 0x11, 0x15,
rolo644u 0:3015b613b20d 111 ST7735_GMCTRP1,16 , // 13: Magical unicorn dust, 16 args, no delay:
rolo644u 0:3015b613b20d 112 0x09, 0x16, 0x09, 0x20, // (seriously though, not sure what
rolo644u 0:3015b613b20d 113 0x21, 0x1B, 0x13, 0x19, // these config values represent)
rolo644u 0:3015b613b20d 114 0x17, 0x15, 0x1E, 0x2B,
rolo644u 0:3015b613b20d 115 0x04, 0x05, 0x02, 0x0E,
rolo644u 0:3015b613b20d 116 ST7735_GMCTRN1,16+DELAY, // 14: Sparkles and rainbows, 16 args + delay:
rolo644u 0:3015b613b20d 117 0x0B, 0x14, 0x08, 0x1E, // (ditto)
rolo644u 0:3015b613b20d 118 0x22, 0x1D, 0x18, 0x1E,
rolo644u 0:3015b613b20d 119 0x1B, 0x1A, 0x24, 0x2B,
rolo644u 0:3015b613b20d 120 0x06, 0x06, 0x02, 0x0F,
rolo644u 0:3015b613b20d 121 10, // 10 ms delay
rolo644u 0:3015b613b20d 122 ST7735_CASET , 4 , // 15: Column addr set, 4 args, no delay:
rolo644u 0:3015b613b20d 123 0x00, 0x02, // XSTART = 2
rolo644u 0:3015b613b20d 124 0x00, 0x81, // XEND = 129
rolo644u 0:3015b613b20d 125 ST7735_RASET , 4 , // 16: Row addr set, 4 args, no delay:
rolo644u 0:3015b613b20d 126 0x00, 0x02, // XSTART = 1
rolo644u 0:3015b613b20d 127 0x00, 0x81, // XEND = 160
rolo644u 0:3015b613b20d 128 ST7735_NORON , DELAY, // 17: Normal display on, no args, w/delay
rolo644u 0:3015b613b20d 129 10, // 10 ms delay
rolo644u 0:3015b613b20d 130 ST7735_DISPON , DELAY, // 18: Main screen turn on, no args, w/delay
rolo644u 0:3015b613b20d 131 255 }, // 255 = 500 ms delay
rolo644u 0:3015b613b20d 132
rolo644u 0:3015b613b20d 133 Rcmd1[] = { // Init for 7735R, part 1 (red or green tab)
rolo644u 0:3015b613b20d 134 15, // 15 commands in list:
rolo644u 0:3015b613b20d 135 ST7735_SWRESET, DELAY, // 1: Software reset, 0 args, w/delay
rolo644u 0:3015b613b20d 136 150, // 150 ms delay
rolo644u 0:3015b613b20d 137 ST7735_SLPOUT , DELAY, // 2: Out of sleep mode, 0 args, w/delay
rolo644u 0:3015b613b20d 138 255, // 500 ms delay
rolo644u 0:3015b613b20d 139 ST7735_FRMCTR1, 3 , // 3: Frame rate ctrl - normal mode, 3 args:
rolo644u 0:3015b613b20d 140 0x01, 0x2C, 0x2D, // Rate = fosc/(1x2+40) * (LINE+2C+2D)
rolo644u 0:3015b613b20d 141 ST7735_FRMCTR2, 3 , // 4: Frame rate control - idle mode, 3 args:
rolo644u 0:3015b613b20d 142 0x01, 0x2C, 0x2D, // Rate = fosc/(1x2+40) * (LINE+2C+2D)
rolo644u 0:3015b613b20d 143 ST7735_FRMCTR3, 6 , // 5: Frame rate ctrl - partial mode, 6 args:
rolo644u 0:3015b613b20d 144 0x01, 0x2C, 0x2D, // Dot inversion mode
rolo644u 0:3015b613b20d 145 0x01, 0x2C, 0x2D, // Line inversion mode
rolo644u 0:3015b613b20d 146 ST7735_INVCTR , 1 , // 6: Display inversion ctrl, 1 arg, no delay:
rolo644u 0:3015b613b20d 147 0x07, // No inversion
rolo644u 0:3015b613b20d 148 ST7735_PWCTR1 , 3 , // 7: Power control, 3 args, no delay:
rolo644u 0:3015b613b20d 149 0xA2,
rolo644u 0:3015b613b20d 150 0x02, // -4.6V
rolo644u 0:3015b613b20d 151 0x84, // AUTO mode
rolo644u 0:3015b613b20d 152 ST7735_PWCTR2 , 1 , // 8: Power control, 1 arg, no delay:
rolo644u 0:3015b613b20d 153 0xC5, // VGH25 = 2.4C VGSEL = -10 VGH = 3 * AVDD
rolo644u 0:3015b613b20d 154 ST7735_PWCTR3 , 2 , // 9: Power control, 2 args, no delay:
rolo644u 0:3015b613b20d 155 0x0A, // Opamp current small
rolo644u 0:3015b613b20d 156 0x00, // Boost frequency
rolo644u 0:3015b613b20d 157 ST7735_PWCTR4 , 2 , // 10: Power control, 2 args, no delay:
rolo644u 0:3015b613b20d 158 0x8A, // BCLK/2, Opamp current small & Medium low
rolo644u 0:3015b613b20d 159 0x2A,
rolo644u 0:3015b613b20d 160 ST7735_PWCTR5 , 2 , // 11: Power control, 2 args, no delay:
rolo644u 0:3015b613b20d 161 0x8A, 0xEE,
rolo644u 0:3015b613b20d 162 ST7735_VMCTR1 , 1 , // 12: Power control, 1 arg, no delay:
rolo644u 0:3015b613b20d 163 0x0E,
rolo644u 0:3015b613b20d 164 ST7735_INVOFF , 0 , // 13: Don't invert display, no args, no delay
rolo644u 0:3015b613b20d 165 ST7735_MADCTL , 1 , // 14: Memory access control (directions), 1 arg:
rolo644u 0:3015b613b20d 166 0xC8, // row addr/col addr, bottom to top refresh
rolo644u 0:3015b613b20d 167 ST7735_COLMOD , 1 , // 15: set color mode, 1 arg, no delay:
rolo644u 0:3015b613b20d 168 0x05 }, // 16-bit color
rolo644u 0:3015b613b20d 169
rolo644u 0:3015b613b20d 170 Rcmd2green[] = { // Init for 7735R, part 2 (green tab only)
rolo644u 0:3015b613b20d 171 2, // 2 commands in list:
rolo644u 0:3015b613b20d 172 ST7735_CASET , 4 , // 1: Column addr set, 4 args, no delay:
rolo644u 0:3015b613b20d 173 0x00, 0x02, // XSTART = 0
rolo644u 0:3015b613b20d 174 0x00, 0x7F+0x02, // XEND = 127
rolo644u 0:3015b613b20d 175 ST7735_RASET , 4 , // 2: Row addr set, 4 args, no delay:
rolo644u 0:3015b613b20d 176 0x00, 0x01, // XSTART = 0
rolo644u 0:3015b613b20d 177 0x00, 0x9F+0x01 }, // XEND = 159
rolo644u 0:3015b613b20d 178 Rcmd2red[] = { // Init for 7735R, part 2 (red tab only)
rolo644u 0:3015b613b20d 179 2, // 2 commands in list:
rolo644u 0:3015b613b20d 180 ST7735_CASET , 4 , // 1: Column addr set, 4 args, no delay:
rolo644u 0:3015b613b20d 181 0x00, 0x00, // XSTART = 0
rolo644u 0:3015b613b20d 182 0x00, 0x7F, // XEND = 127
rolo644u 0:3015b613b20d 183 ST7735_RASET , 4 , // 2: Row addr set, 4 args, no delay:
rolo644u 0:3015b613b20d 184 0x00, 0x00, // XSTART = 0
rolo644u 0:3015b613b20d 185 0x00, 0x9F }, // XEND = 159
rolo644u 0:3015b613b20d 186
rolo644u 0:3015b613b20d 187 Rcmd3[] = { // Init for 7735R, part 3 (red or green tab)
rolo644u 0:3015b613b20d 188 4, // 4 commands in list:
rolo644u 0:3015b613b20d 189 ST7735_GMCTRP1, 16 , // 1: Magical unicorn dust, 16 args, no delay:
rolo644u 0:3015b613b20d 190 0x02, 0x1c, 0x07, 0x12,
rolo644u 0:3015b613b20d 191 0x37, 0x32, 0x29, 0x2d,
rolo644u 0:3015b613b20d 192 0x29, 0x25, 0x2B, 0x39,
rolo644u 0:3015b613b20d 193 0x00, 0x01, 0x03, 0x10,
rolo644u 0:3015b613b20d 194 ST7735_GMCTRN1, 16 , // 2: Sparkles and rainbows, 16 args, no delay:
rolo644u 0:3015b613b20d 195 0x03, 0x1d, 0x07, 0x06,
rolo644u 0:3015b613b20d 196 0x2E, 0x2C, 0x29, 0x2D,
rolo644u 0:3015b613b20d 197 0x2E, 0x2E, 0x37, 0x3F,
rolo644u 0:3015b613b20d 198 0x00, 0x00, 0x02, 0x10,
rolo644u 0:3015b613b20d 199 ST7735_NORON , DELAY, // 3: Normal display on, no args, w/delay
rolo644u 0:3015b613b20d 200 10, // 10 ms delay
rolo644u 0:3015b613b20d 201 ST7735_DISPON , DELAY, // 4: Main screen turn on, no args w/delay
rolo644u 0:3015b613b20d 202 100 }; // 100 ms delay
rolo644u 0:3015b613b20d 203
rolo644u 0:3015b613b20d 204
rolo644u 0:3015b613b20d 205
rolo644u 0:3015b613b20d 206 // Companion code to the above tables. Reads and issues
rolo644u 0:3015b613b20d 207 // a series of LCD commands stored in PROGMEM byte array.
rolo644u 0:3015b613b20d 208 void ST7735::commandList(const uint8_t *addr){
rolo644u 0:3015b613b20d 209 uint8_t numCommands, numArgs;
rolo644u 0:3015b613b20d 210 uint16_t ms;
rolo644u 0:3015b613b20d 211
rolo644u 0:3015b613b20d 212 numCommands = pgm_read_byte(addr++); // Number of commands to follow
rolo644u 0:3015b613b20d 213 while(numCommands--) { // For each command...
rolo644u 0:3015b613b20d 214 writecommand(pgm_read_byte(addr++)); // Read, issue command
rolo644u 0:3015b613b20d 215 numArgs = pgm_read_byte(addr++); // Number of args to follow
rolo644u 0:3015b613b20d 216 ms = numArgs & DELAY; // If hibit set, delay follows args
rolo644u 0:3015b613b20d 217 numArgs &= ~DELAY; // Mask out delay bit
rolo644u 0:3015b613b20d 218 while(numArgs--) { // For each argument...
rolo644u 0:3015b613b20d 219 writedata(pgm_read_byte(addr++)); // Read, issue argument
rolo644u 0:3015b613b20d 220 }
rolo644u 0:3015b613b20d 221
rolo644u 0:3015b613b20d 222 if(ms) {
rolo644u 0:3015b613b20d 223 ms = pgm_read_byte(addr++); // Read post-command delay time (ms)
rolo644u 0:3015b613b20d 224 if(ms == 255) ms = 500; // If 255, delay for 500 ms
rolo644u 0:3015b613b20d 225 wait_ms(ms);
rolo644u 0:3015b613b20d 226 }
rolo644u 0:3015b613b20d 227 }
rolo644u 0:3015b613b20d 228 }
rolo644u 0:3015b613b20d 229
rolo644u 0:3015b613b20d 230 // Initialization code common to both 'B' and 'R' type displays
rolo644u 0:3015b613b20d 231 void ST7735::commonInit(const uint8_t *cmdList){
rolo644u 1:6a6d8d2b19f1 232 wait_ms(100); // Wait for reset to be stable after power-up
rolo644u 0:3015b613b20d 233 colstart = rowstart = 0; // May be overridden in init func
rolo644u 0:3015b613b20d 234 if(cmdList) commandList(cmdList);
rolo644u 0:3015b613b20d 235 }
rolo644u 0:3015b613b20d 236
rolo644u 0:3015b613b20d 237 // Initialization for ST7735B screens
rolo644u 0:3015b613b20d 238 void ST7735::initB() {
rolo644u 0:3015b613b20d 239 commonInit(Bcmd);
rolo644u 0:3015b613b20d 240 }
rolo644u 0:3015b613b20d 241
rolo644u 0:3015b613b20d 242 // Initialization for ST7735R screens (green or red tabs)
rolo644u 0:3015b613b20d 243 void ST7735::initR(uint8_t options) {
rolo644u 0:3015b613b20d 244 commonInit(Rcmd1);
rolo644u 0:3015b613b20d 245 if(options == INITR_GREENTAB) {
rolo644u 0:3015b613b20d 246 commandList(Rcmd2green);
rolo644u 0:3015b613b20d 247 colstart = 2;
rolo644u 0:3015b613b20d 248 rowstart = 1;
rolo644u 0:3015b613b20d 249 } else {
rolo644u 0:3015b613b20d 250 // colstart, rowstart left at default '0' values
rolo644u 0:3015b613b20d 251 commandList(Rcmd2red);
rolo644u 0:3015b613b20d 252 }
rolo644u 0:3015b613b20d 253 commandList(Rcmd3);
rolo644u 0:3015b613b20d 254
rolo644u 0:3015b613b20d 255 // if black, change MADCTL color filter
rolo644u 0:3015b613b20d 256 if (options == INITR_BLACKTAB) {
rolo644u 0:3015b613b20d 257 writecommand(ST7735_MADCTL);
rolo644u 0:3015b613b20d 258 writedata(0xC0);
rolo644u 0:3015b613b20d 259 }
rolo644u 0:3015b613b20d 260
rolo644u 0:3015b613b20d 261 tabcolor = options;
rolo644u 0:3015b613b20d 262 }
rolo644u 0:3015b613b20d 263
rolo644u 0:3015b613b20d 264 void ST7735::setRotation(uint8_t m) {
rolo644u 0:3015b613b20d 265
rolo644u 0:3015b613b20d 266 writecommand(ST7735_MADCTL);
rolo644u 0:3015b613b20d 267 rotation = m % 4; // can't be higher than 3
rolo644u 0:3015b613b20d 268 switch (rotation) {
rolo644u 0:3015b613b20d 269 case 0:
rolo644u 0:3015b613b20d 270 if (tabcolor == INITR_BLACKTAB) {
rolo644u 0:3015b613b20d 271 writedata(MADCTL_MX | MADCTL_MY | MADCTL_RGB);
rolo644u 0:3015b613b20d 272 } else {
rolo644u 0:3015b613b20d 273 writedata(MADCTL_MX | MADCTL_MY | MADCTL_BGR);
rolo644u 0:3015b613b20d 274 }
rolo644u 0:3015b613b20d 275 _width = ST7735_TFTWIDTH;
rolo644u 0:3015b613b20d 276 _height = ST7735_TFTHEIGHT;
rolo644u 0:3015b613b20d 277 break;
rolo644u 0:3015b613b20d 278 case 1:
rolo644u 0:3015b613b20d 279 if (tabcolor == INITR_BLACKTAB) {
rolo644u 0:3015b613b20d 280 writedata(MADCTL_MY | MADCTL_MV | MADCTL_RGB);
rolo644u 0:3015b613b20d 281 } else {
rolo644u 0:3015b613b20d 282 writedata(MADCTL_MY | MADCTL_MV | MADCTL_BGR);
rolo644u 0:3015b613b20d 283 }
rolo644u 0:3015b613b20d 284 _width = ST7735_TFTHEIGHT;
rolo644u 0:3015b613b20d 285 _height = ST7735_TFTWIDTH;
rolo644u 0:3015b613b20d 286 break;
rolo644u 0:3015b613b20d 287 case 2:
rolo644u 0:3015b613b20d 288 if (tabcolor == INITR_BLACKTAB) {
rolo644u 0:3015b613b20d 289 writedata(MADCTL_RGB);
rolo644u 0:3015b613b20d 290 } else {
rolo644u 0:3015b613b20d 291 writedata(MADCTL_BGR);
rolo644u 0:3015b613b20d 292 }
rolo644u 0:3015b613b20d 293 _width = ST7735_TFTWIDTH;
rolo644u 0:3015b613b20d 294 _height = ST7735_TFTHEIGHT;
rolo644u 0:3015b613b20d 295 break;
rolo644u 0:3015b613b20d 296 case 3:
rolo644u 0:3015b613b20d 297 if (tabcolor == INITR_BLACKTAB) {
rolo644u 0:3015b613b20d 298 writedata(MADCTL_MX | MADCTL_MV | MADCTL_RGB);
rolo644u 0:3015b613b20d 299 } else {
rolo644u 0:3015b613b20d 300 writedata(MADCTL_MX | MADCTL_MV | MADCTL_BGR);
rolo644u 0:3015b613b20d 301 }
rolo644u 0:3015b613b20d 302 _width = ST7735_TFTHEIGHT;
rolo644u 0:3015b613b20d 303 _height = ST7735_TFTWIDTH;
rolo644u 0:3015b613b20d 304 break;
rolo644u 0:3015b613b20d 305 }
rolo644u 0:3015b613b20d 306 }
rolo644u 0:3015b613b20d 307
rolo644u 0:3015b613b20d 308 void ST7735::fillScreen(uint16_t color) {
rolo644u 0:3015b613b20d 309 fillRect(0, 0, _width, _height, color);
rolo644u 0:3015b613b20d 310 }
rolo644u 0:3015b613b20d 311
rolo644u 0:3015b613b20d 312
rolo644u 0:3015b613b20d 313
rolo644u 0:3015b613b20d 314 void ST7735::pushColor(uint16_t color) {
rolo644u 0:3015b613b20d 315 dc->write(1);
rolo644u 0:3015b613b20d 316 ce->write(0);
rolo644u 0:3015b613b20d 317 spi->write(color >> 8);
rolo644u 0:3015b613b20d 318 spi->write(color);
rolo644u 0:3015b613b20d 319 ce->write(1);
rolo644u 0:3015b613b20d 320 }
rolo644u 0:3015b613b20d 321
rolo644u 0:3015b613b20d 322 // fill a rectangle
rolo644u 0:3015b613b20d 323 void ST7735::fillRect(int16_t x, int16_t y, int16_t w, int16_t h, uint16_t color) {
rolo644u 0:3015b613b20d 324
rolo644u 0:3015b613b20d 325 // rudimentary clipping (drawChar w/big text requires this)
rolo644u 0:3015b613b20d 326 if((x >= _width) || (y >= _height)) return;
rolo644u 0:3015b613b20d 327 if((x + w - 1) >= _width) w = _width - x;
rolo644u 0:3015b613b20d 328 if((y + h - 1) >= _height) h = _height - y;
rolo644u 0:3015b613b20d 329
rolo644u 0:3015b613b20d 330 setAddrWindow(x, y, x+w-1, y+h-1);
rolo644u 0:3015b613b20d 331
rolo644u 0:3015b613b20d 332 uint8_t hi = color >> 8, lo = color;
rolo644u 0:3015b613b20d 333
rolo644u 0:3015b613b20d 334 dc->write(1);
rolo644u 0:3015b613b20d 335 ce->write(0);
rolo644u 0:3015b613b20d 336
rolo644u 0:3015b613b20d 337 for(y=h; y>0; y--) {
rolo644u 0:3015b613b20d 338 for(x=w; x>0; x--) {
rolo644u 0:3015b613b20d 339 spi->write(hi);
rolo644u 0:3015b613b20d 340 spi->write(lo);
rolo644u 0:3015b613b20d 341 }
rolo644u 0:3015b613b20d 342 }
rolo644u 0:3015b613b20d 343 ce->write(1);
rolo644u 0:3015b613b20d 344 }
rolo644u 0:3015b613b20d 345
rolo644u 0:3015b613b20d 346
rolo644u 0:3015b613b20d 347
rolo644u 0:3015b613b20d 348 void ST7735::invertDisplay(bool i) {
rolo644u 0:3015b613b20d 349 writecommand(i ? ST7735_INVON : ST7735_INVOFF);
rolo644u 0:3015b613b20d 350 }
rolo644u 0:3015b613b20d 351
rolo644u 0:3015b613b20d 352 void ST7735::drawPixel(int16_t x, int16_t y, uint16_t color) {
rolo644u 0:3015b613b20d 353
rolo644u 0:3015b613b20d 354 if((x < 0) ||(x >= _width) || (y < 0) || (y >= _height)) return;
rolo644u 0:3015b613b20d 355
rolo644u 0:3015b613b20d 356 setAddrWindow(x,y,x+1,y+1);
rolo644u 0:3015b613b20d 357 dc->write(1);
rolo644u 0:3015b613b20d 358 ce->write(0);
rolo644u 0:3015b613b20d 359 spi->write(color >> 8);
rolo644u 0:3015b613b20d 360 spi->write(color);
rolo644u 0:3015b613b20d 361 ce->write(1);
rolo644u 0:3015b613b20d 362 }
rolo644u 0:3015b613b20d 363
rolo644u 0:3015b613b20d 364 void ST7735::drawFastVLine(int16_t x, int16_t y, int16_t h, uint16_t color) {
rolo644u 0:3015b613b20d 365
rolo644u 0:3015b613b20d 366 // Rudimentary clipping
rolo644u 0:3015b613b20d 367 if((x >= _width) || (y >= _height)) return;
rolo644u 0:3015b613b20d 368 if((y+h-1) >= _height) h = _height-y;
rolo644u 0:3015b613b20d 369 setAddrWindow(x, y, x, y+h-1);
rolo644u 0:3015b613b20d 370
rolo644u 0:3015b613b20d 371 uint8_t hi = color >> 8, lo = color;
rolo644u 0:3015b613b20d 372
rolo644u 0:3015b613b20d 373 dc->write(1);
rolo644u 0:3015b613b20d 374 ce->write(0);
rolo644u 0:3015b613b20d 375 while (h--) {
rolo644u 0:3015b613b20d 376 spi->write(hi);
rolo644u 0:3015b613b20d 377 spi->write(lo);
rolo644u 0:3015b613b20d 378 }
rolo644u 0:3015b613b20d 379 ce->write(1);
rolo644u 0:3015b613b20d 380 }
rolo644u 0:3015b613b20d 381
rolo644u 0:3015b613b20d 382 void ST7735::drawFastHLine(int16_t x, int16_t y, int16_t w, uint16_t color) {
rolo644u 0:3015b613b20d 383
rolo644u 0:3015b613b20d 384 // Rudimentary clipping
rolo644u 0:3015b613b20d 385 if((x >= _width) || (y >= _height)) return;
rolo644u 0:3015b613b20d 386 if((x+w-1) >= _width) w = _width-x;
rolo644u 0:3015b613b20d 387 setAddrWindow(x, y, x+w-1, y);
rolo644u 0:3015b613b20d 388 uint8_t hi = color >> 8, lo = color;
rolo644u 0:3015b613b20d 389
rolo644u 0:3015b613b20d 390 dc->write(1);;
rolo644u 0:3015b613b20d 391 ce->write(0);;
rolo644u 0:3015b613b20d 392
rolo644u 0:3015b613b20d 393 while (w--) {
rolo644u 0:3015b613b20d 394 spi->write(hi);
rolo644u 0:3015b613b20d 395 spi->write(lo);
rolo644u 0:3015b613b20d 396 }
rolo644u 0:3015b613b20d 397
rolo644u 0:3015b613b20d 398 ce->write(1);
rolo644u 0:3015b613b20d 399 }
rolo644u 0:3015b613b20d 400
rolo644u 0:3015b613b20d 401 // Pass 8-bit (each) R,G,B, get back 16-bit packed color
rolo644u 0:3015b613b20d 402 uint16_t ST7735::Color565(uint8_t r, uint8_t g, uint8_t b) {
rolo644u 0:3015b613b20d 403 return ((r & 0xF8) << 8) | ((g & 0xFC) << 3) | (b >> 3);
rolo644u 0:3015b613b20d 404 }
rolo644u 0:3015b613b20d 405
rolo644u 0:3015b613b20d 406 // Bresenham's algorithm - thx wikpedia
rolo644u 0:3015b613b20d 407 void ST7735::drawLine(int16_t x0, int16_t y0, int16_t x1, int16_t y1, uint16_t color) {
rolo644u 0:3015b613b20d 408 int16_t steep = abs(y1 - y0) > abs(x1 - x0);
rolo644u 0:3015b613b20d 409 if (steep) {
rolo644u 0:3015b613b20d 410 swap(x0, y0);
rolo644u 0:3015b613b20d 411 swap(x1, y1);
rolo644u 0:3015b613b20d 412 }
rolo644u 0:3015b613b20d 413
rolo644u 0:3015b613b20d 414 if (x0 > x1) {
rolo644u 0:3015b613b20d 415 swap(x0, x1);
rolo644u 0:3015b613b20d 416 swap(y0, y1);
rolo644u 0:3015b613b20d 417 }
rolo644u 0:3015b613b20d 418
rolo644u 0:3015b613b20d 419 int16_t dx, dy;
rolo644u 0:3015b613b20d 420 dx = x1 - x0;
rolo644u 0:3015b613b20d 421 dy = abs(y1 - y0);
rolo644u 0:3015b613b20d 422
rolo644u 0:3015b613b20d 423 int16_t err = dx / 2;
rolo644u 0:3015b613b20d 424 int16_t ystep;
rolo644u 0:3015b613b20d 425
rolo644u 0:3015b613b20d 426 if (y0 < y1) {
rolo644u 0:3015b613b20d 427 ystep = 1;
rolo644u 0:3015b613b20d 428 } else {
rolo644u 0:3015b613b20d 429 ystep = -1;
rolo644u 0:3015b613b20d 430 }
rolo644u 0:3015b613b20d 431
rolo644u 0:3015b613b20d 432 for (; x0<=x1; x0++) {
rolo644u 0:3015b613b20d 433 if (steep) {
rolo644u 0:3015b613b20d 434 drawPixel(y0, x0, color);
rolo644u 0:3015b613b20d 435 } else {
rolo644u 0:3015b613b20d 436 drawPixel(x0, y0, color);
rolo644u 0:3015b613b20d 437 }
rolo644u 0:3015b613b20d 438 err -= dy;
rolo644u 0:3015b613b20d 439 if (err < 0) {
rolo644u 0:3015b613b20d 440 y0 += ystep;
rolo644u 0:3015b613b20d 441 err += dx;
rolo644u 0:3015b613b20d 442 }
rolo644u 0:3015b613b20d 443 }
rolo644u 0:3015b613b20d 444 }
rolo644u 0:3015b613b20d 445
rolo644u 0:3015b613b20d 446 // Draw a rectangle
rolo644u 0:3015b613b20d 447 void ST7735::drawRect(int16_t x, int16_t y, int16_t w, int16_t h, uint16_t color) {
rolo644u 0:3015b613b20d 448 drawFastHLine(x, y, w, color);
rolo644u 0:3015b613b20d 449 drawFastHLine(x, y+h-1, w, color);
rolo644u 0:3015b613b20d 450 drawFastVLine(x, y, h, color);
rolo644u 0:3015b613b20d 451 drawFastVLine(x+w-1, y, h, color);
rolo644u 0:3015b613b20d 452 }
rolo644u 0:3015b613b20d 453
rolo644u 0:3015b613b20d 454 // Draw a circle outline
rolo644u 0:3015b613b20d 455 void ST7735::drawCircle(int16_t x0, int16_t y0, int16_t r, uint16_t color) {
rolo644u 0:3015b613b20d 456 int16_t f = 1 - r;
rolo644u 0:3015b613b20d 457 int16_t ddF_x = 1;
rolo644u 0:3015b613b20d 458 int16_t ddF_y = -2 * r;
rolo644u 0:3015b613b20d 459 int16_t x = 0;
rolo644u 0:3015b613b20d 460 int16_t y = r;
rolo644u 0:3015b613b20d 461
rolo644u 0:3015b613b20d 462 drawPixel(x0 , y0+r, color);
rolo644u 0:3015b613b20d 463 drawPixel(x0 , y0-r, color);
rolo644u 0:3015b613b20d 464 drawPixel(x0+r, y0 , color);
rolo644u 0:3015b613b20d 465 drawPixel(x0-r, y0 , color);
rolo644u 0:3015b613b20d 466
rolo644u 0:3015b613b20d 467 while (x<y) {
rolo644u 0:3015b613b20d 468 if (f >= 0) {
rolo644u 0:3015b613b20d 469 y--;
rolo644u 0:3015b613b20d 470 ddF_y += 2;
rolo644u 0:3015b613b20d 471 f += ddF_y;
rolo644u 0:3015b613b20d 472 }
rolo644u 0:3015b613b20d 473 x++;
rolo644u 0:3015b613b20d 474 ddF_x += 2;
rolo644u 0:3015b613b20d 475 f += ddF_x;
rolo644u 0:3015b613b20d 476
rolo644u 0:3015b613b20d 477 drawPixel(x0 + x, y0 + y, color);
rolo644u 0:3015b613b20d 478 drawPixel(x0 - x, y0 + y, color);
rolo644u 0:3015b613b20d 479 drawPixel(x0 + x, y0 - y, color);
rolo644u 0:3015b613b20d 480 drawPixel(x0 - x, y0 - y, color);
rolo644u 0:3015b613b20d 481 drawPixel(x0 + y, y0 + x, color);
rolo644u 0:3015b613b20d 482 drawPixel(x0 - y, y0 + x, color);
rolo644u 0:3015b613b20d 483 drawPixel(x0 + y, y0 - x, color);
rolo644u 0:3015b613b20d 484 drawPixel(x0 - y, y0 - x, color);
rolo644u 0:3015b613b20d 485 }
rolo644u 0:3015b613b20d 486 }
rolo644u 0:3015b613b20d 487
rolo644u 0:3015b613b20d 488 void ST7735::drawCircleHelper( int16_t x0, int16_t y0, int16_t r, uint8_t cornername, uint16_t color) {
rolo644u 0:3015b613b20d 489 int16_t f = 1 - r;
rolo644u 0:3015b613b20d 490 int16_t ddF_x = 1;
rolo644u 0:3015b613b20d 491 int16_t ddF_y = -2 * r;
rolo644u 0:3015b613b20d 492 int16_t x = 0;
rolo644u 0:3015b613b20d 493 int16_t y = r;
rolo644u 0:3015b613b20d 494
rolo644u 0:3015b613b20d 495 while (x<y) {
rolo644u 0:3015b613b20d 496 if (f >= 0) {
rolo644u 0:3015b613b20d 497 y--;
rolo644u 0:3015b613b20d 498 ddF_y += 2;
rolo644u 0:3015b613b20d 499 f += ddF_y;
rolo644u 0:3015b613b20d 500 }
rolo644u 0:3015b613b20d 501 x++;
rolo644u 0:3015b613b20d 502 ddF_x += 2;
rolo644u 0:3015b613b20d 503 f += ddF_x;
rolo644u 0:3015b613b20d 504 if (cornername & 0x4) {
rolo644u 0:3015b613b20d 505 drawPixel(x0 + x, y0 + y, color);
rolo644u 0:3015b613b20d 506 drawPixel(x0 + y, y0 + x, color);
rolo644u 0:3015b613b20d 507 }
rolo644u 0:3015b613b20d 508 if (cornername & 0x2) {
rolo644u 0:3015b613b20d 509 drawPixel(x0 + x, y0 - y, color);
rolo644u 0:3015b613b20d 510 drawPixel(x0 + y, y0 - x, color);
rolo644u 0:3015b613b20d 511 }
rolo644u 0:3015b613b20d 512 if (cornername & 0x8) {
rolo644u 0:3015b613b20d 513 drawPixel(x0 - y, y0 + x, color);
rolo644u 0:3015b613b20d 514 drawPixel(x0 - x, y0 + y, color);
rolo644u 0:3015b613b20d 515 }
rolo644u 0:3015b613b20d 516 if (cornername & 0x1) {
rolo644u 0:3015b613b20d 517 drawPixel(x0 - y, y0 - x, color);
rolo644u 0:3015b613b20d 518 drawPixel(x0 - x, y0 - y, color);
rolo644u 0:3015b613b20d 519 }
rolo644u 0:3015b613b20d 520 }
rolo644u 0:3015b613b20d 521 }
rolo644u 0:3015b613b20d 522
rolo644u 0:3015b613b20d 523 void ST7735::fillCircle(int16_t x0, int16_t y0, int16_t r, uint16_t color) {
rolo644u 0:3015b613b20d 524 drawFastVLine(x0, y0-r, 2*r+1, color);
rolo644u 0:3015b613b20d 525 fillCircleHelper(x0, y0, r, 3, 0, color);
rolo644u 0:3015b613b20d 526 }
rolo644u 0:3015b613b20d 527
rolo644u 0:3015b613b20d 528 // Used to do circles and roundrects
rolo644u 0:3015b613b20d 529 void ST7735::fillCircleHelper(int16_t x0, int16_t y0, int16_t r, uint8_t cornername, int16_t delta, uint16_t color) {
rolo644u 0:3015b613b20d 530
rolo644u 0:3015b613b20d 531 int16_t f = 1 - r;
rolo644u 0:3015b613b20d 532 int16_t ddF_x = 1;
rolo644u 0:3015b613b20d 533 int16_t ddF_y = -2 * r;
rolo644u 0:3015b613b20d 534 int16_t x = 0;
rolo644u 0:3015b613b20d 535 int16_t y = r;
rolo644u 0:3015b613b20d 536
rolo644u 0:3015b613b20d 537 while (x<y) {
rolo644u 0:3015b613b20d 538 if (f >= 0) {
rolo644u 0:3015b613b20d 539 y--;
rolo644u 0:3015b613b20d 540 ddF_y += 2;
rolo644u 0:3015b613b20d 541 f += ddF_y;
rolo644u 0:3015b613b20d 542 }
rolo644u 0:3015b613b20d 543 x++;
rolo644u 0:3015b613b20d 544 ddF_x += 2;
rolo644u 0:3015b613b20d 545 f += ddF_x;
rolo644u 0:3015b613b20d 546
rolo644u 0:3015b613b20d 547 if (cornername & 0x1) {
rolo644u 0:3015b613b20d 548 drawFastVLine(x0+x, y0-y, 2*y+1+delta, color);
rolo644u 0:3015b613b20d 549 drawFastVLine(x0+y, y0-x, 2*x+1+delta, color);
rolo644u 0:3015b613b20d 550 }
rolo644u 0:3015b613b20d 551 if (cornername & 0x2) {
rolo644u 0:3015b613b20d 552 drawFastVLine(x0-x, y0-y, 2*y+1+delta, color);
rolo644u 0:3015b613b20d 553 drawFastVLine(x0-y, y0-x, 2*x+1+delta, color);
rolo644u 0:3015b613b20d 554 }
rolo644u 0:3015b613b20d 555 }
rolo644u 0:3015b613b20d 556 }
rolo644u 0:3015b613b20d 557
rolo644u 0:3015b613b20d 558
rolo644u 0:3015b613b20d 559 // Draw a triangle
rolo644u 0:3015b613b20d 560 void ST7735::drawTriangle(int16_t x0, int16_t y0, int16_t x1, int16_t y1, int16_t x2, int16_t y2, uint16_t color) {
rolo644u 0:3015b613b20d 561 drawLine(x0, y0, x1, y1, color);
rolo644u 0:3015b613b20d 562 drawLine(x1, y1, x2, y2, color);
rolo644u 0:3015b613b20d 563 drawLine(x2, y2, x0, y0, color);
rolo644u 0:3015b613b20d 564 }
rolo644u 0:3015b613b20d 565
rolo644u 0:3015b613b20d 566 // Fill a triangle
rolo644u 0:3015b613b20d 567 void ST7735::fillTriangle ( int16_t x0, int16_t y0, int16_t x1, int16_t y1, int16_t x2, int16_t y2, uint16_t color) {
rolo644u 0:3015b613b20d 568
rolo644u 0:3015b613b20d 569 int16_t a, b, y, last;
rolo644u 0:3015b613b20d 570
rolo644u 0:3015b613b20d 571 // Sort coordinates by Y order (y2 >= y1 >= y0)
rolo644u 0:3015b613b20d 572 if (y0 > y1) {
rolo644u 0:3015b613b20d 573 swap(y0, y1); swap(x0, x1);
rolo644u 0:3015b613b20d 574 }
rolo644u 0:3015b613b20d 575 if (y1 > y2) {
rolo644u 0:3015b613b20d 576 swap(y2, y1); swap(x2, x1);
rolo644u 0:3015b613b20d 577 }
rolo644u 0:3015b613b20d 578 if (y0 > y1) {
rolo644u 0:3015b613b20d 579 swap(y0, y1); swap(x0, x1);
rolo644u 0:3015b613b20d 580 }
rolo644u 0:3015b613b20d 581
rolo644u 0:3015b613b20d 582 if(y0 == y2) { // Handle awkward all-on-same-line case as its own thing
rolo644u 0:3015b613b20d 583 a = b = x0;
rolo644u 0:3015b613b20d 584 if(x1 < a) a = x1;
rolo644u 0:3015b613b20d 585 else if(x1 > b) b = x1;
rolo644u 0:3015b613b20d 586 if(x2 < a) a = x2;
rolo644u 0:3015b613b20d 587 else if(x2 > b) b = x2;
rolo644u 0:3015b613b20d 588 drawFastHLine(a, y0, b-a+1, color);
rolo644u 0:3015b613b20d 589 return;
rolo644u 0:3015b613b20d 590 }
rolo644u 0:3015b613b20d 591
rolo644u 0:3015b613b20d 592 int16_t
rolo644u 0:3015b613b20d 593 dx01 = x1 - x0,
rolo644u 0:3015b613b20d 594 dy01 = y1 - y0,
rolo644u 0:3015b613b20d 595 dx02 = x2 - x0,
rolo644u 0:3015b613b20d 596 dy02 = y2 - y0,
rolo644u 0:3015b613b20d 597 dx12 = x2 - x1,
rolo644u 0:3015b613b20d 598 dy12 = y2 - y1,
rolo644u 0:3015b613b20d 599 sa = 0,
rolo644u 0:3015b613b20d 600 sb = 0;
rolo644u 0:3015b613b20d 601
rolo644u 0:3015b613b20d 602 // For upper part of triangle, find scanline crossings for segments
rolo644u 0:3015b613b20d 603 // 0-1 and 0-2. If y1=y2 (flat-bottomed triangle), the scanline y1
rolo644u 0:3015b613b20d 604 // is included here (and second loop will be skipped, avoiding a /0
rolo644u 0:3015b613b20d 605 // error there), otherwise scanline y1 is skipped here and handled
rolo644u 0:3015b613b20d 606 // in the second loop...which also avoids a /0 error here if y0=y1
rolo644u 0:3015b613b20d 607 // (flat-topped triangle).
rolo644u 0:3015b613b20d 608 if(y1 == y2) last = y1; // Include y1 scanline
rolo644u 0:3015b613b20d 609 else last = y1-1; // Skip it
rolo644u 0:3015b613b20d 610
rolo644u 0:3015b613b20d 611 for(y=y0; y<=last; y++) {
rolo644u 0:3015b613b20d 612 a = x0 + sa / dy01;
rolo644u 0:3015b613b20d 613 b = x0 + sb / dy02;
rolo644u 0:3015b613b20d 614 sa += dx01;
rolo644u 0:3015b613b20d 615 sb += dx02;
rolo644u 0:3015b613b20d 616 /* longhand:
rolo644u 0:3015b613b20d 617 a = x0 + (x1 - x0) * (y - y0) / (y1 - y0);
rolo644u 0:3015b613b20d 618 b = x0 + (x2 - x0) * (y - y0) / (y2 - y0);
rolo644u 0:3015b613b20d 619 */
rolo644u 0:3015b613b20d 620 if(a > b) swap(a,b);
rolo644u 0:3015b613b20d 621 drawFastHLine(a, y, b-a+1, color);
rolo644u 0:3015b613b20d 622 }
rolo644u 0:3015b613b20d 623
rolo644u 0:3015b613b20d 624 // For lower part of triangle, find scanline crossings for segments
rolo644u 0:3015b613b20d 625 // 0-2 and 1-2. This loop is skipped if y1=y2.
rolo644u 0:3015b613b20d 626 sa = dx12 * (y - y1);
rolo644u 0:3015b613b20d 627 sb = dx02 * (y - y0);
rolo644u 0:3015b613b20d 628 for(; y<=y2; y++) {
rolo644u 0:3015b613b20d 629 a = x1 + sa / dy12;
rolo644u 0:3015b613b20d 630 b = x0 + sb / dy02;
rolo644u 0:3015b613b20d 631 sa += dx12;
rolo644u 0:3015b613b20d 632 sb += dx02;
rolo644u 0:3015b613b20d 633 /* longhand:
rolo644u 0:3015b613b20d 634 a = x1 + (x2 - x1) * (y - y1) / (y2 - y1);
rolo644u 0:3015b613b20d 635 b = x0 + (x2 - x0) * (y - y0) / (y2 - y0);
rolo644u 0:3015b613b20d 636 */
rolo644u 0:3015b613b20d 637 if(a > b) swap(a,b);
rolo644u 0:3015b613b20d 638 drawFastHLine(a, y, b-a+1, color);
rolo644u 0:3015b613b20d 639 }
rolo644u 0:3015b613b20d 640 }
rolo644u 0:3015b613b20d 641
rolo644u 0:3015b613b20d 642 // Draw a rounded rectangle
rolo644u 0:3015b613b20d 643 void ST7735::drawRoundRect(int16_t x, int16_t y, int16_t w, int16_t h, int16_t r, uint16_t color) {
rolo644u 0:3015b613b20d 644 // smarter version
rolo644u 0:3015b613b20d 645 drawFastHLine(x+r , y , w-2*r, color); // Top
rolo644u 0:3015b613b20d 646 drawFastHLine(x+r , y+h-1, w-2*r, color); // Bottom
rolo644u 0:3015b613b20d 647 drawFastVLine(x , y+r , h-2*r, color); // Left
rolo644u 0:3015b613b20d 648 drawFastVLine(x+w-1, y+r , h-2*r, color); // Right
rolo644u 0:3015b613b20d 649 // draw four corners
rolo644u 0:3015b613b20d 650 drawCircleHelper(x+r , y+r , r, 1, color);
rolo644u 0:3015b613b20d 651 drawCircleHelper(x+w-r-1, y+r , r, 2, color);
rolo644u 0:3015b613b20d 652 drawCircleHelper(x+w-r-1, y+h-r-1, r, 4, color);
rolo644u 0:3015b613b20d 653 drawCircleHelper(x+r , y+h-r-1, r, 8, color);
rolo644u 0:3015b613b20d 654 }
rolo644u 0:3015b613b20d 655
rolo644u 0:3015b613b20d 656 // Fill a rounded rectangle
rolo644u 0:3015b613b20d 657 void ST7735::fillRoundRect(int16_t x, int16_t y, int16_t w, int16_t h, int16_t r, uint16_t color) {
rolo644u 0:3015b613b20d 658 // smarter version
rolo644u 0:3015b613b20d 659 fillRect(x+r, y, w-2*r, h, color);
rolo644u 0:3015b613b20d 660
rolo644u 0:3015b613b20d 661 // draw four corners
rolo644u 0:3015b613b20d 662 fillCircleHelper(x+w-r-1, y+r, r, 1, h-2*r-1, color);
rolo644u 0:3015b613b20d 663 fillCircleHelper(x+r , y+r, r, 2, h-2*r-1, color);
rolo644u 0:3015b613b20d 664 }
rolo644u 0:3015b613b20d 665
rolo644u 0:3015b613b20d 666 void ST7735::setCursor(int16_t x, int16_t y) {
rolo644u 0:3015b613b20d 667 cursor_x = x;
rolo644u 0:3015b613b20d 668 cursor_y = y;
rolo644u 0:3015b613b20d 669 }
rolo644u 0:3015b613b20d 670
rolo644u 0:3015b613b20d 671 void ST7735::setTextSize(uint8_t s) {
rolo644u 0:3015b613b20d 672 textsize = (s > 0) ? s : 1;
rolo644u 0:3015b613b20d 673 }
rolo644u 0:3015b613b20d 674
rolo644u 0:3015b613b20d 675
rolo644u 0:3015b613b20d 676 void ST7735::setTextColor(uint16_t c) {
rolo644u 0:3015b613b20d 677 // For 'transparent' background, we'll set the bg
rolo644u 0:3015b613b20d 678 // to the same as fg instead of using a flag
rolo644u 0:3015b613b20d 679 textcolor = textbgcolor = c;
rolo644u 0:3015b613b20d 680 }
rolo644u 0:3015b613b20d 681
rolo644u 0:3015b613b20d 682 void ST7735::setTextColor(uint16_t c, uint16_t b) {
rolo644u 0:3015b613b20d 683 textcolor = c;
rolo644u 0:3015b613b20d 684 textbgcolor = b;
rolo644u 0:3015b613b20d 685 }
rolo644u 0:3015b613b20d 686
rolo644u 0:3015b613b20d 687 void ST7735::setTextWrap(bool w) {
rolo644u 0:3015b613b20d 688 wrap = w;
rolo644u 0:3015b613b20d 689 }
rolo644u 0:3015b613b20d 690
rolo644u 0:3015b613b20d 691 uint8_t ST7735::getRotation(void) {
rolo644u 0:3015b613b20d 692 return rotation;
rolo644u 0:3015b613b20d 693 }
rolo644u 0:3015b613b20d 694
rolo644u 0:3015b613b20d 695 void ST7735::drawBitmap(int16_t x, int16_t y, const uint8_t *bitmap, int16_t w, int16_t h, uint16_t color) {
rolo644u 0:3015b613b20d 696
rolo644u 0:3015b613b20d 697 int16_t i, j, byteWidth = (w + 7) / 8;
rolo644u 0:3015b613b20d 698
rolo644u 0:3015b613b20d 699 for(j=0; j<h; j++) {
rolo644u 0:3015b613b20d 700 for(i=0; i<w; i++ ) {
rolo644u 0:3015b613b20d 701 if(pgm_read_byte(bitmap + j * byteWidth + i / 8) & (128 >> (i & 7))) {
rolo644u 0:3015b613b20d 702 drawPixel(x+i, y+j, color);
rolo644u 0:3015b613b20d 703 }
rolo644u 0:3015b613b20d 704 }
rolo644u 0:3015b613b20d 705 }
rolo644u 0:3015b613b20d 706 }
rolo644u 0:3015b613b20d 707
rolo644u 0:3015b613b20d 708
rolo644u 0:3015b613b20d 709 /***************************************************************************************
rolo644u 0:3015b613b20d 710 ** Function name: drawUnicode
rolo644u 0:3015b613b20d 711 ** Descriptions: draw a unicode
rolo644u 0:3015b613b20d 712 ***************************************************************************************/
rolo644u 0:3015b613b20d 713 int ST7735::drawUnicode(unsigned int uniCode, int x, int y, int font)
rolo644u 0:3015b613b20d 714 {
rolo644u 0:3015b613b20d 715
rolo644u 0:3015b613b20d 716 if (font) uniCode -= 32;
rolo644u 0:3015b613b20d 717
rolo644u 0:3015b613b20d 718 unsigned int width = 0;
rolo644u 0:3015b613b20d 719 unsigned int height = 0;
rolo644u 0:3015b613b20d 720 unsigned int flash_address = 0;
rolo644u 0:3015b613b20d 721 int8_t gap = 0;
rolo644u 0:3015b613b20d 722
rolo644u 0:3015b613b20d 723 // if (size == 1) {
rolo644u 0:3015b613b20d 724 // flash_address = pgm_read_word(&chrtbl_f8[uniCode]);
rolo644u 0:3015b613b20d 725 // width = pgm_read_byte(widtbl_f8+uniCode);
rolo644u 0:3015b613b20d 726 // height = chr_hgt_f8;
rolo644u 0:3015b613b20d 727 // gap = 1;
rolo644u 0:3015b613b20d 728 // }
rolo644u 0:3015b613b20d 729 #ifdef LOAD_FONT2
rolo644u 0:3015b613b20d 730 if (font == 2) {
rolo644u 0:3015b613b20d 731 flash_address = pgm_read_word(&chrtbl_f16[uniCode]);
rolo644u 0:3015b613b20d 732 width = pgm_read_byte(widtbl_f16+uniCode);
rolo644u 0:3015b613b20d 733 height = chr_hgt_f16;
rolo644u 0:3015b613b20d 734 gap = 1;
rolo644u 0:3015b613b20d 735 }
rolo644u 0:3015b613b20d 736 #endif
rolo644u 0:3015b613b20d 737 // if (font == 3) {
rolo644u 0:3015b613b20d 738 // flash_address = pgm_read_word(&chrtbl_f24[uniCode]);
rolo644u 0:3015b613b20d 739 // width = pgm_read_byte(widtbl_f24+uniCode);
rolo644u 0:3015b613b20d 740 // height = chr_hgt_f24;
rolo644u 0:3015b613b20d 741 // gap = 0;
rolo644u 0:3015b613b20d 742 // }
rolo644u 0:3015b613b20d 743 #ifdef LOAD_FONT4
rolo644u 0:3015b613b20d 744 if (font == 4) {
rolo644u 0:3015b613b20d 745 flash_address = pgm_read_word(&chrtbl_f32[uniCode]);
rolo644u 0:3015b613b20d 746 width = pgm_read_byte(widtbl_f32+uniCode);
rolo644u 0:3015b613b20d 747 height = chr_hgt_f32;
rolo644u 0:3015b613b20d 748 gap = -3;
rolo644u 0:3015b613b20d 749 }
rolo644u 0:3015b613b20d 750 #endif
rolo644u 0:3015b613b20d 751 // if (font == 5) {
rolo644u 0:3015b613b20d 752 // flash_address = pgm_read_word(&chrtbl_f48[uniCode]);
rolo644u 0:3015b613b20d 753 // width = pgm_read_byte(widtbl_f48+uniCode);
rolo644u 0:3015b613b20d 754 // height = chr_hgt_f48;
rolo644u 0:3015b613b20d 755 // gap = -3;
rolo644u 0:3015b613b20d 756 // }
rolo644u 0:3015b613b20d 757 #ifdef LOAD_FONT6
rolo644u 0:3015b613b20d 758 if (font == 6) {
rolo644u 0:3015b613b20d 759 flash_address = pgm_read_word(&chrtbl_f64[uniCode]);
rolo644u 0:3015b613b20d 760 width = pgm_read_byte(widtbl_f64+uniCode);
rolo644u 0:3015b613b20d 761 height = chr_hgt_f64;
rolo644u 0:3015b613b20d 762 gap = -3;
rolo644u 0:3015b613b20d 763 }
rolo644u 0:3015b613b20d 764 #endif
rolo644u 0:3015b613b20d 765 #ifdef LOAD_FONT7
rolo644u 0:3015b613b20d 766 if (font == 7) {
rolo644u 0:3015b613b20d 767 flash_address = pgm_read_word(&chrtbl_f7s[uniCode]);
rolo644u 0:3015b613b20d 768 width = pgm_read_byte(widtbl_f7s+uniCode);
rolo644u 0:3015b613b20d 769 height = chr_hgt_f7s;
rolo644u 0:3015b613b20d 770 gap = 2;
rolo644u 0:3015b613b20d 771 }
rolo644u 0:3015b613b20d 772 #endif
rolo644u 0:3015b613b20d 773 #ifdef LOAD_FONT8
rolo644u 0:3015b613b20d 774 if (font == 8) {
rolo644u 0:3015b613b20d 775 flash_address = pgm_read_word(&chrtbl_f72[uniCode]);
rolo644u 0:3015b613b20d 776 width = pgm_read_byte(widtbl_f72+uniCode);
rolo644u 0:3015b613b20d 777 height = chr_hgt_f72;
rolo644u 0:3015b613b20d 778 gap = 2;
rolo644u 0:3015b613b20d 779 }
rolo644u 0:3015b613b20d 780 #endif
rolo644u 0:3015b613b20d 781
rolo644u 0:3015b613b20d 782
rolo644u 0:3015b613b20d 783 int w = (width+7)/8;
rolo644u 0:3015b613b20d 784 int pX = 0;
rolo644u 0:3015b613b20d 785 int pY = y;
rolo644u 1:6a6d8d2b19f1 786 //int color = 0;
rolo644u 0:3015b613b20d 787 char line = 0;
rolo644u 0:3015b613b20d 788
rolo644u 0:3015b613b20d 789 //fillRect(x,pY,width+gap,height,textbgcolor);
rolo644u 0:3015b613b20d 790
rolo644u 0:3015b613b20d 791 for(int i=0; i<height; i++)
rolo644u 0:3015b613b20d 792 {
rolo644u 0:3015b613b20d 793 if (textcolor != textbgcolor) {
rolo644u 0:3015b613b20d 794 if (textsize == 1) drawFastHLine(x, pY, width+gap, textbgcolor);
rolo644u 0:3015b613b20d 795 else fillRect(x, pY, (width+gap)*textsize, textsize, textbgcolor);
rolo644u 0:3015b613b20d 796 }
rolo644u 0:3015b613b20d 797 for (int k = 0;k < w; k++)
rolo644u 0:3015b613b20d 798 {
rolo644u 0:3015b613b20d 799 line = pgm_read_byte(flash_address+w*i+k);
rolo644u 0:3015b613b20d 800 if(line) {
rolo644u 0:3015b613b20d 801 if (textsize==1){
rolo644u 0:3015b613b20d 802 pX = x + k*8;
rolo644u 0:3015b613b20d 803 if(line & 0x80) drawPixel(pX, pY, textcolor);
rolo644u 0:3015b613b20d 804 if(line & 0x40) drawPixel(pX+1, pY, textcolor);
rolo644u 0:3015b613b20d 805 if(line & 0x20) drawPixel(pX+2, pY, textcolor);
rolo644u 0:3015b613b20d 806 if(line & 0x10) drawPixel(pX+3, pY, textcolor);
rolo644u 0:3015b613b20d 807 if(line & 0x8) drawPixel(pX+4, pY, textcolor);
rolo644u 0:3015b613b20d 808 if(line & 0x4) drawPixel(pX+5, pY, textcolor);
rolo644u 0:3015b613b20d 809 if(line & 0x2) drawPixel(pX+6, pY, textcolor);
rolo644u 0:3015b613b20d 810 if(line & 0x1) drawPixel(pX+7, pY, textcolor);
rolo644u 0:3015b613b20d 811 }
rolo644u 0:3015b613b20d 812 else {
rolo644u 0:3015b613b20d 813 pX = x + k*8*textsize;
rolo644u 0:3015b613b20d 814 if(line & 0x80) fillRect(pX, pY, textsize, textsize, textcolor);
rolo644u 0:3015b613b20d 815 if(line & 0x40) fillRect(pX+textsize, pY, textsize, textsize, textcolor);
rolo644u 0:3015b613b20d 816 if(line & 0x20) fillRect(pX+2*textsize, pY, textsize, textsize, textcolor);
rolo644u 0:3015b613b20d 817 if(line & 0x10) fillRect(pX+3*textsize, pY, textsize, textsize, textcolor);
rolo644u 0:3015b613b20d 818 if(line & 0x8) fillRect(pX+4*textsize, pY, textsize, textsize, textcolor);
rolo644u 0:3015b613b20d 819 if(line & 0x4) fillRect(pX+5*textsize, pY, textsize, textsize, textcolor);
rolo644u 0:3015b613b20d 820 if(line & 0x2) fillRect(pX+6*textsize, pY, textsize, textsize, textcolor);
rolo644u 0:3015b613b20d 821 if(line & 0x1) fillRect(pX+7*textsize, pY, textsize, textsize, textcolor);
rolo644u 0:3015b613b20d 822 }
rolo644u 0:3015b613b20d 823 }
rolo644u 0:3015b613b20d 824 }
rolo644u 0:3015b613b20d 825 pY+=textsize;
rolo644u 0:3015b613b20d 826 }
rolo644u 0:3015b613b20d 827 return (width+gap)*textsize; // x +
rolo644u 0:3015b613b20d 828 }
rolo644u 0:3015b613b20d 829
rolo644u 0:3015b613b20d 830 /***************************************************************************************
rolo644u 0:3015b613b20d 831 ** Function name: drawNumber unsigned with size
rolo644u 0:3015b613b20d 832 ** Descriptions: drawNumber
rolo644u 0:3015b613b20d 833 ***************************************************************************************/
rolo644u 0:3015b613b20d 834 int ST7735::drawNumber(long long_num,int poX, int poY, int font)
rolo644u 0:3015b613b20d 835 {
rolo644u 0:3015b613b20d 836 char tmp[10];
rolo644u 0:3015b613b20d 837 if (long_num < 0) sprintf(tmp, "%li", long_num);
rolo644u 0:3015b613b20d 838 else sprintf(tmp, "%lu", long_num);
rolo644u 0:3015b613b20d 839 return drawString(tmp, poX, poY, font);
rolo644u 0:3015b613b20d 840 }
rolo644u 0:3015b613b20d 841
rolo644u 0:3015b613b20d 842 /***************************************************************************************
rolo644u 0:3015b613b20d 843 ** Function name: drawChar
rolo644u 0:3015b613b20d 844 ** Descriptions: draw char
rolo644u 0:3015b613b20d 845 ***************************************************************************************/
rolo644u 0:3015b613b20d 846 int ST7735::drawChar(char c, int x, int y, int font)
rolo644u 0:3015b613b20d 847 {
rolo644u 0:3015b613b20d 848 return drawUnicode(c, x, y, font);
rolo644u 0:3015b613b20d 849 }
rolo644u 0:3015b613b20d 850
rolo644u 0:3015b613b20d 851 /***************************************************************************************
rolo644u 0:3015b613b20d 852 ** Function name: drawString
rolo644u 0:3015b613b20d 853 ** Descriptions: draw string
rolo644u 0:3015b613b20d 854 ***************************************************************************************/
rolo644u 0:3015b613b20d 855 int ST7735::drawString(char *string, int poX, int poY, int font)
rolo644u 0:3015b613b20d 856 {
rolo644u 0:3015b613b20d 857 int sumX = 0;
rolo644u 0:3015b613b20d 858
rolo644u 0:3015b613b20d 859 while(*string)
rolo644u 0:3015b613b20d 860 {
rolo644u 0:3015b613b20d 861 int xPlus = drawChar(*string, poX, poY, font);
rolo644u 0:3015b613b20d 862 sumX += xPlus;
rolo644u 0:3015b613b20d 863 *string++;
rolo644u 0:3015b613b20d 864 poX += xPlus; /* Move cursor right */
rolo644u 0:3015b613b20d 865 }
rolo644u 0:3015b613b20d 866 return sumX;
rolo644u 0:3015b613b20d 867 }
rolo644u 0:3015b613b20d 868
rolo644u 0:3015b613b20d 869 /***************************************************************************************
rolo644u 0:3015b613b20d 870 ** Function name: drawCentreString
rolo644u 0:3015b613b20d 871 ** Descriptions: draw string across centre
rolo644u 0:3015b613b20d 872 ***************************************************************************************/
rolo644u 0:3015b613b20d 873 int ST7735::drawCentreString(char *string, int dX, int poY, int font)
rolo644u 0:3015b613b20d 874 {
rolo644u 0:3015b613b20d 875 int sumX = 0;
rolo644u 0:3015b613b20d 876 int len = 0;
rolo644u 0:3015b613b20d 877 char *pointer = string;
rolo644u 0:3015b613b20d 878 char ascii;
rolo644u 0:3015b613b20d 879
rolo644u 0:3015b613b20d 880 while(*pointer)
rolo644u 0:3015b613b20d 881 {
rolo644u 0:3015b613b20d 882 ascii = *pointer;
rolo644u 0:3015b613b20d 883 //if (font==0)len += 1+pgm_read_byte(widtbl_log+ascii);
rolo644u 0:3015b613b20d 884 //if (font==1)len += 1+pgm_read_byte(widtbl_f8+ascii-32);
rolo644u 0:3015b613b20d 885 #ifdef LOAD_FONT2
rolo644u 0:3015b613b20d 886 if (font==2)len += 1+pgm_read_byte(widtbl_f16+ascii-32);
rolo644u 0:3015b613b20d 887 #endif
rolo644u 0:3015b613b20d 888 //if (font==3)len += 1+pgm_read_byte(widtbl_f48+ascii-32)/2;
rolo644u 0:3015b613b20d 889 #ifdef LOAD_FONT4
rolo644u 0:3015b613b20d 890 if (font==4)len += pgm_read_byte(widtbl_f32+ascii-32)-3;
rolo644u 0:3015b613b20d 891 #endif
rolo644u 0:3015b613b20d 892 //if (font==5) len += pgm_read_byte(widtbl_f48+ascii-32)-3;
rolo644u 0:3015b613b20d 893 #ifdef LOAD_FONT6
rolo644u 0:3015b613b20d 894 if (font==6) len += pgm_read_byte(widtbl_f64+ascii-32)-3;
rolo644u 0:3015b613b20d 895 #endif
rolo644u 0:3015b613b20d 896 #ifdef LOAD_FONT7
rolo644u 0:3015b613b20d 897 if (font==7) len += pgm_read_byte(widtbl_f7s+ascii-32)+2;
rolo644u 0:3015b613b20d 898 #endif
rolo644u 0:3015b613b20d 899 #ifdef LOAD_FONT8
rolo644u 0:3015b613b20d 900 if (font==8) len += pgm_read_byte(widtbl_f72+ascii-32)+2;
rolo644u 0:3015b613b20d 901 #endif
rolo644u 0:3015b613b20d 902 *pointer++;
rolo644u 0:3015b613b20d 903 }
rolo644u 0:3015b613b20d 904 len = len*textsize;
rolo644u 0:3015b613b20d 905 int poX = dX - len/2;
rolo644u 0:3015b613b20d 906
rolo644u 0:3015b613b20d 907 if (poX < 0) poX = 0;
rolo644u 0:3015b613b20d 908
rolo644u 0:3015b613b20d 909 while(*string)
rolo644u 0:3015b613b20d 910 {
rolo644u 0:3015b613b20d 911
rolo644u 0:3015b613b20d 912 int xPlus = drawChar(*string, poX, poY, font);
rolo644u 0:3015b613b20d 913 sumX += xPlus;
rolo644u 0:3015b613b20d 914 *string++;
rolo644u 0:3015b613b20d 915 poX += xPlus; /* Move cursor right */
rolo644u 0:3015b613b20d 916 }
rolo644u 0:3015b613b20d 917
rolo644u 0:3015b613b20d 918 return sumX;
rolo644u 0:3015b613b20d 919 }
rolo644u 0:3015b613b20d 920
rolo644u 0:3015b613b20d 921 /***************************************************************************************
rolo644u 0:3015b613b20d 922 ** Function name: drawRightString
rolo644u 0:3015b613b20d 923 ** Descriptions: draw string right justified
rolo644u 0:3015b613b20d 924 ***************************************************************************************/
rolo644u 0:3015b613b20d 925 int ST7735::drawRightString(char *string, int dX, int poY, int font)
rolo644u 0:3015b613b20d 926 {
rolo644u 0:3015b613b20d 927 int sumX = 0;
rolo644u 0:3015b613b20d 928 int len = 0;
rolo644u 0:3015b613b20d 929 char *pointer = string;
rolo644u 0:3015b613b20d 930 char ascii;
rolo644u 0:3015b613b20d 931
rolo644u 0:3015b613b20d 932 while(*pointer)
rolo644u 0:3015b613b20d 933 {
rolo644u 0:3015b613b20d 934 ascii = *pointer;
rolo644u 0:3015b613b20d 935 //if (font==0)len += 1+pgm_read_byte(widtbl_log+ascii);
rolo644u 0:3015b613b20d 936 //if (font==1)len += 1+pgm_read_byte(widtbl_f8+ascii-32);
rolo644u 0:3015b613b20d 937 #ifdef LOAD_FONT2
rolo644u 0:3015b613b20d 938 if (font==2)len += 1+pgm_read_byte(widtbl_f16+ascii-32);
rolo644u 0:3015b613b20d 939 #endif
rolo644u 0:3015b613b20d 940 //if (font==3)len += 1+pgm_read_byte(widtbl_f48+ascii-32)/2;
rolo644u 0:3015b613b20d 941 #ifdef LOAD_FONT4
rolo644u 0:3015b613b20d 942 if (font==4)len += pgm_read_byte(widtbl_f32+ascii-32)-3;
rolo644u 0:3015b613b20d 943 #endif
rolo644u 0:3015b613b20d 944 //if (font==5) len += pgm_read_byte(widtbl_f48+ascii-32)-3;
rolo644u 0:3015b613b20d 945 #ifdef LOAD_FONT6
rolo644u 0:3015b613b20d 946 if (font==6) len += pgm_read_byte(widtbl_f64+ascii-32)-3;
rolo644u 0:3015b613b20d 947 #endif
rolo644u 0:3015b613b20d 948 #ifdef LOAD_FONT7
rolo644u 0:3015b613b20d 949 if (font==7) len += pgm_read_byte(widtbl_f7s+ascii-32)+2;
rolo644u 0:3015b613b20d 950 #endif
rolo644u 0:3015b613b20d 951 #ifdef LOAD_FONT8
rolo644u 0:3015b613b20d 952 if (font==8) len += pgm_read_byte(widtbl_f72+ascii-32)+2;
rolo644u 0:3015b613b20d 953 #endif
rolo644u 0:3015b613b20d 954 *pointer++;
rolo644u 0:3015b613b20d 955 }
rolo644u 0:3015b613b20d 956
rolo644u 0:3015b613b20d 957 len = len*textsize;
rolo644u 0:3015b613b20d 958 int poX = dX - len;
rolo644u 0:3015b613b20d 959
rolo644u 0:3015b613b20d 960 if (poX < 0) poX = 0;
rolo644u 0:3015b613b20d 961
rolo644u 0:3015b613b20d 962 while(*string)
rolo644u 0:3015b613b20d 963 {
rolo644u 0:3015b613b20d 964
rolo644u 0:3015b613b20d 965 int xPlus = drawChar(*string, poX, poY, font);
rolo644u 0:3015b613b20d 966 sumX += xPlus;
rolo644u 0:3015b613b20d 967 *string++;
rolo644u 0:3015b613b20d 968 poX += xPlus; /* Move cursor right */
rolo644u 0:3015b613b20d 969 }
rolo644u 0:3015b613b20d 970
rolo644u 0:3015b613b20d 971 return sumX;
rolo644u 0:3015b613b20d 972 }
rolo644u 0:3015b613b20d 973
rolo644u 0:3015b613b20d 974 /***************************************************************************************
rolo644u 0:3015b613b20d 975 ** Function name: drawFloat
rolo644u 0:3015b613b20d 976 ** Descriptions: drawFloat
rolo644u 0:3015b613b20d 977 ***************************************************************************************/
rolo644u 0:3015b613b20d 978 int ST7735::drawFloat(float floatNumber, int decimal, int poX, int poY, int font)
rolo644u 0:3015b613b20d 979 {
rolo644u 0:3015b613b20d 980 unsigned long temp=0;
rolo644u 0:3015b613b20d 981 float decy=0.0;
rolo644u 0:3015b613b20d 982 float rounding = 0.5;
rolo644u 0:3015b613b20d 983
rolo644u 0:3015b613b20d 984 float eep = 0.000001;
rolo644u 0:3015b613b20d 985
rolo644u 0:3015b613b20d 986 int sumX = 0;
rolo644u 0:3015b613b20d 987 int xPlus = 0;
rolo644u 0:3015b613b20d 988
rolo644u 0:3015b613b20d 989 if(floatNumber-0.0 < eep) // floatNumber < 0
rolo644u 0:3015b613b20d 990 {
rolo644u 0:3015b613b20d 991 xPlus = drawChar('-',poX, poY, font);
rolo644u 0:3015b613b20d 992 floatNumber = -floatNumber;
rolo644u 0:3015b613b20d 993
rolo644u 0:3015b613b20d 994 poX += xPlus;
rolo644u 0:3015b613b20d 995 sumX += xPlus;
rolo644u 0:3015b613b20d 996 }
rolo644u 0:3015b613b20d 997
rolo644u 0:3015b613b20d 998 for (unsigned char i=0; i<decimal; ++i)
rolo644u 0:3015b613b20d 999 {
rolo644u 0:3015b613b20d 1000 rounding /= 10.0;
rolo644u 0:3015b613b20d 1001 }
rolo644u 0:3015b613b20d 1002
rolo644u 0:3015b613b20d 1003 floatNumber += rounding;
rolo644u 0:3015b613b20d 1004
rolo644u 0:3015b613b20d 1005 temp = (long)floatNumber;
rolo644u 0:3015b613b20d 1006
rolo644u 0:3015b613b20d 1007
rolo644u 0:3015b613b20d 1008 xPlus = drawNumber(temp,poX, poY, font);
rolo644u 0:3015b613b20d 1009
rolo644u 0:3015b613b20d 1010 poX += xPlus;
rolo644u 0:3015b613b20d 1011 sumX += xPlus;
rolo644u 0:3015b613b20d 1012
rolo644u 0:3015b613b20d 1013 if(decimal>0)
rolo644u 0:3015b613b20d 1014 {
rolo644u 0:3015b613b20d 1015 xPlus = drawChar('.',poX, poY, font);
rolo644u 0:3015b613b20d 1016 poX += xPlus; /* Move cursor right */
rolo644u 0:3015b613b20d 1017 sumX += xPlus;
rolo644u 0:3015b613b20d 1018 }
rolo644u 0:3015b613b20d 1019 else
rolo644u 0:3015b613b20d 1020 {
rolo644u 0:3015b613b20d 1021 return sumX;
rolo644u 0:3015b613b20d 1022 }
rolo644u 0:3015b613b20d 1023
rolo644u 0:3015b613b20d 1024 decy = floatNumber - temp;
rolo644u 0:3015b613b20d 1025 for(unsigned char i=0; i<decimal; i++)
rolo644u 0:3015b613b20d 1026 {
rolo644u 0:3015b613b20d 1027 decy *= 10; /* for the next decimal */
rolo644u 0:3015b613b20d 1028 temp = decy; /* get the decimal */
rolo644u 0:3015b613b20d 1029 xPlus = drawNumber(temp,poX, poY, font);
rolo644u 0:3015b613b20d 1030
rolo644u 0:3015b613b20d 1031 poX += xPlus; /* Move cursor right */
rolo644u 0:3015b613b20d 1032 sumX += xPlus;
rolo644u 0:3015b613b20d 1033 decy -= temp;
rolo644u 0:3015b613b20d 1034 }
rolo644u 0:3015b613b20d 1035 return sumX;
rolo644u 0:3015b613b20d 1036 }
rolo644u 0:3015b613b20d 1037
rolo644u 1:6a6d8d2b19f1 1038 void ST7735::setAddrWindow(uint8_t x0, uint8_t y0, uint8_t x1, uint8_t y1) {
rolo644u 1:6a6d8d2b19f1 1039
rolo644u 1:6a6d8d2b19f1 1040 writecommand(ST7735_CASET); // Column addr set
rolo644u 1:6a6d8d2b19f1 1041 writedata(0x00);
rolo644u 1:6a6d8d2b19f1 1042 writedata(x0+colstart); // XSTART
rolo644u 1:6a6d8d2b19f1 1043 writedata(0x00);
rolo644u 1:6a6d8d2b19f1 1044 writedata(x1+colstart); // XEND
rolo644u 1:6a6d8d2b19f1 1045
rolo644u 1:6a6d8d2b19f1 1046 writecommand(ST7735_RASET); // Row addr set
rolo644u 1:6a6d8d2b19f1 1047 writedata(0x00);
rolo644u 1:6a6d8d2b19f1 1048 writedata(y0+rowstart); // YSTART
rolo644u 1:6a6d8d2b19f1 1049 writedata(0x00);
rolo644u 1:6a6d8d2b19f1 1050 writedata(y1+rowstart); // YEND
rolo644u 1:6a6d8d2b19f1 1051
rolo644u 1:6a6d8d2b19f1 1052 writecommand(ST7735_RAMWR); // write to RAM
rolo644u 1:6a6d8d2b19f1 1053 }