for 522 mbed basic operate
DmTftBase.cpp@15:70127e08ed27, 2019-12-21 (annotated)
- Committer:
- UlricL
- Date:
- Sat Dec 21 06:43:26 2019 +0000
- Revision:
- 15:70127e08ed27
- Parent:
- 7:6cd8c36cbdb3
522
Who changed what in which revision?
User | Revision | Line number | New 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 |