Driver Library for our displays

Dependents:   dm_bubbles dm_calc dm_paint dm_sdcard_with_adapter ... more

Committer:
displaymodule
Date:
Mon Oct 12 08:35:35 2015 +0000
Revision:
14:2db7065edbec
Parent:
7:6cd8c36cbdb3
Important updates, compatible with the new mbed library?more platforms support. Recommended updates.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
displaymodule 0:d6ff5fa503e8 1 /**********************************************************************************************
displaymodule 0:d6ff5fa503e8 2 Copyright (c) 2014 DisplayModule. All rights reserved.
displaymodule 0:d6ff5fa503e8 3
displaymodule 0:d6ff5fa503e8 4 Redistribution and use of this source code, part of this source code or any compiled binary
displaymodule 0:d6ff5fa503e8 5 based on this source code is permitted as long as the above copyright notice and following
displaymodule 0:d6ff5fa503e8 6 disclaimer is retained.
displaymodule 0:d6ff5fa503e8 7
displaymodule 0:d6ff5fa503e8 8 DISCLAIMER:
displaymodule 0:d6ff5fa503e8 9 THIS SOFTWARE IS SUPPLIED "AS IS" WITHOUT ANY WARRANTIES AND SUPPORT. DISPLAYMODULE ASSUMES
displaymodule 0:d6ff5fa503e8 10 NO RESPONSIBILITY OR LIABILITY FOR THE USE OF THE SOFTWARE.
displaymodule 0:d6ff5fa503e8 11 ********************************************************************************************/
displaymodule 0:d6ff5fa503e8 12
displaymodule 0:d6ff5fa503e8 13 #include "DmTftBase.h"
displaymodule 0:d6ff5fa503e8 14
displaymodule 0:d6ff5fa503e8 15 #define FONT_CHAR_WIDTH 8
displaymodule 0:d6ff5fa503e8 16 #define FONT_CHAR_HEIGHT 16
displaymodule 0:d6ff5fa503e8 17 extern uint8_t font[];
displaymodule 0:d6ff5fa503e8 18
displaymodule 0:d6ff5fa503e8 19 /*
displaymodule 0:d6ff5fa503e8 20 * Macro to read the 8 bits representing one line of a character.
displaymodule 0:d6ff5fa503e8 21 * The macro is needed as the reading is handled differently on
displaymodule 0:d6ff5fa503e8 22 * Arduino and Mbed platforms.
displaymodule 0:d6ff5fa503e8 23 */
displaymodule 0:d6ff5fa503e8 24 #if defined (DM_TOOLCHAIN_ARDUINO)
displaymodule 0:d6ff5fa503e8 25 #define read_font_line(__char, __line) \
displaymodule 0:d6ff5fa503e8 26 pgm_read_byte(&font[((uint16_t)(__char))*FONT_CHAR_HEIGHT+(__line)])
displaymodule 0:d6ff5fa503e8 27 #elif defined (DM_TOOLCHAIN_MBED)
displaymodule 0:d6ff5fa503e8 28 #define read_font_line(__char, __line) \
displaymodule 0:d6ff5fa503e8 29 font[((uint16_t)(__char))*FONT_CHAR_HEIGHT+(__line)]
displaymodule 0:d6ff5fa503e8 30 #endif
displaymodule 0:d6ff5fa503e8 31
displaymodule 0:d6ff5fa503e8 32
displaymodule 0:d6ff5fa503e8 33 void DmTftBase::setPixel(uint16_t x, uint16_t y, uint16_t color) {
displaymodule 0:d6ff5fa503e8 34 cbi(_pinCS, _bitmaskCS);
displaymodule 0:d6ff5fa503e8 35
displaymodule 7:6cd8c36cbdb3 36 if ((x >= _width) || (y >= _height)) {
displaymodule 7:6cd8c36cbdb3 37 return;
displaymodule 7:6cd8c36cbdb3 38 }
displaymodule 7:6cd8c36cbdb3 39
displaymodule 0:d6ff5fa503e8 40 setAddress(x, y, x, y);
displaymodule 0:d6ff5fa503e8 41
displaymodule 0:d6ff5fa503e8 42 sendData(color);
displaymodule 0:d6ff5fa503e8 43 sbi(_pinCS, _bitmaskCS);
displaymodule 0:d6ff5fa503e8 44 }
displaymodule 0:d6ff5fa503e8 45
displaymodule 0:d6ff5fa503e8 46 void DmTftBase::clearScreen(uint16_t color) {
displaymodule 0:d6ff5fa503e8 47 cbi(_pinCS, _bitmaskCS);
displaymodule 0:d6ff5fa503e8 48
displaymodule 0:d6ff5fa503e8 49 setAddress(0,0,_width-1, _height-1);
displaymodule 0:d6ff5fa503e8 50
displaymodule 0:d6ff5fa503e8 51 for(uint16_t i=0; i<_height; i++) {
displaymodule 0:d6ff5fa503e8 52 for(uint16_t j=0; j<_width; j++) {
displaymodule 0:d6ff5fa503e8 53 sendData(color);
displaymodule 0:d6ff5fa503e8 54 }
displaymodule 0:d6ff5fa503e8 55 }
displaymodule 0:d6ff5fa503e8 56
displaymodule 0:d6ff5fa503e8 57 sbi(_pinCS, _bitmaskCS);
displaymodule 0:d6ff5fa503e8 58 }
displaymodule 0:d6ff5fa503e8 59
displaymodule 0:d6ff5fa503e8 60 void DmTftBase::drawHorizontalLine(uint16_t x, uint16_t y, uint16_t length, uint16_t color) {
displaymodule 0:d6ff5fa503e8 61 cbi(_pinCS, _bitmaskCS);
displaymodule 0:d6ff5fa503e8 62
displaymodule 0:d6ff5fa503e8 63 setAddress(x, y, x + length, y);
displaymodule 0:d6ff5fa503e8 64
displaymodule 0:d6ff5fa503e8 65 for (int i = 0; i <= length; i++) {
displaymodule 0:d6ff5fa503e8 66 sendData(color);
displaymodule 0:d6ff5fa503e8 67 }
displaymodule 0:d6ff5fa503e8 68
displaymodule 0:d6ff5fa503e8 69 sbi(_pinCS, _bitmaskCS);
displaymodule 0:d6ff5fa503e8 70 }
displaymodule 0:d6ff5fa503e8 71
displaymodule 0:d6ff5fa503e8 72 void DmTftBase::drawVerticalLine(uint16_t x, uint16_t y, uint16_t length, uint16_t color) {
displaymodule 0:d6ff5fa503e8 73 cbi(_pinCS, _bitmaskCS);
displaymodule 0:d6ff5fa503e8 74
displaymodule 0:d6ff5fa503e8 75 setAddress(x, y, x, y + length);
displaymodule 0:d6ff5fa503e8 76
displaymodule 0:d6ff5fa503e8 77 for (int i = 0; i <= length; i++) {
displaymodule 0:d6ff5fa503e8 78 sendData(color);
displaymodule 0:d6ff5fa503e8 79 }
displaymodule 0:d6ff5fa503e8 80
displaymodule 0:d6ff5fa503e8 81 sbi(_pinCS, _bitmaskCS);
displaymodule 0:d6ff5fa503e8 82 }
displaymodule 0:d6ff5fa503e8 83
displaymodule 0:d6ff5fa503e8 84 void DmTftBase::drawLine(uint16_t x0, uint16_t y0, uint16_t x1, uint16_t y1, uint16_t color) {
displaymodule 0:d6ff5fa503e8 85 int x = x1-x0;
displaymodule 0:d6ff5fa503e8 86 int y = y1-y0;
displaymodule 0:d6ff5fa503e8 87 int dx = abs(x), sx = x0<x1 ? 1 : -1;
displaymodule 0:d6ff5fa503e8 88 int dy = -abs(y), sy = y0<y1 ? 1 : -1;
displaymodule 0:d6ff5fa503e8 89 int err = dx+dy, e2; /* error value e_xy */
displaymodule 0:d6ff5fa503e8 90 for (;;) {
displaymodule 0:d6ff5fa503e8 91 setPixel(x0,y0,color);
displaymodule 0:d6ff5fa503e8 92 e2 = 2*err;
displaymodule 0:d6ff5fa503e8 93 if (e2 >= dy) { /* e_xy+e_x > 0 */
displaymodule 0:d6ff5fa503e8 94 if (x0 == x1) {
displaymodule 0:d6ff5fa503e8 95 break;
displaymodule 0:d6ff5fa503e8 96 }
displaymodule 0:d6ff5fa503e8 97 err += dy; x0 += sx;
displaymodule 0:d6ff5fa503e8 98 }
displaymodule 0:d6ff5fa503e8 99 if (e2 <= dx) { /* e_xy+e_y < 0 */
displaymodule 0:d6ff5fa503e8 100 if (y0 == y1) {
displaymodule 0:d6ff5fa503e8 101 break;
displaymodule 0:d6ff5fa503e8 102 }
displaymodule 0:d6ff5fa503e8 103 err += dx; y0 += sy;
displaymodule 0:d6ff5fa503e8 104 }
displaymodule 0:d6ff5fa503e8 105 }
displaymodule 0:d6ff5fa503e8 106 }
displaymodule 0:d6ff5fa503e8 107
displaymodule 0:d6ff5fa503e8 108 void DmTftBase::drawRectangle(uint16_t x0, uint16_t y0, uint16_t x1, uint16_t y1, uint16_t color) {
displaymodule 0:d6ff5fa503e8 109 // Make sure x0,y0 are in the top left corner
displaymodule 0:d6ff5fa503e8 110 if(x0 > x1) {
displaymodule 0:d6ff5fa503e8 111 x0 = x0^x1;
displaymodule 0:d6ff5fa503e8 112 x1 = x0^x1;
displaymodule 0:d6ff5fa503e8 113 x0 = x0^x1;
displaymodule 0:d6ff5fa503e8 114 }
displaymodule 0:d6ff5fa503e8 115 if(y0 > y1) {
displaymodule 0:d6ff5fa503e8 116 y0 = y0^y1;
displaymodule 0:d6ff5fa503e8 117 y1 = y0^y1;
displaymodule 0:d6ff5fa503e8 118 y0 = y0^y1;
displaymodule 0:d6ff5fa503e8 119 }
displaymodule 0:d6ff5fa503e8 120
displaymodule 0:d6ff5fa503e8 121 drawHorizontalLine(x0, y0, x1-x0, color);
displaymodule 0:d6ff5fa503e8 122 drawHorizontalLine(x0, y1, x1-x0, color);
displaymodule 0:d6ff5fa503e8 123 drawVerticalLine(x0, y0, y1-y0, color);
displaymodule 0:d6ff5fa503e8 124 drawVerticalLine(x1, y0, y1-y0, color);
displaymodule 0:d6ff5fa503e8 125 }
displaymodule 0:d6ff5fa503e8 126
displaymodule 0:d6ff5fa503e8 127 void DmTftBase::fillRectangle(uint16_t x0, uint16_t y0, uint16_t x1, uint16_t y1, uint16_t color) {
displaymodule 0:d6ff5fa503e8 128 unsigned long numPixels=0;
displaymodule 0:d6ff5fa503e8 129 unsigned long i=0;
displaymodule 0:d6ff5fa503e8 130
displaymodule 0:d6ff5fa503e8 131 // Make sure x0,y0 are in the top left corner
displaymodule 0:d6ff5fa503e8 132 if(x0 > x1) {
displaymodule 0:d6ff5fa503e8 133 x0 = x0^x1;
displaymodule 0:d6ff5fa503e8 134 x1 = x0^x1;
displaymodule 0:d6ff5fa503e8 135 x0 = x0^x1;
displaymodule 0:d6ff5fa503e8 136 }
displaymodule 0:d6ff5fa503e8 137 if(y0 > y1) {
displaymodule 0:d6ff5fa503e8 138 y0 = y0^y1;
displaymodule 0:d6ff5fa503e8 139 y1 = y0^y1;
displaymodule 0:d6ff5fa503e8 140 y0 = y0^y1;
displaymodule 0:d6ff5fa503e8 141 }
displaymodule 0:d6ff5fa503e8 142
displaymodule 0:d6ff5fa503e8 143 x0 = constrain(x0, 0, _width-1);
displaymodule 0:d6ff5fa503e8 144 x1 = constrain(x1, 0, _width-1);
displaymodule 0:d6ff5fa503e8 145 y0 = constrain(y0, 0, _height-1);
displaymodule 0:d6ff5fa503e8 146 y1 = constrain(y1, 0, _height-1);
displaymodule 0:d6ff5fa503e8 147
displaymodule 0:d6ff5fa503e8 148 numPixels = (x1-x0+1);
displaymodule 0:d6ff5fa503e8 149 numPixels = numPixels*(y1-y0+1);
displaymodule 0:d6ff5fa503e8 150
displaymodule 0:d6ff5fa503e8 151 cbi(_pinCS, _bitmaskCS);
displaymodule 0:d6ff5fa503e8 152 setAddress(x0,y0,x1,y1);/* start to write to display ra */
displaymodule 0:d6ff5fa503e8 153
displaymodule 0:d6ff5fa503e8 154 for(i=0; i < numPixels; i++) {
displaymodule 0:d6ff5fa503e8 155 sendData(color);
displaymodule 0:d6ff5fa503e8 156 }
displaymodule 0:d6ff5fa503e8 157
displaymodule 0:d6ff5fa503e8 158 sbi(_pinCS, _bitmaskCS);
displaymodule 0:d6ff5fa503e8 159 }
displaymodule 0:d6ff5fa503e8 160
displaymodule 0:d6ff5fa503e8 161 void DmTftBase::drawCircle(uint16_t x0, uint16_t y0, uint16_t r, uint16_t color) {
displaymodule 0:d6ff5fa503e8 162 int x = -r, y = 0, err = 2-2*r, e2;
displaymodule 0:d6ff5fa503e8 163 do {
displaymodule 0:d6ff5fa503e8 164 setPixel(x0-x, y0+y, color);
displaymodule 0:d6ff5fa503e8 165 setPixel(x0+x, y0+y, color);
displaymodule 0:d6ff5fa503e8 166 setPixel(x0+x, y0-y, color);
displaymodule 0:d6ff5fa503e8 167 setPixel(x0-x, y0-y, color);
displaymodule 0:d6ff5fa503e8 168 e2 = err;
displaymodule 0:d6ff5fa503e8 169 if (e2 <= y) {
displaymodule 0:d6ff5fa503e8 170 err += ++y*2+1;
displaymodule 0:d6ff5fa503e8 171 if (-x == y && e2 <= x) {
displaymodule 0:d6ff5fa503e8 172 e2 = 0;
displaymodule 0:d6ff5fa503e8 173 }
displaymodule 0:d6ff5fa503e8 174 }
displaymodule 0:d6ff5fa503e8 175 if (e2 > x) {
displaymodule 0:d6ff5fa503e8 176 err += ++x * 2 + 1;
displaymodule 0:d6ff5fa503e8 177 }
displaymodule 0:d6ff5fa503e8 178 } while (x <= 0);
displaymodule 0:d6ff5fa503e8 179 }
displaymodule 0:d6ff5fa503e8 180
displaymodule 0:d6ff5fa503e8 181 void DmTftBase::fillCircle(uint16_t x0, uint16_t y0, uint16_t r, uint16_t color) {
displaymodule 0:d6ff5fa503e8 182 int x = -r, y = 0, err = 2-2*r, e2;
displaymodule 0:d6ff5fa503e8 183 do {
displaymodule 0:d6ff5fa503e8 184 drawVerticalLine(x0-x, y0-y, 2*y, color);
displaymodule 0:d6ff5fa503e8 185 drawVerticalLine(x0+x, y0-y, 2*y, color);
displaymodule 0:d6ff5fa503e8 186
displaymodule 0:d6ff5fa503e8 187 e2 = err;
displaymodule 0:d6ff5fa503e8 188 if (e2 <= y) {
displaymodule 0:d6ff5fa503e8 189 err += ++y * 2 + 1;
displaymodule 0:d6ff5fa503e8 190 if (-x == y && e2 <= x) {
displaymodule 0:d6ff5fa503e8 191 e2 = 0;
displaymodule 0:d6ff5fa503e8 192 }
displaymodule 0:d6ff5fa503e8 193 }
displaymodule 0:d6ff5fa503e8 194 if (e2 > x) {
displaymodule 0:d6ff5fa503e8 195 err += ++x*2+1;
displaymodule 0:d6ff5fa503e8 196 }
displaymodule 0:d6ff5fa503e8 197 } while (x <= 0);
displaymodule 0:d6ff5fa503e8 198 }
displaymodule 0:d6ff5fa503e8 199
displaymodule 0:d6ff5fa503e8 200 void DmTftBase::drawTriangle(uint16_t x0, uint16_t y0, uint16_t x1, uint16_t y1, uint16_t x2, uint16_t y2, uint16_t color) {
displaymodule 0:d6ff5fa503e8 201 drawLine(x0, y0, x1, y1, color);
displaymodule 0:d6ff5fa503e8 202 drawLine(x0, y0, x2, y2, color);
displaymodule 0:d6ff5fa503e8 203 drawLine(x1, y1, x2, y2, color);
displaymodule 0:d6ff5fa503e8 204 }
displaymodule 0:d6ff5fa503e8 205
displaymodule 0:d6ff5fa503e8 206 void DmTftBase::drawPoint(uint16_t x, uint16_t y, uint16_t radius) {
displaymodule 0:d6ff5fa503e8 207 if (radius == 0) {
displaymodule 0:d6ff5fa503e8 208 cbi(_pinCS, _bitmaskCS);
displaymodule 0:d6ff5fa503e8 209
displaymodule 0:d6ff5fa503e8 210 setAddress(x,y,x,y);
displaymodule 0:d6ff5fa503e8 211 sendData(_fgColor);
displaymodule 0:d6ff5fa503e8 212
displaymodule 0:d6ff5fa503e8 213 sbi(_pinCS, _bitmaskCS);
displaymodule 0:d6ff5fa503e8 214 } else {
displaymodule 0:d6ff5fa503e8 215 fillRectangle(x-radius,y-radius,x+radius,y+radius, _fgColor);
displaymodule 0:d6ff5fa503e8 216 }
displaymodule 0:d6ff5fa503e8 217 }
displaymodule 0:d6ff5fa503e8 218
displaymodule 0:d6ff5fa503e8 219 void DmTftBase::drawChar(uint16_t x, uint16_t y, char ch, bool transparent) {
displaymodule 0:d6ff5fa503e8 220 cbi(_pinCS, _bitmaskCS);
displaymodule 0:d6ff5fa503e8 221
displaymodule 0:d6ff5fa503e8 222 uint8_t temp;
displaymodule 0:d6ff5fa503e8 223 uint8_t pos,t;
displaymodule 0:d6ff5fa503e8 224
displaymodule 0:d6ff5fa503e8 225 if ((x > (_width - FONT_CHAR_WIDTH)) || (y > (_height - FONT_CHAR_HEIGHT))) {
displaymodule 0:d6ff5fa503e8 226 return;
displaymodule 0:d6ff5fa503e8 227 }
displaymodule 0:d6ff5fa503e8 228
displaymodule 0:d6ff5fa503e8 229 ch=ch-' ';
displaymodule 0:d6ff5fa503e8 230 if (!transparent) { // Clear background
displaymodule 0:d6ff5fa503e8 231 setAddress(x,y,x+FONT_CHAR_WIDTH-1,y+FONT_CHAR_HEIGHT-1);
displaymodule 0:d6ff5fa503e8 232 for(pos=0;pos<FONT_CHAR_HEIGHT;pos++) {
displaymodule 0:d6ff5fa503e8 233 temp = read_font_line(ch, pos);
displaymodule 0:d6ff5fa503e8 234 for(t=0;t<FONT_CHAR_WIDTH;t++) {
displaymodule 0:d6ff5fa503e8 235 if (temp & 0x01) {
displaymodule 0:d6ff5fa503e8 236 sendData(_fgColor);
displaymodule 0:d6ff5fa503e8 237 }
displaymodule 0:d6ff5fa503e8 238 else {
displaymodule 0:d6ff5fa503e8 239 sendData(_bgColor);
displaymodule 0:d6ff5fa503e8 240 }
displaymodule 0:d6ff5fa503e8 241 temp>>=1;
displaymodule 0:d6ff5fa503e8 242 }
displaymodule 0:d6ff5fa503e8 243 y++;
displaymodule 0:d6ff5fa503e8 244 }
displaymodule 0:d6ff5fa503e8 245 }
displaymodule 0:d6ff5fa503e8 246 else { //Draw directly without clearing background
displaymodule 0:d6ff5fa503e8 247 for(pos=0;pos<FONT_CHAR_HEIGHT;pos++) {
displaymodule 0:d6ff5fa503e8 248 temp = read_font_line(ch, pos);
displaymodule 0:d6ff5fa503e8 249 for(t=0;t<FONT_CHAR_WIDTH;t++) {
displaymodule 0:d6ff5fa503e8 250 if (temp & 0x01) {
displaymodule 0:d6ff5fa503e8 251 setAddress(x + t, y + pos, x + t, y + pos);
displaymodule 0:d6ff5fa503e8 252 sendData(_fgColor);
displaymodule 0:d6ff5fa503e8 253 //drawPoint(x + t, y + pos);
displaymodule 0:d6ff5fa503e8 254 }
displaymodule 0:d6ff5fa503e8 255 temp>>=1;
displaymodule 0:d6ff5fa503e8 256 }
displaymodule 0:d6ff5fa503e8 257 }
displaymodule 0:d6ff5fa503e8 258 }
displaymodule 0:d6ff5fa503e8 259
displaymodule 0:d6ff5fa503e8 260 sbi(_pinCS, _bitmaskCS);
displaymodule 0:d6ff5fa503e8 261 }
displaymodule 0:d6ff5fa503e8 262
displaymodule 0:d6ff5fa503e8 263 void DmTftBase::drawNumber(uint16_t x, uint16_t y, int num, int digitsToShow, bool leadingZeros) {
displaymodule 0:d6ff5fa503e8 264 bool minus = false;
displaymodule 0:d6ff5fa503e8 265 if (num < 0) {
displaymodule 0:d6ff5fa503e8 266 num = -num;
displaymodule 0:d6ff5fa503e8 267 minus = true;
displaymodule 0:d6ff5fa503e8 268 }
displaymodule 0:d6ff5fa503e8 269 for (int i = 0; i < digitsToShow; i++) {
displaymodule 0:d6ff5fa503e8 270 char c = ' ';
displaymodule 0:d6ff5fa503e8 271 if ((num == 0) && (i > 0)) {
displaymodule 0:d6ff5fa503e8 272 if (leadingZeros) {
displaymodule 0:d6ff5fa503e8 273 c = '0';
displaymodule 0:d6ff5fa503e8 274 if (minus && (i == (digitsToShow-1))) {
displaymodule 0:d6ff5fa503e8 275 c = '-';
displaymodule 0:d6ff5fa503e8 276 }
displaymodule 0:d6ff5fa503e8 277 } else if (minus) {
displaymodule 0:d6ff5fa503e8 278 c = '-';
displaymodule 0:d6ff5fa503e8 279 minus = false;
displaymodule 0:d6ff5fa503e8 280 }
displaymodule 0:d6ff5fa503e8 281 } else {
displaymodule 0:d6ff5fa503e8 282 c = '0' + (num % 10);
displaymodule 0:d6ff5fa503e8 283 }
displaymodule 0:d6ff5fa503e8 284 drawChar(x + FONT_CHAR_WIDTH*(digitsToShow - i - 1), y, c, false);
displaymodule 0:d6ff5fa503e8 285 num = num / 10;
displaymodule 0:d6ff5fa503e8 286 }
displaymodule 0:d6ff5fa503e8 287 }
displaymodule 0:d6ff5fa503e8 288
displaymodule 0:d6ff5fa503e8 289 void DmTftBase::drawString(uint16_t x, uint16_t y, const char *p) {
displaymodule 0:d6ff5fa503e8 290 while(*p!='\0')
displaymodule 0:d6ff5fa503e8 291 {
displaymodule 0:d6ff5fa503e8 292 if(x > (_width - FONT_CHAR_WIDTH)) {
displaymodule 0:d6ff5fa503e8 293 x = 0;
displaymodule 0:d6ff5fa503e8 294 y += FONT_CHAR_HEIGHT;
displaymodule 0:d6ff5fa503e8 295 }
displaymodule 0:d6ff5fa503e8 296 if(y > (_height - FONT_CHAR_HEIGHT)) {
displaymodule 0:d6ff5fa503e8 297 y = x = 0;
displaymodule 0:d6ff5fa503e8 298 }
displaymodule 0:d6ff5fa503e8 299 drawChar(x, y, *p, false);
displaymodule 0:d6ff5fa503e8 300 x += FONT_CHAR_WIDTH;
displaymodule 0:d6ff5fa503e8 301 p++;
displaymodule 0:d6ff5fa503e8 302 }
displaymodule 0:d6ff5fa503e8 303 }
displaymodule 0:d6ff5fa503e8 304
displaymodule 0:d6ff5fa503e8 305 void DmTftBase::drawStringCentered(uint16_t x, uint16_t y, uint16_t width, uint16_t height, const char *p) {
displaymodule 0:d6ff5fa503e8 306 int len = strlen(p);
displaymodule 0:d6ff5fa503e8 307 uint16_t tmp = len * FONT_CHAR_WIDTH;
displaymodule 0:d6ff5fa503e8 308 if (tmp <= width) {
displaymodule 0:d6ff5fa503e8 309 x += (width - tmp)/2;
displaymodule 0:d6ff5fa503e8 310 }
displaymodule 0:d6ff5fa503e8 311 if (FONT_CHAR_HEIGHT <= height) {
displaymodule 0:d6ff5fa503e8 312 y += (height - FONT_CHAR_HEIGHT)/2;
displaymodule 0:d6ff5fa503e8 313 }
displaymodule 0:d6ff5fa503e8 314 drawString(x, y, p);
displaymodule 0:d6ff5fa503e8 315 }
displaymodule 0:d6ff5fa503e8 316
displaymodule 0:d6ff5fa503e8 317 void DmTftBase::drawImage(uint16_t x, uint16_t y, uint16_t width, uint16_t height, const uint16_t* data) {
displaymodule 0:d6ff5fa503e8 318 const uint16_t* p = data;
displaymodule 0:d6ff5fa503e8 319
displaymodule 0:d6ff5fa503e8 320 cbi(_pinCS, _bitmaskCS);
displaymodule 0:d6ff5fa503e8 321
displaymodule 0:d6ff5fa503e8 322 setAddress(x,y,x+width-1,y+height-1);
displaymodule 0:d6ff5fa503e8 323 for (int i = width*height; i > 0; i--) {
displaymodule 0:d6ff5fa503e8 324 sendData(*p);
displaymodule 0:d6ff5fa503e8 325 p++;
displaymodule 0:d6ff5fa503e8 326 }
displaymodule 0:d6ff5fa503e8 327
displaymodule 0:d6ff5fa503e8 328 sbi(_pinCS, _bitmaskCS);
displaymodule 0:d6ff5fa503e8 329 }
displaymodule 0:d6ff5fa503e8 330
displaymodule 0:d6ff5fa503e8 331 void DmTftBase::select(){
displaymodule 0:d6ff5fa503e8 332 cbi(_pinCS, _bitmaskCS);
displaymodule 0:d6ff5fa503e8 333 }
displaymodule 0:d6ff5fa503e8 334
displaymodule 0:d6ff5fa503e8 335 void DmTftBase::unSelect() {
displaymodule 0:d6ff5fa503e8 336 sbi(_pinCS, _bitmaskCS);
displaymodule 0:d6ff5fa503e8 337 }
displaymodule 0:d6ff5fa503e8 338