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@8:12f16befa7e1, 2014-10-25 (annotated)

Committer:
taylorza
Date:
Sat Oct 25 04:10:47 2014 +0000
Revision:
8:12f16befa7e1
Parent:
7:f39c980a589c
Child:
9:7ecd74dcb8ef
Added support for RGB and BGR panels

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