Chris Taylor / LCD_ST7735 Featured

SPI based library for the ST7735 LCD controller.

Dependents:   RayCastingEngine RETRO_LCD_PerformanceTest RETRO_loop_test RETRO_RickGame ... more

LCD_ST7735.cpp@7:f39c980a589c, 2014-10-05 (annotated)

Committer:
taylorza
Date:
Sun Oct 05 23:57:36 2014 +0000
Revision:
7:f39c980a589c
Parent:
6:67d3d4a953e0
Child:
8:12f16befa7e1
Improved the ability for fast SPI to work with the standard mbed SPI

Who changed what in which revision?

UserRevisionLine numberNew contents of line
taylorza 0:7b3fb3085867 1 #include "mbed.h"
taylorza 0:7b3fb3085867 2 #include "LCD_ST7735.h"
taylorza 0:7b3fb3085867 3
taylorza 0:7b3fb3085867 4 LCD_ST7735::LCD_ST7735(
taylorza 0:7b3fb3085867 5 PinName backlightPin,
taylorza 0:7b3fb3085867 6 PinName resetPin,
taylorza 0:7b3fb3085867 7 PinName dsPin,
taylorza 0:7b3fb3085867 8 PinName mosiPin,
taylorza 0:7b3fb3085867 9 PinName misoPin,
taylorza 0:7b3fb3085867 10 PinName clkPin,
taylorza 0:7b3fb3085867 11 PinName csPin) :
taylorza 0:7b3fb3085867 12 _backlight(backlightPin, 0),
taylorza 0:7b3fb3085867 13 _reset(resetPin, 1),
taylorza 0:7b3fb3085867 14 _ds(dsPin, 0),
taylorza 0:7b3fb3085867 15 _cs(csPin, 1),
taylorza 0:7b3fb3085867 16 _spi(mosiPin, misoPin, clkPin)
taylorza 0:7b3fb3085867 17 {
taylorza 0:7b3fb3085867 18 _spi.format(8, 3);
taylorza 6:67d3d4a953e0 19 _spi.frequency(15000000);
taylorza 0:7b3fb3085867 20
taylorza 0:7b3fb3085867 21 initDisplay();
taylorza 0:7b3fb3085867 22 clearScreen();
taylorza 0:7b3fb3085867 23 setForegroundColor(0xffff);
taylorza 0:7b3fb3085867 24 setBackgroundColor(0x0000);
taylorza 0:7b3fb3085867 25 }
taylorza 0:7b3fb3085867 26
taylorza 3:451148656b76 27 void LCD_ST7735::setOrientation(Orientation orientation, bool flip)
taylorza 3:451148656b76 28 {
taylorza 5:21c987ee68d2 29 const static uint8_t my = 0x80;
taylorza 3:451148656b76 30 const static uint8_t mx = 0x40;
taylorza 3:451148656b76 31 const static uint8_t mv = 0x20;
taylorza 3:451148656b76 32
taylorza 3:451148656b76 33 uint8_t madctlData = 0x08;
taylorza 3:451148656b76 34 switch(orientation)
taylorza 3:451148656b76 35 {
taylorza 3:451148656b76 36 case Rotate0:
taylorza 3:451148656b76 37 _width = 128;
taylorza 3:451148656b76 38 _height = 160;
taylorza 3:451148656b76 39 madctlData |= flip ? mx : 0;
taylorza 3:451148656b76 40 break;
taylorza 3:451148656b76 41
taylorza 3:451148656b76 42 case Rotate90:
taylorza 3:451148656b76 43 _width = 160;
taylorza 3:451148656b76 44 _height = 128;
taylorza 3:451148656b76 45 madctlData |= flip ? my | mv | mx : mv | mx;
taylorza 3:451148656b76 46 break;
taylorza 3:451148656b76 47
taylorza 3:451148656b76 48 case Rotate180:
taylorza 3:451148656b76 49 _width = 128;
taylorza 3:451148656b76 50 _height = 160;
taylorza 3:451148656b76 51 madctlData |= flip ? my : mx | my;
taylorza 3:451148656b76 52 break;
taylorza 3:451148656b76 53
taylorza 3:451148656b76 54 case Rotate270:
taylorza 3:451148656b76 55 _width = 160;
taylorza 3:451148656b76 56 _height = 128;
taylorza 3:451148656b76 57 madctlData |= flip ? mv : mv | my;
taylorza 3:451148656b76 58 break;
taylorza 3:451148656b76 59 }
taylorza 3:451148656b76 60 write(CMD_MADCTL, (uint8_t[]){madctlData}, 1);
taylorza 3:451148656b76 61 }
taylorza 3:451148656b76 62
taylorza 3:451148656b76 63 int LCD_ST7735::getWidth()
taylorza 3:451148656b76 64 {
taylorza 3:451148656b76 65 return _width;
taylorza 3:451148656b76 66 }
taylorza 3:451148656b76 67
taylorza 3:451148656b76 68 int LCD_ST7735::getHeight()
taylorza 3:451148656b76 69 {
taylorza 3:451148656b76 70 return _height;
taylorza 3:451148656b76 71 }
taylorza 3:451148656b76 72
taylorza 0:7b3fb3085867 73 void LCD_ST7735::setBacklight(bool state)
taylorza 0:7b3fb3085867 74 {
taylorza 0:7b3fb3085867 75 _backlight = state ? 1 : 0;
taylorza 0:7b3fb3085867 76 }
taylorza 0:7b3fb3085867 77
taylorza 0:7b3fb3085867 78 void LCD_ST7735::clearScreen(uint16_t color)
taylorza 0:7b3fb3085867 79 {
taylorza 7:f39c980a589c 80 _spi.prepareFastSPI();
taylorza 3:451148656b76 81 clipRect(0, 0, _width - 1, _height - 1);
taylorza 0:7b3fb3085867 82 beginBatchCommand(CMD_RAMWR);
taylorza 4:88d22437119c 83 uint8_t colorHigh = color >> 8;
taylorza 4:88d22437119c 84 uint8_t colorLow = color;
taylorza 0:7b3fb3085867 85 for(int i = 0; i < 128 * 160 * 2; ++i)
taylorza 0:7b3fb3085867 86 {
taylorza 4:88d22437119c 87 writeBatchData(colorHigh, colorLow);
taylorza 0:7b3fb3085867 88 }
taylorza 0:7b3fb3085867 89 endBatchCommand();
taylorza 0:7b3fb3085867 90 }
taylorza 0:7b3fb3085867 91
taylorza 0:7b3fb3085867 92 void LCD_ST7735::setPixel(int x, int y, uint16_t color)
taylorza 0:7b3fb3085867 93 {
taylorza 7:f39c980a589c 94 _spi.prepareFastSPI();
taylorza 7:f39c980a589c 95 setPixelFast(x, y, color);
taylorza 0:7b3fb3085867 96 }
taylorza 0:7b3fb3085867 97
taylorza 0:7b3fb3085867 98 void LCD_ST7735::drawLine(int x1, int y1, int x2, int y2, uint16_t color)
taylorza 0:7b3fb3085867 99 {
taylorza 7:f39c980a589c 100 _spi.prepareFastSPI();
taylorza 0:7b3fb3085867 101 int dx = abs(x2 - x1);
taylorza 0:7b3fb3085867 102 int dy = abs(y2 - y1);
taylorza 0:7b3fb3085867 103
taylorza 0:7b3fb3085867 104 if (dx == 0)
taylorza 0:7b3fb3085867 105 {
taylorza 0:7b3fb3085867 106 drawVertLine(x1, y1, y2, color);
taylorza 0:7b3fb3085867 107 return;
taylorza 0:7b3fb3085867 108 }
taylorza 0:7b3fb3085867 109 else if(dy == 0)
taylorza 0:7b3fb3085867 110 {
taylorza 0:7b3fb3085867 111 drawHorizLine(x1, y1, x2, color);
taylorza 0:7b3fb3085867 112 return;
taylorza 0:7b3fb3085867 113 }
taylorza 0:7b3fb3085867 114
taylorza 0:7b3fb3085867 115 int sx = (x1 < x2) ? 1 : -1;
taylorza 0:7b3fb3085867 116 int sy = (y1 < y2) ? 1 : -1;
taylorza 0:7b3fb3085867 117 int err = dx - dy;
taylorza 0:7b3fb3085867 118 while(x1 != x2 || y1 != y2)
taylorza 0:7b3fb3085867 119 {
taylorza 7:f39c980a589c 120 setPixelFast(x1, y1, color);
taylorza 0:7b3fb3085867 121 int e2 = err << 1;
taylorza 0:7b3fb3085867 122 if (e2 > -dy)
taylorza 0:7b3fb3085867 123 {
taylorza 0:7b3fb3085867 124 err -= dy;
taylorza 0:7b3fb3085867 125 x1 += sx;
taylorza 0:7b3fb3085867 126 }
taylorza 0:7b3fb3085867 127 if (e2 < dx)
taylorza 0:7b3fb3085867 128 {
taylorza 0:7b3fb3085867 129 err += dx;
taylorza 0:7b3fb3085867 130 y1 += sy;
taylorza 0:7b3fb3085867 131 }
taylorza 0:7b3fb3085867 132 }
taylorza 7:f39c980a589c 133 setPixelFast(x2, y2, color);
taylorza 0:7b3fb3085867 134 }
taylorza 0:7b3fb3085867 135
taylorza 0:7b3fb3085867 136 void LCD_ST7735::swap(int &a, int &b)
taylorza 0:7b3fb3085867 137 {
taylorza 0:7b3fb3085867 138 int t = a;
taylorza 0:7b3fb3085867 139 a = b;
taylorza 0:7b3fb3085867 140 b = t;
taylorza 0:7b3fb3085867 141 }
taylorza 0:7b3fb3085867 142
taylorza 0:7b3fb3085867 143 void LCD_ST7735::drawRect(int x1, int y1, int x2, int y2, uint16_t color)
taylorza 0:7b3fb3085867 144 {
taylorza 7:f39c980a589c 145 _spi.prepareFastSPI();
taylorza 0:7b3fb3085867 146 if (x1 > x2) swap(x1, x2);
taylorza 0:7b3fb3085867 147 if (y1 > y2) swap(y1, y2);
taylorza 0:7b3fb3085867 148
taylorza 0:7b3fb3085867 149 drawHorizLine(x1, y1, x2, color);
taylorza 0:7b3fb3085867 150 drawHorizLine(x1, y2, x2, color);
taylorza 0:7b3fb3085867 151 drawVertLine(x1, y1, y2, color);
taylorza 0:7b3fb3085867 152 drawVertLine(x2, y1, y2, color);
taylorza 0:7b3fb3085867 153 }
taylorza 0:7b3fb3085867 154
taylorza 0:7b3fb3085867 155 void LCD_ST7735::drawCircle(int x, int y, int r, uint16_t color)
taylorza 0:7b3fb3085867 156 {
taylorza 7:f39c980a589c 157 _spi.prepareFastSPI();
taylorza 0:7b3fb3085867 158 int ix = r;
taylorza 0:7b3fb3085867 159 int iy = 0;
taylorza 0:7b3fb3085867 160 int err = 1 - r;
taylorza 0:7b3fb3085867 161
taylorza 0:7b3fb3085867 162 while(ix >= iy)
taylorza 0:7b3fb3085867 163 {
taylorza 7:f39c980a589c 164 setPixelFast(x + ix, y + iy, color);
taylorza 7:f39c980a589c 165 setPixelFast(x + iy, y + ix, color);
taylorza 7:f39c980a589c 166 setPixelFast(x - ix, y + iy, color);
taylorza 7:f39c980a589c 167 setPixelFast(x - iy, y + ix, color);
taylorza 7:f39c980a589c 168 setPixelFast(x - ix, y - iy, color);
taylorza 7:f39c980a589c 169 setPixelFast(x - iy, y - ix, color);
taylorza 7:f39c980a589c 170 setPixelFast(x + ix, y - iy, color);
taylorza 7:f39c980a589c 171 setPixelFast(x + iy, y - ix, color);
taylorza 0:7b3fb3085867 172 iy++;
taylorza 0:7b3fb3085867 173 if (err < 0)
taylorza 0:7b3fb3085867 174 {
taylorza 0:7b3fb3085867 175 err += 2 * iy + 1;
taylorza 0:7b3fb3085867 176 }
taylorza 0:7b3fb3085867 177 else
taylorza 0:7b3fb3085867 178 {
taylorza 0:7b3fb3085867 179 ix--;
taylorza 0:7b3fb3085867 180 err += 2 * (iy - ix + 1);
taylorza 0:7b3fb3085867 181 }
taylorza 0:7b3fb3085867 182 }
taylorza 0:7b3fb3085867 183 }
taylorza 0:7b3fb3085867 184
taylorza 1:33ff5fad4320 185 void LCD_ST7735::drawEllipse(int x, int y, int rx, int ry, uint16_t color)
taylorza 1:33ff5fad4320 186 {
taylorza 7:f39c980a589c 187 _spi.prepareFastSPI();
taylorza 1:33ff5fad4320 188 int a2 = rx * rx;
taylorza 1:33ff5fad4320 189 int b2 = ry * ry;
taylorza 1:33ff5fad4320 190 int fa2 = 4 * a2;
taylorza 1:33ff5fad4320 191 int fb2 = 4 * b2;
taylorza 1:33ff5fad4320 192
taylorza 1:33ff5fad4320 193 int ix, iy, sigma;
taylorza 1:33ff5fad4320 194 for (ix = 0, iy = ry, sigma = 2 * b2 + a2 * (1 - 2 * ry); b2 * ix <= a2 * iy; ix++)
taylorza 1:33ff5fad4320 195 {
taylorza 7:f39c980a589c 196 setPixelFast(x + ix, y + iy, color);
taylorza 7:f39c980a589c 197 setPixelFast(x - ix, y + iy, color);
taylorza 7:f39c980a589c 198 setPixelFast(x + ix, y - iy, color);
taylorza 7:f39c980a589c 199 setPixelFast(x - ix, y - iy, color);
taylorza 1:33ff5fad4320 200 if (sigma >= 0)
taylorza 1:33ff5fad4320 201 {
taylorza 1:33ff5fad4320 202 sigma+= fa2 * (1 - iy);
taylorza 1:33ff5fad4320 203 iy--;
taylorza 1:33ff5fad4320 204 }
taylorza 1:33ff5fad4320 205 sigma += b2 * ((4 * ix) + 6);
taylorza 1:33ff5fad4320 206 }
taylorza 1:33ff5fad4320 207
taylorza 1:33ff5fad4320 208 for (ix = rx, iy = 0, sigma = 2 * a2 + b2 * (1 - 2 * rx); a2 * iy <= b2 * ix; iy++)
taylorza 1:33ff5fad4320 209 {
taylorza 7:f39c980a589c 210 setPixelFast(x + ix, y + iy, color);
taylorza 7:f39c980a589c 211 setPixelFast(x - ix, y + iy, color);
taylorza 7:f39c980a589c 212 setPixelFast(x + ix, y - iy, color);
taylorza 7:f39c980a589c 213 setPixelFast(x - ix, y - iy, color);
taylorza 1:33ff5fad4320 214 if (sigma >= 0)
taylorza 1:33ff5fad4320 215 {
taylorza 1:33ff5fad4320 216 sigma+= fb2 * (1 - ix);
taylorza 1:33ff5fad4320 217 ix--;
taylorza 1:33ff5fad4320 218 }
taylorza 1:33ff5fad4320 219 sigma += a2 * ((4 * iy) + 6);
taylorza 1:33ff5fad4320 220 }
taylorza 1:33ff5fad4320 221 }
taylorza 4:88d22437119c 222 void LCD_ST7735::fillRect(int x1, int y1, int x2, int y2, uint16_t fillColor)
taylorza 4:88d22437119c 223 {
taylorza 7:f39c980a589c 224 _spi.prepareFastSPI();
taylorza 4:88d22437119c 225 clipRect(x1, y1, x2, y2);
taylorza 4:88d22437119c 226 int c = ((x2-x1) * (y2-y1)) << 1;
taylorza 4:88d22437119c 227 uint8_t colorHigh = fillColor >> 8;
taylorza 4:88d22437119c 228 uint8_t colorLow = fillColor;
taylorza 4:88d22437119c 229 beginBatchCommand(CMD_RAMWR);
taylorza 4:88d22437119c 230 while(c--)
taylorza 4:88d22437119c 231 {
taylorza 4:88d22437119c 232 writeBatchData(colorHigh, colorLow);
taylorza 4:88d22437119c 233 }
taylorza 4:88d22437119c 234 endBatchCommand();
taylorza 4:88d22437119c 235 }
taylorza 1:33ff5fad4320 236
taylorza 0:7b3fb3085867 237 void LCD_ST7735::fillRect(int x1, int y1, int x2, int y2, uint16_t borderColor, uint16_t fillColor)
taylorza 0:7b3fb3085867 238 {
taylorza 7:f39c980a589c 239 _spi.prepareFastSPI();
taylorza 0:7b3fb3085867 240 if (x1 > x2) swap(x1, x2);
taylorza 0:7b3fb3085867 241 if (y1 > y2) swap(y1, y2);
taylorza 0:7b3fb3085867 242
taylorza 0:7b3fb3085867 243 drawRect(x1, y1, x2, y2, borderColor);
taylorza 0:7b3fb3085867 244 clipRect(x1 + 1, y1 + 1, x2 - 1, y2 - 1);
taylorza 0:7b3fb3085867 245 int c = ((x2-x1-2) * (y2-y1-2)) << 1;
taylorza 4:88d22437119c 246 uint8_t colorHigh = fillColor >> 8;
taylorza 4:88d22437119c 247 uint8_t colorLow = fillColor;
taylorza 0:7b3fb3085867 248 beginBatchCommand(CMD_RAMWR);
taylorza 0:7b3fb3085867 249 while(c--)
taylorza 0:7b3fb3085867 250 {
taylorza 4:88d22437119c 251 writeBatchData(colorHigh, colorLow);
taylorza 0:7b3fb3085867 252 }
taylorza 0:7b3fb3085867 253 endBatchCommand();
taylorza 0:7b3fb3085867 254 }
taylorza 0:7b3fb3085867 255
taylorza 0:7b3fb3085867 256 void LCD_ST7735::fillCircle(int x, int y, int r, uint16_t borderColor, uint16_t fillColor)
taylorza 0:7b3fb3085867 257 {
taylorza 7:f39c980a589c 258 _spi.prepareFastSPI();
taylorza 0:7b3fb3085867 259 int ix = r;
taylorza 0:7b3fb3085867 260 int iy = 0;
taylorza 0:7b3fb3085867 261 int err = 1 - r;
taylorza 0:7b3fb3085867 262
taylorza 0:7b3fb3085867 263 while(ix >= iy)
taylorza 0:7b3fb3085867 264 {
taylorza 7:f39c980a589c 265 setPixelFast(x - ix, y + iy, borderColor);
taylorza 7:f39c980a589c 266 setPixelFast(x + ix, y + iy, borderColor);
taylorza 0:7b3fb3085867 267 drawHorizLine(x - ix + 1, y + iy, x + ix - 1, fillColor);
taylorza 0:7b3fb3085867 268
taylorza 7:f39c980a589c 269 setPixelFast(x - iy, y + ix, borderColor);
taylorza 7:f39c980a589c 270 setPixelFast(x + iy, y + ix, borderColor);
taylorza 0:7b3fb3085867 271 drawHorizLine(x - iy + 1, y + ix, x + iy - 1, fillColor);
taylorza 0:7b3fb3085867 272
taylorza 7:f39c980a589c 273 setPixelFast(x - ix, y - iy, borderColor);
taylorza 7:f39c980a589c 274 setPixelFast(x + ix, y - iy, borderColor);
taylorza 0:7b3fb3085867 275 drawHorizLine(x - ix + 1, y - iy, x + ix - 1, fillColor);
taylorza 0:7b3fb3085867 276
taylorza 7:f39c980a589c 277 setPixelFast(x - iy, y - ix, borderColor);
taylorza 7:f39c980a589c 278 setPixelFast(x + iy, y - ix, borderColor);
taylorza 0:7b3fb3085867 279 drawHorizLine(x - iy + 1, y - ix, x + iy - 1, fillColor);
taylorza 0:7b3fb3085867 280 iy++;
taylorza 0:7b3fb3085867 281 if (err < 0)
taylorza 0:7b3fb3085867 282 {
taylorza 0:7b3fb3085867 283 err += 2 * iy + 1;
taylorza 0:7b3fb3085867 284 }
taylorza 0:7b3fb3085867 285 else
taylorza 0:7b3fb3085867 286 {
taylorza 0:7b3fb3085867 287 ix--;
taylorza 0:7b3fb3085867 288 err += 2 * (iy - ix + 1);
taylorza 0:7b3fb3085867 289 }
taylorza 0:7b3fb3085867 290 }
taylorza 0:7b3fb3085867 291 }
taylorza 0:7b3fb3085867 292
taylorza 1:33ff5fad4320 293 void LCD_ST7735::fillEllipse(int x, int y, int rx, int ry, uint16_t borderColor, uint16_t fillColor)
taylorza 1:33ff5fad4320 294 {
taylorza 7:f39c980a589c 295 _spi.prepareFastSPI();
taylorza 1:33ff5fad4320 296 int a2 = rx * rx;
taylorza 1:33ff5fad4320 297 int b2 = ry * ry;
taylorza 1:33ff5fad4320 298 int fa2 = 4 * a2;
taylorza 1:33ff5fad4320 299 int fb2 = 4 * b2;
taylorza 1:33ff5fad4320 300
taylorza 1:33ff5fad4320 301 int ix, iy, sigma;
taylorza 1:33ff5fad4320 302 for (ix = 0, iy = ry, sigma = 2 * b2 + a2 * (1 - 2 * ry); b2 * ix <= a2 * iy; ix++)
taylorza 1:33ff5fad4320 303 {
taylorza 7:f39c980a589c 304 setPixelFast(x + ix, y + iy, borderColor);
taylorza 7:f39c980a589c 305 setPixelFast(x - ix, y + iy, borderColor);
taylorza 1:33ff5fad4320 306 drawHorizLine(x - ix + 1, y + iy, x + ix - 1, fillColor);
taylorza 1:33ff5fad4320 307
taylorza 7:f39c980a589c 308 setPixelFast(x + ix, y - iy, borderColor);
taylorza 7:f39c980a589c 309 setPixelFast(x - ix, y - iy, borderColor);
taylorza 1:33ff5fad4320 310 drawHorizLine(x - ix + 1, y - iy, x + ix - 1, fillColor);
taylorza 1:33ff5fad4320 311
taylorza 1:33ff5fad4320 312 if (sigma >= 0)
taylorza 1:33ff5fad4320 313 {
taylorza 1:33ff5fad4320 314 sigma+= fa2 * (1 - iy);
taylorza 1:33ff5fad4320 315 iy--;
taylorza 1:33ff5fad4320 316 }
taylorza 1:33ff5fad4320 317 sigma += b2 * ((4 * ix) + 6);
taylorza 1:33ff5fad4320 318 }
taylorza 1:33ff5fad4320 319
taylorza 1:33ff5fad4320 320 for (ix = rx, iy = 0, sigma = 2 * a2 + b2 * (1 - 2 * rx); a2 * iy <= b2 * ix; iy++)
taylorza 1:33ff5fad4320 321 {
taylorza 7:f39c980a589c 322 setPixelFast(x + ix, y + iy, borderColor);
taylorza 7:f39c980a589c 323 setPixelFast(x - ix, y + iy, borderColor);
taylorza 1:33ff5fad4320 324 drawHorizLine(x - ix + 1, y + iy, x + ix - 1, fillColor);
taylorza 1:33ff5fad4320 325
taylorza 7:f39c980a589c 326 setPixelFast(x + ix, y - iy, borderColor);
taylorza 7:f39c980a589c 327 setPixelFast(x - ix, y - iy, borderColor);
taylorza 1:33ff5fad4320 328 drawHorizLine(x - ix + 1, y - iy, x + ix - 1, fillColor);
taylorza 1:33ff5fad4320 329 if (sigma >= 0)
taylorza 1:33ff5fad4320 330 {
taylorza 1:33ff5fad4320 331 sigma+= fb2 * (1 - ix);
taylorza 1:33ff5fad4320 332 ix--;
taylorza 1:33ff5fad4320 333 }
taylorza 1:33ff5fad4320 334 sigma += a2 * ((4 * iy) + 6);
taylorza 1:33ff5fad4320 335 }
taylorza 1:33ff5fad4320 336 }
taylorza 1:33ff5fad4320 337
taylorza 0:7b3fb3085867 338 void LCD_ST7735::drawBitmap(int x, int y, const uint16_t *pbmp)
taylorza 0:7b3fb3085867 339 {
taylorza 7:f39c980a589c 340 _spi.prepareFastSPI();
taylorza 0:7b3fb3085867 341 int w = *pbmp++;
taylorza 0:7b3fb3085867 342 int h = *pbmp++;
taylorza 0:7b3fb3085867 343
taylorza 0:7b3fb3085867 344 clip(x, y, w, h);
taylorza 0:7b3fb3085867 345 int c = w * h;
taylorza 0:7b3fb3085867 346 beginBatchCommand(CMD_RAMWR);
taylorza 0:7b3fb3085867 347 while(c--)
taylorza 0:7b3fb3085867 348 {
taylorza 0:7b3fb3085867 349 writeBatchData(*pbmp++);
taylorza 0:7b3fb3085867 350 }
taylorza 0:7b3fb3085867 351 endBatchCommand();
taylorza 0:7b3fb3085867 352 }
taylorza 0:7b3fb3085867 353
taylorza 1:33ff5fad4320 354 void LCD_ST7735::drawBitmap(int x, int y, const uint16_t *pbmp, int srcX, int srcY, int srcWidth, int srcHeight)
taylorza 1:33ff5fad4320 355 {
taylorza 7:f39c980a589c 356 _spi.prepareFastSPI();
taylorza 1:33ff5fad4320 357 int w = *pbmp++;
taylorza 1:33ff5fad4320 358 int h = *pbmp++;
taylorza 1:33ff5fad4320 359
taylorza 1:33ff5fad4320 360 clip(x, y, srcWidth, srcHeight);
taylorza 1:33ff5fad4320 361 beginBatchCommand(CMD_RAMWR);
taylorza 1:33ff5fad4320 362 const uint16_t *p = pbmp + srcX + (srcY * w);
taylorza 1:33ff5fad4320 363 for(int iy = 0; iy < srcHeight; ++iy)
taylorza 1:33ff5fad4320 364 {
taylorza 1:33ff5fad4320 365 for(int ix = 0; ix < srcWidth; ++ix)
taylorza 1:33ff5fad4320 366 {
taylorza 1:33ff5fad4320 367 writeBatchData(*(p + ix));
taylorza 1:33ff5fad4320 368 }
taylorza 1:33ff5fad4320 369 p += w;
taylorza 1:33ff5fad4320 370 }
taylorza 1:33ff5fad4320 371 endBatchCommand();
taylorza 1:33ff5fad4320 372 }
taylorza 1:33ff5fad4320 373
taylorza 0:7b3fb3085867 374 void LCD_ST7735::setForegroundColor(uint16_t color)
taylorza 0:7b3fb3085867 375 {
taylorza 4:88d22437119c 376 _foregroundColorHigh = color >> 8;
taylorza 4:88d22437119c 377 _foregroundColorLow = color;
taylorza 0:7b3fb3085867 378 }
taylorza 0:7b3fb3085867 379
taylorza 0:7b3fb3085867 380 void LCD_ST7735::setBackgroundColor(uint16_t color)
taylorza 0:7b3fb3085867 381 {
taylorza 4:88d22437119c 382 _backgroundColorHigh = color >> 8;
taylorza 4:88d22437119c 383 _backgroundColorLow = color;
taylorza 0:7b3fb3085867 384 }
taylorza 0:7b3fb3085867 385
taylorza 0:7b3fb3085867 386 void LCD_ST7735::drawString(const uint8_t *pFont, int x, int y, const char *pString)
taylorza 0:7b3fb3085867 387 {
taylorza 7:f39c980a589c 388 _spi.prepareFastSPI();
taylorza 0:7b3fb3085867 389 char *p = (char*)pString;
taylorza 0:7b3fb3085867 390 while(*p != 0)
taylorza 0:7b3fb3085867 391 {
taylorza 0:7b3fb3085867 392 drawChar(pFont, x, y, *p++);
taylorza 0:7b3fb3085867 393 x += 8;
taylorza 0:7b3fb3085867 394 }
taylorza 0:7b3fb3085867 395 }
taylorza 0:7b3fb3085867 396
taylorza 7:f39c980a589c 397 void LCD_ST7735::setPixelFast(int x, int y, uint16_t color)
taylorza 7:f39c980a589c 398 {
taylorza 7:f39c980a589c 399 write(CMD_CASET, (uint8_t[]){0, x, 0, x}, 4);
taylorza 7:f39c980a589c 400 write(CMD_RASET, (uint8_t[]){0, y, 0, y}, 4);
taylorza 7:f39c980a589c 401 write(CMD_RAMWR, color);
taylorza 7:f39c980a589c 402 }
taylorza 7:f39c980a589c 403
taylorza 0:7b3fb3085867 404 void LCD_ST7735::drawVertLine(int x1, int y1, int y2, uint16_t color)
taylorza 0:7b3fb3085867 405 {
taylorza 0:7b3fb3085867 406 clipRect(x1, y1, x1, y2);
taylorza 0:7b3fb3085867 407 beginBatchCommand(CMD_RAMWR);
taylorza 4:88d22437119c 408 int c = (y2 - y1) << 1;
taylorza 4:88d22437119c 409 uint8_t colorHigh = color >> 8;
taylorza 4:88d22437119c 410 uint8_t colorLow = color;
taylorza 4:88d22437119c 411 for (int i = 0; i < c; ++i)
taylorza 0:7b3fb3085867 412 {
taylorza 4:88d22437119c 413 writeBatchData(colorHigh, colorLow);
taylorza 0:7b3fb3085867 414 }
taylorza 0:7b3fb3085867 415 endBatchCommand();
taylorza 0:7b3fb3085867 416 }
taylorza 0:7b3fb3085867 417
taylorza 0:7b3fb3085867 418 void LCD_ST7735::drawHorizLine(int x1, int y1, int x2, uint16_t color)
taylorza 0:7b3fb3085867 419 {
taylorza 0:7b3fb3085867 420 clipRect(x1, y1, x2, y1);
taylorza 0:7b3fb3085867 421 beginBatchCommand(CMD_RAMWR);
taylorza 4:88d22437119c 422 int c = (x2 - x1) << 1;
taylorza 4:88d22437119c 423 uint8_t colorHigh = color >> 8;
taylorza 4:88d22437119c 424 uint8_t colorLow = color;
taylorza 4:88d22437119c 425 for (int i = 0; i < c; ++i)
taylorza 0:7b3fb3085867 426 {
taylorza 4:88d22437119c 427 writeBatchData(colorHigh, colorLow);
taylorza 0:7b3fb3085867 428 }
taylorza 0:7b3fb3085867 429 endBatchCommand();
taylorza 0:7b3fb3085867 430 }
taylorza 0:7b3fb3085867 431
taylorza 0:7b3fb3085867 432 void LCD_ST7735::drawChar(const uint8_t *pFont, int x, int y, char c)
taylorza 0:7b3fb3085867 433 {
taylorza 0:7b3fb3085867 434 const uint8_t *pChar = pFont + (c * 8);
taylorza 0:7b3fb3085867 435
taylorza 0:7b3fb3085867 436 clip(x, y, 8, 8);
taylorza 0:7b3fb3085867 437 beginBatchCommand(CMD_RAMWR);
taylorza 0:7b3fb3085867 438 for(int r = 0; r < 8; ++r)
taylorza 0:7b3fb3085867 439 {
taylorza 0:7b3fb3085867 440 uint8_t b = pChar[r];
taylorza 0:7b3fb3085867 441 for(int c = 0; c < 8; ++c)
taylorza 0:7b3fb3085867 442 {
taylorza 0:7b3fb3085867 443 if (b & 0x80)
taylorza 4:88d22437119c 444 {
taylorza 4:88d22437119c 445 writeBatchData(_foregroundColorHigh);
taylorza 4:88d22437119c 446 writeBatchData(_foregroundColorLow);
taylorza 4:88d22437119c 447 }
taylorza 0:7b3fb3085867 448 else
taylorza 4:88d22437119c 449 {
taylorza 4:88d22437119c 450 writeBatchData(_backgroundColorHigh);
taylorza 4:88d22437119c 451 writeBatchData(_backgroundColorLow);
taylorza 4:88d22437119c 452 }
taylorza 0:7b3fb3085867 453
taylorza 0:7b3fb3085867 454 b <<= 1;
taylorza 0:7b3fb3085867 455 }
taylorza 0:7b3fb3085867 456 }
taylorza 0:7b3fb3085867 457 endBatchCommand();
taylorza 0:7b3fb3085867 458 }
taylorza 0:7b3fb3085867 459
taylorza 0:7b3fb3085867 460 void LCD_ST7735::initDisplay()
taylorza 0:7b3fb3085867 461 {
taylorza 7:f39c980a589c 462 _spi.prepareFastSPI();
taylorza 0:7b3fb3085867 463 reset();
taylorza 0:7b3fb3085867 464
taylorza 5:21c987ee68d2 465 writeCommand(CMD_SLPOUT);
taylorza 0:7b3fb3085867 466
taylorza 0:7b3fb3085867 467 write(CMD_FRMCTR1, (uint8_t[]){0x01, 0x2c, 0x2d}, 3);
taylorza 5:21c987ee68d2 468 write(CMD_FRMCTR2, (uint8_t[]){0x01, 0x2c, 0x2d}, 3);
taylorza 5:21c987ee68d2 469 write(CMD_FRMCTR3, (uint8_t[]){0x01, 0x2c, 0x2d, 0x01, 0x2c, 0x2d}, 6);
taylorza 0:7b3fb3085867 470
taylorza 0:7b3fb3085867 471 write(CMD_INVCTR, (uint8_t[]){0x07}, 1);
taylorza 0:7b3fb3085867 472
taylorza 0:7b3fb3085867 473 write(CMD_PWCTR1, (uint8_t[]){0xa2, 0x02, 0x84}, 3);
taylorza 0:7b3fb3085867 474 write(CMD_PWCTR2, (uint8_t[]){0xc5}, 1);
taylorza 0:7b3fb3085867 475 write(CMD_PWCTR3, (uint8_t[]){0x0a, 0x00}, 2);
taylorza 0:7b3fb3085867 476 write(CMD_PWCTR4, (uint8_t[]){0x8a, 0x2a}, 2);
taylorza 0:7b3fb3085867 477 write(CMD_PWCTR5, (uint8_t[]){0x8a, 0xee}, 2);
taylorza 0:7b3fb3085867 478
taylorza 0:7b3fb3085867 479 write(CMD_VMCTR1, (uint8_t[]){0x0e}, 1);
taylorza 0:7b3fb3085867 480
taylorza 0:7b3fb3085867 481 write(CMD_MADCTL, (uint8_t[]){0xc8}, 1);
taylorza 0:7b3fb3085867 482
taylorza 0:7b3fb3085867 483 // Gama sequence
taylorza 0:7b3fb3085867 484 write(CMD_GAMCTRP1, (uint8_t[])
taylorza 0:7b3fb3085867 485 {
taylorza 0:7b3fb3085867 486 0x0f, 0x1a,
taylorza 0:7b3fb3085867 487 0x0f, 0x18,
taylorza 0:7b3fb3085867 488 0x2f, 0x28,
taylorza 0:7b3fb3085867 489 0x20, 0x22,
taylorza 0:7b3fb3085867 490 0x1f, 0x1b,
taylorza 0:7b3fb3085867 491 0x23, 0x37,
taylorza 0:7b3fb3085867 492 0x00, 0x07,
taylorza 0:7b3fb3085867 493 0x02, 0x10
taylorza 0:7b3fb3085867 494 }, 16);
taylorza 0:7b3fb3085867 495
taylorza 0:7b3fb3085867 496 write(CMD_GAMCTRN1, (uint8_t[])
taylorza 0:7b3fb3085867 497 {
taylorza 0:7b3fb3085867 498 0x0f, 0x1b,
taylorza 0:7b3fb3085867 499 0x0f, 0x17,
taylorza 0:7b3fb3085867 500 0x33, 0x2c,
taylorza 0:7b3fb3085867 501 0x29, 0x2e,
taylorza 0:7b3fb3085867 502 0x30, 0x30,
taylorza 0:7b3fb3085867 503 0x39, 0x3f,
taylorza 0:7b3fb3085867 504 0x00, 0x07,
taylorza 0:7b3fb3085867 505 0x03, 0x10
taylorza 0:7b3fb3085867 506 }, 16);
taylorza 0:7b3fb3085867 507
taylorza 0:7b3fb3085867 508 write(CMD_CASET, (uint8_t[]){0x00, 0x00, 0x00, 0x7f}, 4);
taylorza 0:7b3fb3085867 509 write(CMD_RASET, (uint8_t[]){0x00, 0x00, 0x00, 0x9f}, 4);
taylorza 0:7b3fb3085867 510
taylorza 0:7b3fb3085867 511 write(CMD_EXTCTRL, (uint8_t[]){0x01}, 1);
taylorza 0:7b3fb3085867 512
taylorza 0:7b3fb3085867 513 // Disable RAM power save
taylorza 0:7b3fb3085867 514 write(0xf6, (uint8_t[]){0x00}, 1);
taylorza 0:7b3fb3085867 515
taylorza 0:7b3fb3085867 516 // 65k color mode
taylorza 0:7b3fb3085867 517 write(CMD_COLMOD, (uint8_t[]){0x05}, 1);
taylorza 0:7b3fb3085867 518
taylorza 0:7b3fb3085867 519 // Enable display
taylorza 5:21c987ee68d2 520 writeCommand(CMD_DISPON);
taylorza 0:7b3fb3085867 521
taylorza 0:7b3fb3085867 522 setBacklight(true);
taylorza 0:7b3fb3085867 523 }
taylorza 0:7b3fb3085867 524
taylorza 0:7b3fb3085867 525 void LCD_ST7735::reset()
taylorza 0:7b3fb3085867 526 {
taylorza 0:7b3fb3085867 527 _reset = 0;
taylorza 0:7b3fb3085867 528 wait_us(100);
taylorza 0:7b3fb3085867 529 _reset = 1;
taylorza 0:7b3fb3085867 530 wait_us(100);
taylorza 0:7b3fb3085867 531 }
taylorza 0:7b3fb3085867 532
taylorza 0:7b3fb3085867 533 void LCD_ST7735::clip(int x, int y, int w, int h)
taylorza 0:7b3fb3085867 534 {
taylorza 0:7b3fb3085867 535 clipRect(x, y, (x + w) - 1, (y + h) - 1);
taylorza 0:7b3fb3085867 536 }
taylorza 0:7b3fb3085867 537
taylorza 0:7b3fb3085867 538 void LCD_ST7735::clipRect(int x1, int y1, int x2, int y2)
taylorza 0:7b3fb3085867 539 {
taylorza 4:88d22437119c 540 uint8_t x1l = (uint8_t)x1;
taylorza 4:88d22437119c 541 uint8_t x1h = (uint8_t)(x1 >> 8);
taylorza 4:88d22437119c 542 uint8_t x2l = (uint8_t)x2;
taylorza 4:88d22437119c 543 uint8_t x2h = (uint8_t)(x2 >> 8);
taylorza 0:7b3fb3085867 544 write(CMD_CASET, (uint8_t[]){x1h, x1l, x2h, x2l}, 4);
taylorza 0:7b3fb3085867 545
taylorza 4:88d22437119c 546 uint8_t y1l = (uint8_t)y1;
taylorza 4:88d22437119c 547 uint8_t y1h = (uint8_t)(y1 >> 8);
taylorza 4:88d22437119c 548 uint8_t y2l = (uint8_t)y2;
taylorza 4:88d22437119c 549 uint8_t y2h = (uint8_t)(y2 >> 8);
taylorza 0:7b3fb3085867 550 write(CMD_RASET, (uint8_t[]){y1h, y1l, y2h, y2l}, 4);
taylorza 0:7b3fb3085867 551 }
taylorza 5:21c987ee68d2 552
taylorza 5:21c987ee68d2 553 void LCD_ST7735::writeCommand(uint8_t cmd)
taylorza 0:7b3fb3085867 554 {
taylorza 5:21c987ee68d2 555 _cs = 0;
taylorza 5:21c987ee68d2 556 _ds = 0;
taylorza 5:21c987ee68d2 557 _spi.fastWrite(cmd);
taylorza 5:21c987ee68d2 558 _spi.waitWhileBusy();
taylorza 5:21c987ee68d2 559 _spi.clearRx();
taylorza 5:21c987ee68d2 560 _cs = 1;
taylorza 0:7b3fb3085867 561 }
taylorza 0:7b3fb3085867 562
taylorza 0:7b3fb3085867 563 void LCD_ST7735::write(uint8_t cmd, uint8_t data[], int dataLen)
taylorza 0:7b3fb3085867 564 {
taylorza 0:7b3fb3085867 565 _cs = 0;
taylorza 5:21c987ee68d2 566 _ds = 0;
taylorza 5:21c987ee68d2 567 _spi.fastWrite(cmd);
taylorza 5:21c987ee68d2 568 _spi.waitWhileBusy();
taylorza 0:7b3fb3085867 569 if (data != NULL & dataLen > 0)
taylorza 0:7b3fb3085867 570 {
taylorza 0:7b3fb3085867 571 _ds = 1;
taylorza 0:7b3fb3085867 572 for(int i = 0; i < dataLen; ++i)
taylorza 0:7b3fb3085867 573 {
taylorza 5:21c987ee68d2 574 _spi.fastWrite(data[i]);
taylorza 0:7b3fb3085867 575 }
taylorza 5:21c987ee68d2 576 _spi.waitWhileBusy();
taylorza 0:7b3fb3085867 577 _ds = 0;
taylorza 0:7b3fb3085867 578 }
taylorza 5:21c987ee68d2 579 _spi.clearRx();
taylorza 5:21c987ee68d2 580 _cs = 1;
taylorza 0:7b3fb3085867 581 }
taylorza 0:7b3fb3085867 582
taylorza 0:7b3fb3085867 583 void LCD_ST7735::write(uint8_t cmd, uint16_t data)
taylorza 0:7b3fb3085867 584 {
taylorza 5:21c987ee68d2 585 _cs = 0;
taylorza 5:21c987ee68d2 586 _ds = 0;
taylorza 5:21c987ee68d2 587 _spi.fastWrite(cmd);
taylorza 5:21c987ee68d2 588 _spi.waitWhileBusy();
taylorza 5:21c987ee68d2 589 _ds = 1;
taylorza 5:21c987ee68d2 590 _spi.fastWrite(data >> 8);
taylorza 5:21c987ee68d2 591 _spi.fastWrite(data);
taylorza 5:21c987ee68d2 592 _spi.waitWhileBusy();
taylorza 5:21c987ee68d2 593 _spi.clearRx();
taylorza 5:21c987ee68d2 594 _ds = 0;
taylorza 0:7b3fb3085867 595 _cs = 1;
taylorza 0:7b3fb3085867 596 }
taylorza 0:7b3fb3085867 597
taylorza 0:7b3fb3085867 598 void LCD_ST7735::beginBatchCommand(uint8_t cmd)
taylorza 0:7b3fb3085867 599 {
taylorza 0:7b3fb3085867 600 _cs = 0;
taylorza 5:21c987ee68d2 601 _ds = 0;
taylorza 5:21c987ee68d2 602 _spi.fastWrite(cmd);
taylorza 5:21c987ee68d2 603 _spi.waitWhileBusy();
taylorza 0:7b3fb3085867 604 _ds = 1;
taylorza 0:7b3fb3085867 605 }
taylorza 0:7b3fb3085867 606
taylorza 0:7b3fb3085867 607 void LCD_ST7735::writeBatchData(uint8_t data)
taylorza 0:7b3fb3085867 608 {
taylorza 5:21c987ee68d2 609 _spi.fastWrite(data);
taylorza 0:7b3fb3085867 610 }
taylorza 0:7b3fb3085867 611
taylorza 4:88d22437119c 612 void LCD_ST7735::writeBatchData(uint8_t dataHigh, uint8_t dataLow)
taylorza 4:88d22437119c 613 {
taylorza 5:21c987ee68d2 614 _spi.fastWrite(dataHigh);
taylorza 5:21c987ee68d2 615 _spi.fastWrite(dataLow);
taylorza 4:88d22437119c 616 }
taylorza 4:88d22437119c 617
taylorza 4:88d22437119c 618
taylorza 0:7b3fb3085867 619 void LCD_ST7735::writeBatchData(uint16_t data)
taylorza 0:7b3fb3085867 620 {
taylorza 5:21c987ee68d2 621 _spi.fastWrite(data >> 8);
taylorza 5:21c987ee68d2 622 _spi.fastWrite(data);
taylorza 0:7b3fb3085867 623 }
taylorza 0:7b3fb3085867 624
taylorza 0:7b3fb3085867 625 void LCD_ST7735::endBatchCommand()
taylorza 0:7b3fb3085867 626 {
taylorza 5:21c987ee68d2 627 _spi.waitWhileBusy();
taylorza 5:21c987ee68d2 628 _spi.clearRx();
taylorza 0:7b3fb3085867 629 _ds = 0;
taylorza 0:7b3fb3085867 630 _cs = 1;
taylorza 4:88d22437119c 631 }
taylorza 7:f39c980a589c 632