Uses the same fonts as the SPI_TFT_ILI9341 Library (I have many, and a html/php font editor for that)
SPI_TFT_ILI9225.cpp@9:680f6c9940b3, 2016-11-23 (annotated)
- Committer:
- JackB
- Date:
- Wed Nov 23 11:57:11 2016 +0000
- Revision:
- 9:680f6c9940b3
- Parent:
- 8:a569bc50b552
- Child:
- 10:a640680b5309
Performance improvement for hline/vline (15 times faster)
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
JackB | 0:cc1fb45bc3ad | 1 | /* |
JackB | 0:cc1fb45bc3ad | 2 | **************** ****************** |
JackB | 0:cc1fb45bc3ad | 3 | |
JackB | 0:cc1fb45bc3ad | 4 | Ported to mbed platform |
JackB | 0:cc1fb45bc3ad | 5 | by Arman Safikhani 31 - 08-2015 |
JackB | 0:cc1fb45bc3ad | 6 | |
JackB | 0:cc1fb45bc3ad | 7 | Jack: Many thanks Arman! |
JackB | 0:cc1fb45bc3ad | 8 | |
JackB | 0:cc1fb45bc3ad | 9 | Changed: |
JackB | 0:cc1fb45bc3ad | 10 | by Jack Berkhout 23-11-2016 |
JackB | 1:8e447a4c8995 | 11 | - uses the same fonts as the SPI_TFT_ILI9341 Library (I have many, and a html/php font editor for that) |
JackB | 0:cc1fb45bc3ad | 12 | - some code removed, some added, some changed |
JackB | 0:cc1fb45bc3ad | 13 | - the led backlight is using a PWM output, so it can be adjusted (0.0f = off - 1.0f = on) |
JackB | 0:cc1fb45bc3ad | 14 | - added formatted printf |
JackB | 0:cc1fb45bc3ad | 15 | - added claim as standard output on stream |
JackB | 2:e213811335ac | 16 | - Orientation definitions are now related to the SD card slot location (front view) |
JackB | 0:cc1fb45bc3ad | 17 | |
JackB | 0:cc1fb45bc3ad | 18 | * *************** ****************** |
JackB | 0:cc1fb45bc3ad | 19 | */ |
JackB | 0:cc1fb45bc3ad | 20 | |
JackB | 0:cc1fb45bc3ad | 21 | #include "SPI_TFT_ILI9225.h" |
JackB | 0:cc1fb45bc3ad | 22 | #define bitRead(value, bit) (((value) >> (bit)) & 0x01) |
JackB | 0:cc1fb45bc3ad | 23 | |
JackB | 0:cc1fb45bc3ad | 24 | int font_color, x_font, y_font; |
JackB | 0:cc1fb45bc3ad | 25 | char highlight, fa_num; |
JackB | 0:cc1fb45bc3ad | 26 | int effect = 0, italic = 0; |
JackB | 0:cc1fb45bc3ad | 27 | unsigned int highlight_color; |
JackB | 0:cc1fb45bc3ad | 28 | /* Global Variables */ |
JackB | 0:cc1fb45bc3ad | 29 | int x_text = 0, y_text = 0; |
JackB | 0:cc1fb45bc3ad | 30 | int x_base = 0; |
JackB | 0:cc1fb45bc3ad | 31 | |
JackB | 0:cc1fb45bc3ad | 32 | // Constructor when using software SPI. All output pins are configurable. |
JackB | 0:cc1fb45bc3ad | 33 | TFT_22_ILI9225::TFT_22_ILI9225(PinName sdi, PinName clk, PinName cs, PinName rs, PinName rst, PinName led, const char *name) : |
JackB | 0:cc1fb45bc3ad | 34 | spi(sdi, NC, clk), _cs(cs), _rs(rs), _rst(rst), _led(led), Stream(name) |
JackB | 0:cc1fb45bc3ad | 35 | { |
JackB | 0:cc1fb45bc3ad | 36 | spi.frequency(24000000); |
JackB | 0:cc1fb45bc3ad | 37 | spi.format(8, 0); |
JackB | 0:cc1fb45bc3ad | 38 | |
JackB | 0:cc1fb45bc3ad | 39 | // PWM output to control backlight |
JackB | 0:cc1fb45bc3ad | 40 | _led.period_ms(10); |
JackB | 0:cc1fb45bc3ad | 41 | |
JackB | 0:cc1fb45bc3ad | 42 | // --- claim --- |
JackB | 0:cc1fb45bc3ad | 43 | _row = 0; |
JackB | 0:cc1fb45bc3ad | 44 | _column = 0; |
JackB | 0:cc1fb45bc3ad | 45 | if (name == NULL) { |
JackB | 0:cc1fb45bc3ad | 46 | _path = NULL; |
JackB | 0:cc1fb45bc3ad | 47 | } else { |
JackB | 0:cc1fb45bc3ad | 48 | _path = new char[strlen(name) + 2]; |
JackB | 0:cc1fb45bc3ad | 49 | sprintf(_path, "/%s", name); |
JackB | 0:cc1fb45bc3ad | 50 | } |
JackB | 0:cc1fb45bc3ad | 51 | // --- /claim --- |
JackB | 0:cc1fb45bc3ad | 52 | |
JackB | 0:cc1fb45bc3ad | 53 | init(); |
JackB | 0:cc1fb45bc3ad | 54 | } |
JackB | 0:cc1fb45bc3ad | 55 | |
JackB | 7:2616ae4dd315 | 56 | bool TFT_22_ILI9225::claim (FILE *stream) |
JackB | 7:2616ae4dd315 | 57 | { |
JackB | 0:cc1fb45bc3ad | 58 | if ( _path == NULL) { |
JackB | 0:cc1fb45bc3ad | 59 | fprintf(stderr, "claim requires a name to be given in the instantioator of the TextDisplay instance!\r\n"); |
JackB | 0:cc1fb45bc3ad | 60 | return false; |
JackB | 0:cc1fb45bc3ad | 61 | } |
JackB | 0:cc1fb45bc3ad | 62 | if (freopen(_path, "w", stream) == NULL) { |
JackB | 0:cc1fb45bc3ad | 63 | // Failed, should not happen |
JackB | 0:cc1fb45bc3ad | 64 | return false; |
JackB | 0:cc1fb45bc3ad | 65 | } |
JackB | 0:cc1fb45bc3ad | 66 | // make sure we use line buffering |
JackB | 0:cc1fb45bc3ad | 67 | setvbuf(stdout, NULL, _IOLBF, ILI9225_CHARS_PER_LINE); |
JackB | 0:cc1fb45bc3ad | 68 | return true; |
JackB | 0:cc1fb45bc3ad | 69 | } |
JackB | 0:cc1fb45bc3ad | 70 | |
JackB | 7:2616ae4dd315 | 71 | void TFT_22_ILI9225::_orientCoordinates(uint16_t &x1, uint16_t &y1) |
JackB | 7:2616ae4dd315 | 72 | { |
JackB | 0:cc1fb45bc3ad | 73 | switch (_orientation) { |
JackB | 0:cc1fb45bc3ad | 74 | case 0: // ok |
JackB | 0:cc1fb45bc3ad | 75 | break; |
JackB | 0:cc1fb45bc3ad | 76 | case 1: // ok |
JackB | 0:cc1fb45bc3ad | 77 | y1 = _maxY - y1 - 1; |
JackB | 0:cc1fb45bc3ad | 78 | _swap(x1, y1); |
JackB | 0:cc1fb45bc3ad | 79 | break; |
JackB | 0:cc1fb45bc3ad | 80 | case 2: // ok |
JackB | 0:cc1fb45bc3ad | 81 | x1 = _maxX - x1 - 1; |
JackB | 0:cc1fb45bc3ad | 82 | y1 = _maxY - y1 - 1; |
JackB | 0:cc1fb45bc3ad | 83 | break; |
JackB | 0:cc1fb45bc3ad | 84 | case 3: // ok |
JackB | 0:cc1fb45bc3ad | 85 | x1 = _maxX - x1 - 1; |
JackB | 0:cc1fb45bc3ad | 86 | _swap(x1, y1); |
JackB | 0:cc1fb45bc3ad | 87 | break; |
JackB | 0:cc1fb45bc3ad | 88 | } |
JackB | 0:cc1fb45bc3ad | 89 | } |
JackB | 0:cc1fb45bc3ad | 90 | |
JackB | 7:2616ae4dd315 | 91 | void TFT_22_ILI9225::_setWindowMax(void) |
JackB | 7:2616ae4dd315 | 92 | { |
JackB | 0:cc1fb45bc3ad | 93 | _setWindow(0, 0, maxX(), maxY()); |
JackB | 0:cc1fb45bc3ad | 94 | } |
JackB | 0:cc1fb45bc3ad | 95 | |
JackB | 7:2616ae4dd315 | 96 | void TFT_22_ILI9225::_setWindow(uint16_t x0, uint16_t y0, uint16_t x1, uint16_t y1) |
JackB | 7:2616ae4dd315 | 97 | { |
JackB | 0:cc1fb45bc3ad | 98 | _orientCoordinates(x0, y0); |
JackB | 0:cc1fb45bc3ad | 99 | _orientCoordinates(x1, y1); |
JackB | 0:cc1fb45bc3ad | 100 | |
JackB | 0:cc1fb45bc3ad | 101 | if (x1 < x0) _swap(x0, x1); |
JackB | 0:cc1fb45bc3ad | 102 | if (y1 < y0) _swap(y0, y1); |
JackB | 0:cc1fb45bc3ad | 103 | |
JackB | 0:cc1fb45bc3ad | 104 | _writeRegister(ILI9225_HORIZONTAL_WINDOW_ADDR1, x1); |
JackB | 0:cc1fb45bc3ad | 105 | _writeRegister(ILI9225_HORIZONTAL_WINDOW_ADDR2, x0); |
JackB | 0:cc1fb45bc3ad | 106 | |
JackB | 0:cc1fb45bc3ad | 107 | _writeRegister(ILI9225_VERTICAL_WINDOW_ADDR1, y1); |
JackB | 0:cc1fb45bc3ad | 108 | _writeRegister(ILI9225_VERTICAL_WINDOW_ADDR2, y0); |
JackB | 0:cc1fb45bc3ad | 109 | |
JackB | 0:cc1fb45bc3ad | 110 | _writeRegister(ILI9225_RAM_ADDR_SET1, x0); |
JackB | 0:cc1fb45bc3ad | 111 | _writeRegister(ILI9225_RAM_ADDR_SET2, y0); |
JackB | 0:cc1fb45bc3ad | 112 | |
JackB | 0:cc1fb45bc3ad | 113 | _writeCommand(0x00, 0x22); |
JackB | 0:cc1fb45bc3ad | 114 | } |
JackB | 0:cc1fb45bc3ad | 115 | |
JackB | 0:cc1fb45bc3ad | 116 | void TFT_22_ILI9225::init() |
JackB | 0:cc1fb45bc3ad | 117 | { |
JackB | 0:cc1fb45bc3ad | 118 | // Turn off backlight |
JackB | 0:cc1fb45bc3ad | 119 | setBacklight(0.0f); |
JackB | 0:cc1fb45bc3ad | 120 | |
JackB | 0:cc1fb45bc3ad | 121 | // Initialization Code |
JackB | 0:cc1fb45bc3ad | 122 | _rst = 0;// Pull the reset pin low to reset ILI9225 |
JackB | 0:cc1fb45bc3ad | 123 | wait_ms(10); |
JackB | 0:cc1fb45bc3ad | 124 | _rst = 1;// Pull the reset pin high to release the ILI9225C from the reset status |
JackB | 0:cc1fb45bc3ad | 125 | wait_ms(50); |
JackB | 0:cc1fb45bc3ad | 126 | |
JackB | 0:cc1fb45bc3ad | 127 | /* Start Initial Sequence */ |
JackB | 0:cc1fb45bc3ad | 128 | /* Set SS bit and direction output from S528 to S1 */ |
JackB | 0:cc1fb45bc3ad | 129 | _writeRegister(ILI9225_POWER_CTRL1, 0x0000); // Set SAP,DSTB,STB |
JackB | 0:cc1fb45bc3ad | 130 | _writeRegister(ILI9225_POWER_CTRL2, 0x0000); // Set APON,PON,AON,VCI1EN,VC |
JackB | 0:cc1fb45bc3ad | 131 | _writeRegister(ILI9225_POWER_CTRL3, 0x0000); // Set BT,DC1,DC2,DC3 |
JackB | 0:cc1fb45bc3ad | 132 | _writeRegister(ILI9225_POWER_CTRL4, 0x0000); // Set GVDD |
JackB | 0:cc1fb45bc3ad | 133 | _writeRegister(ILI9225_POWER_CTRL5, 0x0000); // Set VCOMH/VCOML voltage |
JackB | 0:cc1fb45bc3ad | 134 | wait_ms(40); |
JackB | 0:cc1fb45bc3ad | 135 | |
JackB | 0:cc1fb45bc3ad | 136 | // Power-on sequence |
JackB | 0:cc1fb45bc3ad | 137 | _writeRegister(ILI9225_POWER_CTRL2, 0x0018); // Set APON,PON,AON,VCI1EN,VC |
JackB | 0:cc1fb45bc3ad | 138 | _writeRegister(ILI9225_POWER_CTRL3, 0x6121); // Set BT,DC1,DC2,DC3 |
JackB | 0:cc1fb45bc3ad | 139 | _writeRegister(ILI9225_POWER_CTRL4, 0x006F); // Set GVDD /*007F 0088 */ |
JackB | 0:cc1fb45bc3ad | 140 | _writeRegister(ILI9225_POWER_CTRL5, 0x495F); // Set VCOMH/VCOML voltage |
JackB | 0:cc1fb45bc3ad | 141 | _writeRegister(ILI9225_POWER_CTRL1, 0x0800); // Set SAP,DSTB,STB |
JackB | 0:cc1fb45bc3ad | 142 | wait_ms(10); |
JackB | 0:cc1fb45bc3ad | 143 | _writeRegister(ILI9225_POWER_CTRL2, 0x103B); // Set APON,PON,AON,VCI1EN,VC |
JackB | 0:cc1fb45bc3ad | 144 | wait_ms(50); |
JackB | 0:cc1fb45bc3ad | 145 | |
JackB | 0:cc1fb45bc3ad | 146 | _writeRegister(ILI9225_DRIVER_OUTPUT_CTRL, 0x011C); // set the display line number and display direction |
JackB | 0:cc1fb45bc3ad | 147 | _writeRegister(ILI9225_LCD_AC_DRIVING_CTRL, 0x0100); // set 1 line inversion |
JackB | 0:cc1fb45bc3ad | 148 | _writeRegister(ILI9225_ENTRY_MODE, 0x1030); // set GRAM write direction and BGR=1. |
JackB | 0:cc1fb45bc3ad | 149 | _writeRegister(ILI9225_DISP_CTRL1, 0x0000); // Display off |
JackB | 0:cc1fb45bc3ad | 150 | _writeRegister(ILI9225_BLANK_PERIOD_CTRL1, 0x0808); // set the back porch and front porch |
JackB | 0:cc1fb45bc3ad | 151 | _writeRegister(ILI9225_FRAME_CYCLE_CTRL, 0x1100); // set the clocks number per line |
JackB | 0:cc1fb45bc3ad | 152 | _writeRegister(ILI9225_INTERFACE_CTRL, 0x0000); // CPU interface |
JackB | 0:cc1fb45bc3ad | 153 | _writeRegister(ILI9225_OSC_CTRL, 0x0D01); // Set Osc /*0e01*/ |
JackB | 0:cc1fb45bc3ad | 154 | _writeRegister(ILI9225_VCI_RECYCLING, 0x0020); // Set VCI recycling |
JackB | 0:cc1fb45bc3ad | 155 | _writeRegister(ILI9225_RAM_ADDR_SET1, 0x0000); // RAM Address |
JackB | 0:cc1fb45bc3ad | 156 | _writeRegister(ILI9225_RAM_ADDR_SET2, 0x0000); // RAM Address |
JackB | 0:cc1fb45bc3ad | 157 | |
JackB | 0:cc1fb45bc3ad | 158 | /* Set GRAM area */ |
JackB | 0:cc1fb45bc3ad | 159 | _writeRegister(ILI9225_GATE_SCAN_CTRL, 0x0000); |
JackB | 0:cc1fb45bc3ad | 160 | _writeRegister(ILI9225_VERTICAL_SCROLL_CTRL1, 0x00DB); |
JackB | 0:cc1fb45bc3ad | 161 | _writeRegister(ILI9225_VERTICAL_SCROLL_CTRL2, 0x0000); |
JackB | 0:cc1fb45bc3ad | 162 | _writeRegister(ILI9225_VERTICAL_SCROLL_CTRL3, 0x0000); |
JackB | 0:cc1fb45bc3ad | 163 | _writeRegister(ILI9225_PARTIAL_DRIVING_POS1, 0x00DB); |
JackB | 0:cc1fb45bc3ad | 164 | _writeRegister(ILI9225_PARTIAL_DRIVING_POS2, 0x0000); |
JackB | 0:cc1fb45bc3ad | 165 | _writeRegister(ILI9225_HORIZONTAL_WINDOW_ADDR1, 0x00AF); |
JackB | 0:cc1fb45bc3ad | 166 | _writeRegister(ILI9225_HORIZONTAL_WINDOW_ADDR2, 0x0000); |
JackB | 0:cc1fb45bc3ad | 167 | _writeRegister(ILI9225_VERTICAL_WINDOW_ADDR1, 0x00DB); |
JackB | 0:cc1fb45bc3ad | 168 | _writeRegister(ILI9225_VERTICAL_WINDOW_ADDR2, 0x0000); |
JackB | 0:cc1fb45bc3ad | 169 | |
JackB | 0:cc1fb45bc3ad | 170 | /* Set GAMMA curve */ |
JackB | 0:cc1fb45bc3ad | 171 | _writeRegister(ILI9225_GAMMA_CTRL1, 0x0000); |
JackB | 0:cc1fb45bc3ad | 172 | _writeRegister(ILI9225_GAMMA_CTRL2, 0x0808); |
JackB | 0:cc1fb45bc3ad | 173 | _writeRegister(ILI9225_GAMMA_CTRL3, 0x080A); |
JackB | 0:cc1fb45bc3ad | 174 | _writeRegister(ILI9225_GAMMA_CTRL4, 0x000A); |
JackB | 0:cc1fb45bc3ad | 175 | _writeRegister(ILI9225_GAMMA_CTRL5, 0x0A08); |
JackB | 0:cc1fb45bc3ad | 176 | _writeRegister(ILI9225_GAMMA_CTRL6, 0x0808); |
JackB | 0:cc1fb45bc3ad | 177 | _writeRegister(ILI9225_GAMMA_CTRL7, 0x0000); |
JackB | 0:cc1fb45bc3ad | 178 | _writeRegister(ILI9225_GAMMA_CTRL8, 0x0A00); |
JackB | 0:cc1fb45bc3ad | 179 | _writeRegister(ILI9225_GAMMA_CTRL9, 0x0710); |
JackB | 0:cc1fb45bc3ad | 180 | _writeRegister(ILI9225_GAMMA_CTRL10, 0x0710); |
JackB | 0:cc1fb45bc3ad | 181 | |
JackB | 0:cc1fb45bc3ad | 182 | _writeRegister(ILI9225_DISP_CTRL1, 0x0012); |
JackB | 0:cc1fb45bc3ad | 183 | wait_ms(50); |
JackB | 0:cc1fb45bc3ad | 184 | _writeRegister(ILI9225_DISP_CTRL1, 0x1017); |
JackB | 0:cc1fb45bc3ad | 185 | |
JackB | 0:cc1fb45bc3ad | 186 | cls(); |
JackB | 0:cc1fb45bc3ad | 187 | linespacing(0); |
JackB | 0:cc1fb45bc3ad | 188 | setBacklight(1.0f); |
JackB | 5:dad648238df3 | 189 | setOrientation(ILI9225_LANDSCAPE_B); |
JackB | 0:cc1fb45bc3ad | 190 | foreground(COLOR_WHITE); |
JackB | 0:cc1fb45bc3ad | 191 | background(COLOR_BLACK); |
JackB | 0:cc1fb45bc3ad | 192 | } |
JackB | 0:cc1fb45bc3ad | 193 | |
JackB | 7:2616ae4dd315 | 194 | void TFT_22_ILI9225::cls() |
JackB | 7:2616ae4dd315 | 195 | { |
JackB | 0:cc1fb45bc3ad | 196 | setBacklightOff(); |
JackB | 0:cc1fb45bc3ad | 197 | _setWindowMax(); |
JackB | 0:cc1fb45bc3ad | 198 | _rs = 1; |
JackB | 0:cc1fb45bc3ad | 199 | _cs = 0; |
JackB | 0:cc1fb45bc3ad | 200 | for (uint16_t i = width() * height(); i > 0; i--) { |
JackB | 0:cc1fb45bc3ad | 201 | spi.write(0x00); |
JackB | 0:cc1fb45bc3ad | 202 | spi.write(0x00); |
JackB | 0:cc1fb45bc3ad | 203 | } |
JackB | 0:cc1fb45bc3ad | 204 | _cs = 1; |
JackB | 0:cc1fb45bc3ad | 205 | setBacklightOn(); |
JackB | 0:cc1fb45bc3ad | 206 | gotoxy(0, 0); |
JackB | 0:cc1fb45bc3ad | 207 | } |
JackB | 0:cc1fb45bc3ad | 208 | |
JackB | 0:cc1fb45bc3ad | 209 | void TFT_22_ILI9225::fill(uint16_t color) |
JackB | 0:cc1fb45bc3ad | 210 | { |
JackB | 5:dad648238df3 | 211 | fillrect(0, 0, maxX(), maxY(), color); |
JackB | 0:cc1fb45bc3ad | 212 | } |
JackB | 0:cc1fb45bc3ad | 213 | |
JackB | 7:2616ae4dd315 | 214 | void TFT_22_ILI9225::invert(bool flag) |
JackB | 7:2616ae4dd315 | 215 | { |
JackB | 0:cc1fb45bc3ad | 216 | _writeCommand(0x00, flag ? ILI9225C_INVON : ILI9225C_INVOFF); |
JackB | 0:cc1fb45bc3ad | 217 | } |
JackB | 0:cc1fb45bc3ad | 218 | |
JackB | 7:2616ae4dd315 | 219 | void TFT_22_ILI9225::setBacklight(double brightness) |
JackB | 7:2616ae4dd315 | 220 | { |
JackB | 0:cc1fb45bc3ad | 221 | // PWM output to control backlight |
JackB | 0:cc1fb45bc3ad | 222 | _brightness = brightness; |
JackB | 0:cc1fb45bc3ad | 223 | _led.write(pow(brightness, 2)); // power(x, 2): For the eye better brightness response |
JackB | 0:cc1fb45bc3ad | 224 | } |
JackB | 0:cc1fb45bc3ad | 225 | |
JackB | 7:2616ae4dd315 | 226 | void TFT_22_ILI9225::setBacklightOff(void) |
JackB | 7:2616ae4dd315 | 227 | { |
JackB | 0:cc1fb45bc3ad | 228 | _led.write(0.0f); |
JackB | 0:cc1fb45bc3ad | 229 | } |
JackB | 0:cc1fb45bc3ad | 230 | |
JackB | 7:2616ae4dd315 | 231 | void TFT_22_ILI9225::setBacklightOn(void) |
JackB | 7:2616ae4dd315 | 232 | { |
JackB | 0:cc1fb45bc3ad | 233 | setBacklight(_brightness); |
JackB | 0:cc1fb45bc3ad | 234 | } |
JackB | 0:cc1fb45bc3ad | 235 | |
JackB | 0:cc1fb45bc3ad | 236 | void TFT_22_ILI9225::setDisplay(bool flag) { |
JackB | 0:cc1fb45bc3ad | 237 | if (flag) { |
JackB | 0:cc1fb45bc3ad | 238 | _writeRegister(0x00ff, 0x0000); |
JackB | 0:cc1fb45bc3ad | 239 | _writeRegister(ILI9225_POWER_CTRL1, 0x0000); |
JackB | 0:cc1fb45bc3ad | 240 | wait_ms(50); |
JackB | 0:cc1fb45bc3ad | 241 | _writeRegister(ILI9225_DISP_CTRL1, 0x1017); |
JackB | 0:cc1fb45bc3ad | 242 | wait_ms(200); |
JackB | 0:cc1fb45bc3ad | 243 | } |
JackB | 0:cc1fb45bc3ad | 244 | else { |
JackB | 0:cc1fb45bc3ad | 245 | _writeRegister(0x00ff, 0x0000); |
JackB | 0:cc1fb45bc3ad | 246 | _writeRegister(ILI9225_DISP_CTRL1, 0x0000); |
JackB | 0:cc1fb45bc3ad | 247 | wait_ms(50); |
JackB | 0:cc1fb45bc3ad | 248 | _writeRegister(ILI9225_POWER_CTRL1, 0x0003); |
JackB | 0:cc1fb45bc3ad | 249 | wait_ms(200); |
JackB | 0:cc1fb45bc3ad | 250 | } |
JackB | 0:cc1fb45bc3ad | 251 | } |
JackB | 0:cc1fb45bc3ad | 252 | |
JackB | 8:a569bc50b552 | 253 | void TFT_22_ILI9225::setOrientation(uint8_t orientation) |
JackB | 8:a569bc50b552 | 254 | { |
JackB | 0:cc1fb45bc3ad | 255 | _orientation = orientation % 4; |
JackB | 3:41e8d7dc279a | 256 | // Entry Mode (R03h) |
JackB | 3:41e8d7dc279a | 257 | // 0x1000 AM = 0: Horizontal, I/D[1:0] = 00: Horizontal: decrement, Vertical: decrement - ILI9225_PORTRAIT_R |
JackB | 3:41e8d7dc279a | 258 | // 0x1010 AM = 0: Horizontal, I/D[1:0] = 01: Horizontal: increment, Vertical: decrement |
JackB | 3:41e8d7dc279a | 259 | // 0x1020 AM = 0: Horizontal, I/D[1:0] = 10: Horizontal: decrement, Vertical: increment |
JackB | 3:41e8d7dc279a | 260 | // 0x1030 AM = 0: Horizontal, I/D[1:0] = 11: Horizontal: increment, Vertical: increment - ILI9225_PORTRAIT_L |
JackB | 3:41e8d7dc279a | 261 | // 0x1008 AM = 1: Vertical, I/D[1:0] = 00: Horizontal: decrement, Vertical: decrement |
JackB | 3:41e8d7dc279a | 262 | // 0x1018 AM = 1: Vertical, I/D[1:0] = 01: Horizontal: increment, Vertical: decrement - ILI9225_LANDSCAPE_T |
JackB | 3:41e8d7dc279a | 263 | // 0x1028 AM = 1: Vertical, I/D[1:0] = 10: Horizontal: decrement, Vertical: increment - ILI9225_LANDSCAPE_B |
JackB | 3:41e8d7dc279a | 264 | // 0x1038 AM = 1: Vertical, I/D[1:0] = 11: Horizontal: increment, Vertical: increment |
JackB | 9:680f6c9940b3 | 265 | |
JackB | 0:cc1fb45bc3ad | 266 | switch (_orientation) { |
JackB | 3:41e8d7dc279a | 267 | case ILI9225_PORTRAIT_L: |
JackB | 3:41e8d7dc279a | 268 | // 0x1030 AM = 0: Horizontal, I/D[1:0] = 11: Horizontal: increment, Vertical: increment |
JackB | 9:680f6c9940b3 | 269 | _entryMode = 0x1030; |
JackB | 3:41e8d7dc279a | 270 | _maxX = ILI9225_LCD_WIDTH; |
JackB | 3:41e8d7dc279a | 271 | _maxY = ILI9225_LCD_HEIGHT; |
JackB | 3:41e8d7dc279a | 272 | break; |
JackB | 3:41e8d7dc279a | 273 | case ILI9225_LANDSCAPE_B: |
JackB | 3:41e8d7dc279a | 274 | // 0x1028 AM = 1: Vertical, I/D[1:0] = 10: Horizontal: decrement, Vertical: increment |
JackB | 9:680f6c9940b3 | 275 | _entryMode = 0x1028; |
JackB | 3:41e8d7dc279a | 276 | _maxX = ILI9225_LCD_HEIGHT; |
JackB | 3:41e8d7dc279a | 277 | _maxY = ILI9225_LCD_WIDTH; |
JackB | 3:41e8d7dc279a | 278 | break; |
JackB | 3:41e8d7dc279a | 279 | case ILI9225_PORTRAIT_R: |
JackB | 3:41e8d7dc279a | 280 | // 0x1000 AM = 0: Horizontal, I/D[1:0] = 00: Horizontal: decrement, Vertical: decrement |
JackB | 9:680f6c9940b3 | 281 | _entryMode = 0x1000; |
JackB | 3:41e8d7dc279a | 282 | _maxX = ILI9225_LCD_WIDTH; |
JackB | 3:41e8d7dc279a | 283 | _maxY = ILI9225_LCD_HEIGHT; |
JackB | 3:41e8d7dc279a | 284 | break; |
JackB | 3:41e8d7dc279a | 285 | case ILI9225_LANDSCAPE_T: |
JackB | 3:41e8d7dc279a | 286 | // 0x1018 AM = 1: Vertical, I/D[1:0] = 01: Horizontal: increment, Vertical: decrement |
JackB | 9:680f6c9940b3 | 287 | _entryMode = 0x1018; |
JackB | 3:41e8d7dc279a | 288 | _maxX = ILI9225_LCD_HEIGHT; |
JackB | 3:41e8d7dc279a | 289 | _maxY = ILI9225_LCD_WIDTH; |
JackB | 3:41e8d7dc279a | 290 | break; |
JackB | 0:cc1fb45bc3ad | 291 | } |
JackB | 9:680f6c9940b3 | 292 | _writeRegister(ILI9225_ENTRY_MODE, _entryMode); // set GRAM write direction and BGR=1. |
JackB | 0:cc1fb45bc3ad | 293 | } |
JackB | 0:cc1fb45bc3ad | 294 | |
JackB | 0:cc1fb45bc3ad | 295 | uint8_t TFT_22_ILI9225::getOrientation() { |
JackB | 0:cc1fb45bc3ad | 296 | return _orientation; |
JackB | 0:cc1fb45bc3ad | 297 | } |
JackB | 0:cc1fb45bc3ad | 298 | |
JackB | 5:dad648238df3 | 299 | // Graphics functions |
JackB | 5:dad648238df3 | 300 | |
JackB | 5:dad648238df3 | 301 | void TFT_22_ILI9225::pixel(uint16_t x1, uint16_t y1, uint16_t color) { |
JackB | 5:dad648238df3 | 302 | |
JackB | 5:dad648238df3 | 303 | if ((x1 >= _maxX) || (y1 >= _maxY)) return; |
JackB | 0:cc1fb45bc3ad | 304 | |
JackB | 5:dad648238df3 | 305 | _setWindow(x1, y1, x1 + 1, y1 + 1); |
JackB | 5:dad648238df3 | 306 | _orientCoordinates(x1, y1); |
JackB | 5:dad648238df3 | 307 | _rs = 1; |
JackB | 5:dad648238df3 | 308 | _cs = 0; |
JackB | 5:dad648238df3 | 309 | spi.write(color >> 8); |
JackB | 5:dad648238df3 | 310 | spi.write(color & 0xff); |
JackB | 5:dad648238df3 | 311 | _cs = 1; |
JackB | 0:cc1fb45bc3ad | 312 | } |
JackB | 0:cc1fb45bc3ad | 313 | |
JackB | 5:dad648238df3 | 314 | void TFT_22_ILI9225::line(uint16_t x1, uint16_t y1, uint16_t x2, uint16_t y2, uint16_t color) { |
JackB | 0:cc1fb45bc3ad | 315 | |
JackB | 0:cc1fb45bc3ad | 316 | // Classic Bresenham algorithm |
JackB | 0:cc1fb45bc3ad | 317 | int16_t steep = abs(y2 - y1) > abs(x2 - x1); |
JackB | 0:cc1fb45bc3ad | 318 | int16_t dx, dy; |
JackB | 0:cc1fb45bc3ad | 319 | |
JackB | 0:cc1fb45bc3ad | 320 | if (steep) { |
JackB | 0:cc1fb45bc3ad | 321 | _swap(x1, y1); |
JackB | 0:cc1fb45bc3ad | 322 | _swap(x2, y2); |
JackB | 0:cc1fb45bc3ad | 323 | } |
JackB | 0:cc1fb45bc3ad | 324 | |
JackB | 0:cc1fb45bc3ad | 325 | if (x1 > x2) { |
JackB | 0:cc1fb45bc3ad | 326 | _swap(x1, x2); |
JackB | 0:cc1fb45bc3ad | 327 | _swap(y1, y2); |
JackB | 0:cc1fb45bc3ad | 328 | } |
JackB | 0:cc1fb45bc3ad | 329 | |
JackB | 0:cc1fb45bc3ad | 330 | dx = x2 - x1; |
JackB | 0:cc1fb45bc3ad | 331 | dy = abs(y2 - y1); |
JackB | 0:cc1fb45bc3ad | 332 | |
JackB | 0:cc1fb45bc3ad | 333 | int16_t err = dx / 2; |
JackB | 0:cc1fb45bc3ad | 334 | int16_t ystep; |
JackB | 0:cc1fb45bc3ad | 335 | |
JackB | 0:cc1fb45bc3ad | 336 | if (y1 < y2) ystep = 1; |
JackB | 0:cc1fb45bc3ad | 337 | else ystep = -1; |
JackB | 0:cc1fb45bc3ad | 338 | |
JackB | 0:cc1fb45bc3ad | 339 | |
JackB | 0:cc1fb45bc3ad | 340 | for (; x1 <= x2; x1++) { |
JackB | 5:dad648238df3 | 341 | if (steep) pixel(y1, x1, color); |
JackB | 5:dad648238df3 | 342 | else pixel(x1, y1, color); |
JackB | 0:cc1fb45bc3ad | 343 | |
JackB | 0:cc1fb45bc3ad | 344 | err -= dy; |
JackB | 0:cc1fb45bc3ad | 345 | if (err < 0) { |
JackB | 0:cc1fb45bc3ad | 346 | y1 += ystep; |
JackB | 0:cc1fb45bc3ad | 347 | err += dx; |
JackB | 0:cc1fb45bc3ad | 348 | } |
JackB | 0:cc1fb45bc3ad | 349 | } |
JackB | 0:cc1fb45bc3ad | 350 | } |
JackB | 0:cc1fb45bc3ad | 351 | |
JackB | 9:680f6c9940b3 | 352 | void TFT_22_ILI9225::hline(uint16_t x1, uint16_t x2, uint16_t y, uint16_t color) |
JackB | 9:680f6c9940b3 | 353 | { |
JackB | 9:680f6c9940b3 | 354 | _writeRegister(ILI9225_ENTRY_MODE, 0x1028); // set GRAM write direction and BGR=1. |
JackB | 9:680f6c9940b3 | 355 | _setWindow(x1, y, x2 + 1, y + 1); |
JackB | 9:680f6c9940b3 | 356 | if (x2 < x1) { |
JackB | 9:680f6c9940b3 | 357 | _swap(x1, x2); |
JackB | 9:680f6c9940b3 | 358 | } |
JackB | 9:680f6c9940b3 | 359 | _rs = 1; |
JackB | 9:680f6c9940b3 | 360 | _cs = 0; |
JackB | 9:680f6c9940b3 | 361 | for (uint16_t x = x1; x <= x2; x++) { |
JackB | 9:680f6c9940b3 | 362 | spi.write(color >> 8); |
JackB | 9:680f6c9940b3 | 363 | spi.write(color & 0xff); |
JackB | 7:2616ae4dd315 | 364 | } |
JackB | 9:680f6c9940b3 | 365 | _cs = 1; |
JackB | 9:680f6c9940b3 | 366 | _writeRegister(ILI9225_ENTRY_MODE, _entryMode); // set GRAM write direction and BGR=1. |
JackB | 7:2616ae4dd315 | 367 | } |
JackB | 7:2616ae4dd315 | 368 | |
JackB | 9:680f6c9940b3 | 369 | void TFT_22_ILI9225::vline(uint16_t x, uint16_t y1, uint16_t y2, uint16_t color) |
JackB | 9:680f6c9940b3 | 370 | { |
JackB | 9:680f6c9940b3 | 371 | _writeRegister(ILI9225_ENTRY_MODE, 0x1010); // set GRAM write direction and BGR=1. |
JackB | 9:680f6c9940b3 | 372 | _setWindow(x, y1, x + 1, y2 + 1); |
JackB | 9:680f6c9940b3 | 373 | if (y2 < y1) { |
JackB | 9:680f6c9940b3 | 374 | _swap(y1, y2); |
JackB | 9:680f6c9940b3 | 375 | } |
JackB | 9:680f6c9940b3 | 376 | _rs = 1; |
JackB | 9:680f6c9940b3 | 377 | _cs = 0; |
JackB | 9:680f6c9940b3 | 378 | for (uint16_t y = y1; y <= y2; y++) { |
JackB | 9:680f6c9940b3 | 379 | spi.write(color >> 8); |
JackB | 9:680f6c9940b3 | 380 | spi.write(color & 0xff); |
JackB | 7:2616ae4dd315 | 381 | } |
JackB | 9:680f6c9940b3 | 382 | _cs = 1; |
JackB | 9:680f6c9940b3 | 383 | _writeRegister(ILI9225_ENTRY_MODE, _entryMode); // set GRAM write direction and BGR=1. |
JackB | 7:2616ae4dd315 | 384 | } |
JackB | 7:2616ae4dd315 | 385 | |
JackB | 5:dad648238df3 | 386 | void TFT_22_ILI9225::rect(uint16_t x1, uint16_t y1, uint16_t x2, uint16_t y2, uint16_t color) { |
JackB | 7:2616ae4dd315 | 387 | |
JackB | 7:2616ae4dd315 | 388 | vline(x1, y1, y2, color); |
JackB | 7:2616ae4dd315 | 389 | hline(x1, x2, y1, color); |
JackB | 7:2616ae4dd315 | 390 | hline(x1, x2, y2, color); |
JackB | 7:2616ae4dd315 | 391 | vline(x2, y1, y2, color); |
JackB | 5:dad648238df3 | 392 | } |
JackB | 5:dad648238df3 | 393 | |
JackB | 5:dad648238df3 | 394 | void TFT_22_ILI9225::fillrect(uint16_t x1, uint16_t y1, uint16_t x2, uint16_t y2, uint16_t color) { |
JackB | 7:2616ae4dd315 | 395 | |
JackB | 5:dad648238df3 | 396 | _setWindow(x1, y1, x2, y2); |
JackB | 5:dad648238df3 | 397 | _startData(); |
JackB | 5:dad648238df3 | 398 | for (uint16_t t = (y2 - y1 + 1) * (x2 - x1 + 1); t > 0; t--) { |
JackB | 5:dad648238df3 | 399 | _writeData(color); |
JackB | 5:dad648238df3 | 400 | } |
JackB | 5:dad648238df3 | 401 | _endData(); |
JackB | 5:dad648238df3 | 402 | } |
JackB | 5:dad648238df3 | 403 | |
JackB | 5:dad648238df3 | 404 | void TFT_22_ILI9225::circle(uint16_t x0, uint16_t y0, uint16_t r, uint16_t color) { |
JackB | 5:dad648238df3 | 405 | |
JackB | 5:dad648238df3 | 406 | int16_t f = 1 - r; |
JackB | 5:dad648238df3 | 407 | int16_t ddF_x = 1; |
JackB | 5:dad648238df3 | 408 | int16_t ddF_y = -2 * r; |
JackB | 5:dad648238df3 | 409 | int16_t x = 0; |
JackB | 5:dad648238df3 | 410 | int16_t y = r; |
JackB | 5:dad648238df3 | 411 | |
JackB | 5:dad648238df3 | 412 | pixel(x0, y0 + r, color); |
JackB | 5:dad648238df3 | 413 | pixel(x0, y0 - r, color); |
JackB | 5:dad648238df3 | 414 | pixel(x0 + r, y0, color); |
JackB | 5:dad648238df3 | 415 | pixel(x0 - r, y0, color); |
JackB | 0:cc1fb45bc3ad | 416 | |
JackB | 5:dad648238df3 | 417 | while (x < y) { |
JackB | 5:dad648238df3 | 418 | if (f >= 0) { |
JackB | 5:dad648238df3 | 419 | y--; |
JackB | 5:dad648238df3 | 420 | ddF_y += 2; |
JackB | 5:dad648238df3 | 421 | f += ddF_y; |
JackB | 5:dad648238df3 | 422 | } |
JackB | 5:dad648238df3 | 423 | x++; |
JackB | 5:dad648238df3 | 424 | ddF_x += 2; |
JackB | 5:dad648238df3 | 425 | f += ddF_x; |
JackB | 5:dad648238df3 | 426 | |
JackB | 5:dad648238df3 | 427 | pixel(x0 + x, y0 + y, color); |
JackB | 5:dad648238df3 | 428 | pixel(x0 - x, y0 + y, color); |
JackB | 5:dad648238df3 | 429 | pixel(x0 + x, y0 - y, color); |
JackB | 5:dad648238df3 | 430 | pixel(x0 - x, y0 - y, color); |
JackB | 5:dad648238df3 | 431 | pixel(x0 + y, y0 + x, color); |
JackB | 5:dad648238df3 | 432 | pixel(x0 - y, y0 + x, color); |
JackB | 5:dad648238df3 | 433 | pixel(x0 + y, y0 - x, color); |
JackB | 5:dad648238df3 | 434 | pixel(x0 - y, y0 - x, color); |
JackB | 5:dad648238df3 | 435 | } |
JackB | 5:dad648238df3 | 436 | } |
JackB | 5:dad648238df3 | 437 | |
JackB | 5:dad648238df3 | 438 | void TFT_22_ILI9225::fillcircle(uint8_t x0, uint8_t y0, uint8_t radius, uint16_t color) { |
JackB | 5:dad648238df3 | 439 | |
JackB | 5:dad648238df3 | 440 | int16_t f = 1 - radius; |
JackB | 5:dad648238df3 | 441 | int16_t ddF_x = 1; |
JackB | 5:dad648238df3 | 442 | int16_t ddF_y = -2 * radius; |
JackB | 5:dad648238df3 | 443 | int16_t x = 0; |
JackB | 5:dad648238df3 | 444 | int16_t y = radius; |
JackB | 5:dad648238df3 | 445 | |
JackB | 5:dad648238df3 | 446 | while (x < y) { |
JackB | 5:dad648238df3 | 447 | if (f >= 0) { |
JackB | 5:dad648238df3 | 448 | y--; |
JackB | 5:dad648238df3 | 449 | ddF_y += 2; |
JackB | 5:dad648238df3 | 450 | f += ddF_y; |
JackB | 5:dad648238df3 | 451 | } |
JackB | 5:dad648238df3 | 452 | x++; |
JackB | 5:dad648238df3 | 453 | ddF_x += 2; |
JackB | 5:dad648238df3 | 454 | f += ddF_x; |
JackB | 5:dad648238df3 | 455 | |
JackB | 5:dad648238df3 | 456 | line(x0 + x, y0 + y, x0 - x, y0 + y, color); // bottom |
JackB | 5:dad648238df3 | 457 | line(x0 + x, y0 - y, x0 - x, y0 - y, color); // top |
JackB | 5:dad648238df3 | 458 | line(x0 + y, y0 - x, x0 + y, y0 + x, color); // right |
JackB | 5:dad648238df3 | 459 | line(x0 - y, y0 - x, x0 - y, y0 + x, color); // left |
JackB | 5:dad648238df3 | 460 | } |
JackB | 5:dad648238df3 | 461 | fillrect(x0 - x, y0 - y, x0 + x, y0 + y, color); |
JackB | 5:dad648238df3 | 462 | } |
JackB | 0:cc1fb45bc3ad | 463 | |
JackB | 5:dad648238df3 | 464 | void TFT_22_ILI9225::triangle(uint16_t x1, uint16_t y1, uint16_t x2, uint16_t y2, uint16_t x3, uint16_t y3, uint16_t color) { |
JackB | 5:dad648238df3 | 465 | line(x1, y1, x2, y2, color); |
JackB | 5:dad648238df3 | 466 | line(x2, y2, x3, y3, color); |
JackB | 5:dad648238df3 | 467 | line(x3, y3, x1, y1, color); |
JackB | 5:dad648238df3 | 468 | } |
JackB | 5:dad648238df3 | 469 | |
JackB | 5:dad648238df3 | 470 | void TFT_22_ILI9225::filltriangle(uint16_t x1, uint16_t y1, uint16_t x2, uint16_t y2, uint16_t x3, uint16_t y3, uint16_t color) { |
JackB | 5:dad648238df3 | 471 | |
JackB | 5:dad648238df3 | 472 | uint16_t a, b, y, last; |
JackB | 5:dad648238df3 | 473 | |
JackB | 5:dad648238df3 | 474 | // Sort coordinates by Y order (y3 >= y2 >= y1) |
JackB | 5:dad648238df3 | 475 | if (y1 > y2) { |
JackB | 5:dad648238df3 | 476 | _swap(y1, y2); _swap(x1, x2); |
JackB | 5:dad648238df3 | 477 | } |
JackB | 5:dad648238df3 | 478 | if (y2 > y3) { |
JackB | 5:dad648238df3 | 479 | _swap(y3, y2); _swap(x3, x2); |
JackB | 5:dad648238df3 | 480 | } |
JackB | 5:dad648238df3 | 481 | if (y1 > y2) { |
JackB | 5:dad648238df3 | 482 | _swap(y1, y2); _swap(x1, x2); |
JackB | 5:dad648238df3 | 483 | } |
JackB | 5:dad648238df3 | 484 | |
JackB | 5:dad648238df3 | 485 | if (y1 == y3) { // Handle awkward all-on-same-line case as its own thing |
JackB | 5:dad648238df3 | 486 | a = b = x1; |
JackB | 5:dad648238df3 | 487 | if (x2 < a) a = x2; |
JackB | 5:dad648238df3 | 488 | else if (x2 > b) b = x2; |
JackB | 5:dad648238df3 | 489 | if (x3 < a) a = x3; |
JackB | 5:dad648238df3 | 490 | else if (x3 > b) b = x3; |
JackB | 5:dad648238df3 | 491 | line(a, y1, b, y1, color); |
JackB | 5:dad648238df3 | 492 | return; |
JackB | 5:dad648238df3 | 493 | } |
JackB | 5:dad648238df3 | 494 | |
JackB | 5:dad648238df3 | 495 | uint16_t dx11 = x2 - x1, |
JackB | 5:dad648238df3 | 496 | dy11 = y2 - y1, |
JackB | 5:dad648238df3 | 497 | dx12 = x3 - x1, |
JackB | 5:dad648238df3 | 498 | dy12 = y3 - y1, |
JackB | 5:dad648238df3 | 499 | dx22 = x3 - x2, |
JackB | 5:dad648238df3 | 500 | dy22 = y3 - y2, |
JackB | 5:dad648238df3 | 501 | sa = 0, |
JackB | 5:dad648238df3 | 502 | sb = 0; |
JackB | 5:dad648238df3 | 503 | |
JackB | 5:dad648238df3 | 504 | // For upper part of triangle, find scanline crossings for segments |
JackB | 5:dad648238df3 | 505 | // 0-1 and 0-2. If y2=y3 (flat-bottomed triangle), the scanline y2 |
JackB | 5:dad648238df3 | 506 | // is included here (and second loop will be skipped, avoiding a /0 |
JackB | 5:dad648238df3 | 507 | // error there), otherwise scanline y2 is skipped here and handled |
JackB | 5:dad648238df3 | 508 | // in the second loop...which also avoids a /0 error here if y1=y2 |
JackB | 5:dad648238df3 | 509 | // (flat-topped triangle). |
JackB | 5:dad648238df3 | 510 | if (y2 == y3) last = y2; // Include y2 scanline |
JackB | 5:dad648238df3 | 511 | else last = y2 - 1; // Skip it |
JackB | 5:dad648238df3 | 512 | |
JackB | 5:dad648238df3 | 513 | for (y = y1; y <= last; y++) { |
JackB | 5:dad648238df3 | 514 | a = x1 + sa / dy11; |
JackB | 5:dad648238df3 | 515 | b = x1 + sb / dy12; |
JackB | 5:dad648238df3 | 516 | sa += dx11; |
JackB | 5:dad648238df3 | 517 | sb += dx12; |
JackB | 5:dad648238df3 | 518 | /* longhand: |
JackB | 5:dad648238df3 | 519 | a = x1 + (x2 - x1) * (y - y1) / (y2 - y1); |
JackB | 5:dad648238df3 | 520 | b = x1 + (x3 - x1) * (y - y1) / (y3 - y1); |
JackB | 5:dad648238df3 | 521 | */ |
JackB | 5:dad648238df3 | 522 | if (a > b) _swap(a, b); |
JackB | 5:dad648238df3 | 523 | line(a, y, b, y, color); |
JackB | 5:dad648238df3 | 524 | } |
JackB | 5:dad648238df3 | 525 | |
JackB | 5:dad648238df3 | 526 | // For lower part of triangle, find scanline crossings for segments |
JackB | 5:dad648238df3 | 527 | // 0-2 and 1-2. This loop is skipped if y2=y3. |
JackB | 5:dad648238df3 | 528 | sa = dx22 * (y - y2); |
JackB | 5:dad648238df3 | 529 | sb = dx12 * (y - y1); |
JackB | 5:dad648238df3 | 530 | for (; y <= y3; y++) { |
JackB | 5:dad648238df3 | 531 | a = x2 + sa / dy22; |
JackB | 5:dad648238df3 | 532 | b = x1 + sb / dy12; |
JackB | 5:dad648238df3 | 533 | sa += dx22; |
JackB | 5:dad648238df3 | 534 | sb += dx12; |
JackB | 5:dad648238df3 | 535 | /* longhand: |
JackB | 5:dad648238df3 | 536 | a = x2 + (x3 - x2) * (y - y2) / (y3 - y2); |
JackB | 5:dad648238df3 | 537 | b = x1 + (x3 - x1) * (y - y1) / (y3 - y1); |
JackB | 5:dad648238df3 | 538 | */ |
JackB | 5:dad648238df3 | 539 | if (a > b) _swap(a, b); |
JackB | 5:dad648238df3 | 540 | line(a, y, b, y, color); |
JackB | 5:dad648238df3 | 541 | } |
JackB | 0:cc1fb45bc3ad | 542 | } |
JackB | 0:cc1fb45bc3ad | 543 | |
JackB | 8:a569bc50b552 | 544 | void TFT_22_ILI9225::roundrect(uint16_t x1, uint16_t y1, uint16_t x2, uint16_t y2, uint16_t rad, bool fill, uint16_t color) |
JackB | 8:a569bc50b552 | 545 | { |
JackB | 8:a569bc50b552 | 546 | signed int a, b, P; |
JackB | 8:a569bc50b552 | 547 | |
JackB | 8:a569bc50b552 | 548 | a = 0; // increment by 1 |
JackB | 8:a569bc50b552 | 549 | b = rad; // decrement by 1 using P |
JackB | 8:a569bc50b552 | 550 | P = 1 - rad; |
JackB | 8:a569bc50b552 | 551 | |
JackB | 8:a569bc50b552 | 552 | if (fill) |
JackB | 8:a569bc50b552 | 553 | { |
JackB | 8:a569bc50b552 | 554 | fillrect(x1, y1 + rad, x2, y2 - rad, color); |
JackB | 8:a569bc50b552 | 555 | |
JackB | 8:a569bc50b552 | 556 | do |
JackB | 8:a569bc50b552 | 557 | { |
JackB | 8:a569bc50b552 | 558 | fillrect(x1 - a + rad, y1 - b + rad, a + x2 - rad, y1 - b + rad, color); // 8 --> 1 |
JackB | 8:a569bc50b552 | 559 | fillrect(x1 - b + rad, y1 - a + rad, b + x2 - rad, y1 - a + rad, color); // 7 --> 2 |
JackB | 8:a569bc50b552 | 560 | fillrect(x1 - b + rad, a + y2 - rad, b + x2 - rad, a + y2 - rad, color); // 6 --> 3 |
JackB | 8:a569bc50b552 | 561 | fillrect(x1 - a + rad, b + y2 - rad, a + x2 - rad, b + y2 - rad, color); // 5 --> 4 |
JackB | 8:a569bc50b552 | 562 | |
JackB | 8:a569bc50b552 | 563 | if (P < 0) |
JackB | 8:a569bc50b552 | 564 | P += 3 + 2 * a++; |
JackB | 8:a569bc50b552 | 565 | else |
JackB | 8:a569bc50b552 | 566 | P += 5 + 2 * (a++ - b--); |
JackB | 8:a569bc50b552 | 567 | |
JackB | 8:a569bc50b552 | 568 | } while (a <= b); |
JackB | 8:a569bc50b552 | 569 | } |
JackB | 8:a569bc50b552 | 570 | else |
JackB | 8:a569bc50b552 | 571 | { |
JackB | 8:a569bc50b552 | 572 | hline(x1 + rad, x2 - rad, y1, color); // top |
JackB | 8:a569bc50b552 | 573 | hline(x1 + rad, x2 - rad, y2, color); // bottom |
JackB | 8:a569bc50b552 | 574 | vline(x1, y1 + rad, y2 - rad, color); // left |
JackB | 8:a569bc50b552 | 575 | vline(x2, y1 + rad, y2 - rad, color); // right |
JackB | 8:a569bc50b552 | 576 | |
JackB | 8:a569bc50b552 | 577 | do |
JackB | 8:a569bc50b552 | 578 | { |
JackB | 8:a569bc50b552 | 579 | pixel(a + x2 - rad, y1 - b + rad, color); // `````` Segment 1 |
JackB | 8:a569bc50b552 | 580 | pixel(b + x2 - rad, y1 - a + rad, color); // `````` Segment 2 |
JackB | 8:a569bc50b552 | 581 | |
JackB | 8:a569bc50b552 | 582 | pixel(b + x2 - rad, a + y2 - rad, color); // `````` Segment 3 |
JackB | 8:a569bc50b552 | 583 | pixel(a + x2 - rad, b + y2 - rad, color); // `````` Segment 4 |
JackB | 8:a569bc50b552 | 584 | |
JackB | 8:a569bc50b552 | 585 | pixel(x1 - a + rad, b + y2 - rad, color); // `````` Segment 5 |
JackB | 8:a569bc50b552 | 586 | pixel(x1 - b + rad, a + y2 - rad, color); // `````` Segment 6 |
JackB | 8:a569bc50b552 | 587 | |
JackB | 8:a569bc50b552 | 588 | pixel(x1 - b + rad, y1 - a + rad, color); // `````` Segment 7 |
JackB | 8:a569bc50b552 | 589 | pixel(x1 - a + rad, y1 - b + rad, color); // `````` Segment 8 |
JackB | 8:a569bc50b552 | 590 | |
JackB | 8:a569bc50b552 | 591 | if (P < 0) |
JackB | 8:a569bc50b552 | 592 | P += 3 + 2 * a++; |
JackB | 8:a569bc50b552 | 593 | else |
JackB | 8:a569bc50b552 | 594 | P += 5 + 2 * (a++ - b--); |
JackB | 8:a569bc50b552 | 595 | } while (a <= b); |
JackB | 8:a569bc50b552 | 596 | } |
JackB | 8:a569bc50b552 | 597 | } |
JackB | 8:a569bc50b552 | 598 | |
JackB | 0:cc1fb45bc3ad | 599 | uint16_t TFT_22_ILI9225::maxX(void) { |
JackB | 0:cc1fb45bc3ad | 600 | return _maxX - 1; |
JackB | 0:cc1fb45bc3ad | 601 | } |
JackB | 0:cc1fb45bc3ad | 602 | |
JackB | 0:cc1fb45bc3ad | 603 | uint16_t TFT_22_ILI9225::maxY(void) { |
JackB | 0:cc1fb45bc3ad | 604 | return _maxY - 1; |
JackB | 0:cc1fb45bc3ad | 605 | } |
JackB | 0:cc1fb45bc3ad | 606 | |
JackB | 0:cc1fb45bc3ad | 607 | uint16_t TFT_22_ILI9225::width(void) { |
JackB | 0:cc1fb45bc3ad | 608 | return _maxX; |
JackB | 0:cc1fb45bc3ad | 609 | } |
JackB | 0:cc1fb45bc3ad | 610 | |
JackB | 0:cc1fb45bc3ad | 611 | uint16_t TFT_22_ILI9225::height(void) { |
JackB | 0:cc1fb45bc3ad | 612 | return _maxY; |
JackB | 0:cc1fb45bc3ad | 613 | } |
JackB | 0:cc1fb45bc3ad | 614 | |
JackB | 0:cc1fb45bc3ad | 615 | uint16_t TFT_22_ILI9225::setColor(uint8_t red8, uint8_t green8, uint8_t blue8) { |
JackB | 0:cc1fb45bc3ad | 616 | // rgb16 = red5 green6 blue5 |
JackB | 0:cc1fb45bc3ad | 617 | return (red8 >> 3) << 11 | (green8 >> 2) << 5 | (blue8 >> 3); |
JackB | 0:cc1fb45bc3ad | 618 | } |
JackB | 0:cc1fb45bc3ad | 619 | |
JackB | 0:cc1fb45bc3ad | 620 | void TFT_22_ILI9225::splitColor(uint16_t rgb, uint8_t &red, uint8_t &green, uint8_t &blue) { |
JackB | 0:cc1fb45bc3ad | 621 | // rgb16 = red5 green6 blue5 |
JackB | 0:cc1fb45bc3ad | 622 | |
JackB | 0:cc1fb45bc3ad | 623 | red = (rgb & 0xF800) >> 11 << 3; |
JackB | 0:cc1fb45bc3ad | 624 | green = (rgb & 0x7E0) >> 5 << 2; |
JackB | 0:cc1fb45bc3ad | 625 | blue = (rgb & 0x1F) << 3; |
JackB | 0:cc1fb45bc3ad | 626 | } |
JackB | 0:cc1fb45bc3ad | 627 | |
JackB | 0:cc1fb45bc3ad | 628 | void TFT_22_ILI9225::_swap(uint16_t &a, uint16_t &b) { |
JackB | 0:cc1fb45bc3ad | 629 | uint16_t w = a; |
JackB | 0:cc1fb45bc3ad | 630 | a = b; |
JackB | 0:cc1fb45bc3ad | 631 | b = w; |
JackB | 0:cc1fb45bc3ad | 632 | } |
JackB | 0:cc1fb45bc3ad | 633 | |
JackB | 0:cc1fb45bc3ad | 634 | void TFT_22_ILI9225::_writeCommand(uint8_t HI, uint8_t LO) { |
JackB | 0:cc1fb45bc3ad | 635 | _rs = 0; |
JackB | 0:cc1fb45bc3ad | 636 | _cs = 0; |
JackB | 0:cc1fb45bc3ad | 637 | spi.write(HI); |
JackB | 0:cc1fb45bc3ad | 638 | spi.write(LO); |
JackB | 0:cc1fb45bc3ad | 639 | _cs = 1; |
JackB | 0:cc1fb45bc3ad | 640 | } |
JackB | 0:cc1fb45bc3ad | 641 | |
JackB | 0:cc1fb45bc3ad | 642 | void TFT_22_ILI9225::_writeData(uint16_t data) { |
JackB | 0:cc1fb45bc3ad | 643 | spi.write(data >> 8); |
JackB | 0:cc1fb45bc3ad | 644 | spi.write(data & 0xff); |
JackB | 0:cc1fb45bc3ad | 645 | // spi.write(data); |
JackB | 0:cc1fb45bc3ad | 646 | } |
JackB | 0:cc1fb45bc3ad | 647 | |
JackB | 0:cc1fb45bc3ad | 648 | void TFT_22_ILI9225::_startData(void) { |
JackB | 0:cc1fb45bc3ad | 649 | _rs = 1; |
JackB | 0:cc1fb45bc3ad | 650 | _cs = 0; |
JackB | 0:cc1fb45bc3ad | 651 | // spi.format(16, 0); // New mbed library can't use 16 bit spi anymore on this platform |
JackB | 0:cc1fb45bc3ad | 652 | } |
JackB | 0:cc1fb45bc3ad | 653 | |
JackB | 0:cc1fb45bc3ad | 654 | void TFT_22_ILI9225::_endData(void) { |
JackB | 0:cc1fb45bc3ad | 655 | _cs = 1; |
JackB | 0:cc1fb45bc3ad | 656 | // spi.format(8, 0); |
JackB | 0:cc1fb45bc3ad | 657 | } |
JackB | 0:cc1fb45bc3ad | 658 | |
JackB | 0:cc1fb45bc3ad | 659 | void TFT_22_ILI9225::_writeRegister(uint16_t reg, uint16_t data) { |
JackB | 0:cc1fb45bc3ad | 660 | _writeCommand(reg >> 8, reg & 0xff); |
JackB | 0:cc1fb45bc3ad | 661 | _startData(); |
JackB | 0:cc1fb45bc3ad | 662 | _writeData(data); |
JackB | 0:cc1fb45bc3ad | 663 | _endData(); |
JackB | 0:cc1fb45bc3ad | 664 | } |
JackB | 0:cc1fb45bc3ad | 665 | |
JackB | 0:cc1fb45bc3ad | 666 | void TFT_22_ILI9225::setFont(unsigned char* f) { |
JackB | 0:cc1fb45bc3ad | 667 | font = f; |
JackB | 0:cc1fb45bc3ad | 668 | } |
JackB | 0:cc1fb45bc3ad | 669 | |
JackB | 0:cc1fb45bc3ad | 670 | int TFT_22_ILI9225::putc(int value) |
JackB | 0:cc1fb45bc3ad | 671 | { |
JackB | 0:cc1fb45bc3ad | 672 | if (value == '\n') { // new line |
JackB | 0:cc1fb45bc3ad | 673 | char_x = 0; |
JackB | 0:cc1fb45bc3ad | 674 | char_y = char_y + (font[FONT_VERT] + char_line_spacing); |
JackB | 0:cc1fb45bc3ad | 675 | if (char_y >= height() - (font[FONT_VERT] + char_line_spacing)) { |
JackB | 0:cc1fb45bc3ad | 676 | char_y = 0; |
JackB | 0:cc1fb45bc3ad | 677 | } |
JackB | 0:cc1fb45bc3ad | 678 | return value; |
JackB | 0:cc1fb45bc3ad | 679 | } |
JackB | 0:cc1fb45bc3ad | 680 | if ((value < 32) || (value > 127)) { |
JackB | 0:cc1fb45bc3ad | 681 | return value; |
JackB | 0:cc1fb45bc3ad | 682 | } |
JackB | 0:cc1fb45bc3ad | 683 | character(char_x, char_y, value); |
JackB | 0:cc1fb45bc3ad | 684 | return value; |
JackB | 0:cc1fb45bc3ad | 685 | } |
JackB | 0:cc1fb45bc3ad | 686 | |
JackB | 0:cc1fb45bc3ad | 687 | void TFT_22_ILI9225::character(int x, int y, int c) |
JackB | 0:cc1fb45bc3ad | 688 | { |
JackB | 3:41e8d7dc279a | 689 | unsigned int hor, vert, offset, bpl, i, j, b; |
JackB | 0:cc1fb45bc3ad | 690 | unsigned char* zeichen; |
JackB | 0:cc1fb45bc3ad | 691 | unsigned char z,w; |
JackB | 0:cc1fb45bc3ad | 692 | |
JackB | 0:cc1fb45bc3ad | 693 | if ((c < 31) || (c > 127)) return; // test char range |
JackB | 0:cc1fb45bc3ad | 694 | |
JackB | 0:cc1fb45bc3ad | 695 | // read font parameter from start of array |
JackB | 0:cc1fb45bc3ad | 696 | offset = font[FONT_LENGTH]; // bytes / char |
JackB | 0:cc1fb45bc3ad | 697 | hor = font[FONT_HORZ]; // get hor size of font |
JackB | 0:cc1fb45bc3ad | 698 | vert = font[FONT_VERT]; // get vert size of font |
JackB | 0:cc1fb45bc3ad | 699 | bpl = font[FONT_BYTES_VERT]; // bytes per line |
JackB | 0:cc1fb45bc3ad | 700 | |
JackB | 0:cc1fb45bc3ad | 701 | if (char_x + hor > width()) { |
JackB | 0:cc1fb45bc3ad | 702 | char_x = 0; |
JackB | 0:cc1fb45bc3ad | 703 | char_y = char_y + vert + char_line_spacing; |
JackB | 0:cc1fb45bc3ad | 704 | if (char_y >= height() - (vert + char_line_spacing)) { |
JackB | 0:cc1fb45bc3ad | 705 | char_y = 0; |
JackB | 0:cc1fb45bc3ad | 706 | } |
JackB | 0:cc1fb45bc3ad | 707 | } |
JackB | 0:cc1fb45bc3ad | 708 | _setWindow(char_x, char_y, (char_x+hor)-1, (char_y+vert)-1); |
JackB | 0:cc1fb45bc3ad | 709 | |
JackB | 0:cc1fb45bc3ad | 710 | zeichen = &font[((c -32) * offset) + 4]; // start of char bitmap |
JackB | 0:cc1fb45bc3ad | 711 | w = zeichen[0]; // width of actual char |
JackB | 0:cc1fb45bc3ad | 712 | _startData(); |
JackB | 0:cc1fb45bc3ad | 713 | |
JackB | 4:44a66bd8c16c | 714 | // Portrait |
JackB | 4:44a66bd8c16c | 715 | for (j = 0; j < vert; j++) { // vert line |
JackB | 4:44a66bd8c16c | 716 | for (i = 0; i < hor; i++) { // horz line |
JackB | 4:44a66bd8c16c | 717 | z = zeichen[bpl * i + ((j & 0xF8) >> 3)+1]; |
JackB | 4:44a66bd8c16c | 718 | b = 1 << (j & 0x07); |
JackB | 4:44a66bd8c16c | 719 | if (( z & b ) == 0x00) { |
JackB | 4:44a66bd8c16c | 720 | spi.write(_background >> 8); |
JackB | 4:44a66bd8c16c | 721 | spi.write(_background & 0xff); |
JackB | 4:44a66bd8c16c | 722 | } else { |
JackB | 4:44a66bd8c16c | 723 | spi.write(_foreground >> 8); |
JackB | 4:44a66bd8c16c | 724 | spi.write(_foreground & 0xff); |
JackB | 0:cc1fb45bc3ad | 725 | } |
JackB | 4:44a66bd8c16c | 726 | } |
JackB | 4:44a66bd8c16c | 727 | } |
JackB | 0:cc1fb45bc3ad | 728 | |
JackB | 0:cc1fb45bc3ad | 729 | _endData(); |
JackB | 0:cc1fb45bc3ad | 730 | _setWindowMax(); |
JackB | 0:cc1fb45bc3ad | 731 | if ((w + 2) < hor) { // x offset to next char |
JackB | 0:cc1fb45bc3ad | 732 | char_x += w + 2; |
JackB | 0:cc1fb45bc3ad | 733 | } else char_x += hor; |
JackB | 0:cc1fb45bc3ad | 734 | } |
JackB | 0:cc1fb45bc3ad | 735 | |
JackB | 0:cc1fb45bc3ad | 736 | void TFT_22_ILI9225::foreground(uint16_t colour) { |
JackB | 0:cc1fb45bc3ad | 737 | _foreground = colour; |
JackB | 0:cc1fb45bc3ad | 738 | } |
JackB | 0:cc1fb45bc3ad | 739 | |
JackB | 0:cc1fb45bc3ad | 740 | void TFT_22_ILI9225::background(uint16_t colour) { |
JackB | 0:cc1fb45bc3ad | 741 | _background = colour; |
JackB | 0:cc1fb45bc3ad | 742 | } |
JackB | 0:cc1fb45bc3ad | 743 | |
JackB | 0:cc1fb45bc3ad | 744 | void TFT_22_ILI9225::locate(int x, int y) |
JackB | 0:cc1fb45bc3ad | 745 | { |
JackB | 0:cc1fb45bc3ad | 746 | char_x = x; |
JackB | 0:cc1fb45bc3ad | 747 | char_y = y; |
JackB | 0:cc1fb45bc3ad | 748 | } |
JackB | 0:cc1fb45bc3ad | 749 | |
JackB | 0:cc1fb45bc3ad | 750 | void TFT_22_ILI9225::gotoxy(int x, int y) |
JackB | 0:cc1fb45bc3ad | 751 | { |
JackB | 0:cc1fb45bc3ad | 752 | char_x = x * font[FONT_HORZ]; |
JackB | 0:cc1fb45bc3ad | 753 | char_y = y * (font[FONT_VERT] + char_line_spacing); |
JackB | 0:cc1fb45bc3ad | 754 | } |
JackB | 0:cc1fb45bc3ad | 755 | |
JackB | 0:cc1fb45bc3ad | 756 | void TFT_22_ILI9225::home(void) |
JackB | 0:cc1fb45bc3ad | 757 | { |
JackB | 0:cc1fb45bc3ad | 758 | gotoxy(0, 0); |
JackB | 0:cc1fb45bc3ad | 759 | } |
JackB | 0:cc1fb45bc3ad | 760 | |
JackB | 0:cc1fb45bc3ad | 761 | void TFT_22_ILI9225::linespacing(int line_spacing) |
JackB | 0:cc1fb45bc3ad | 762 | { |
JackB | 0:cc1fb45bc3ad | 763 | char_line_spacing = line_spacing; |
JackB | 0:cc1fb45bc3ad | 764 | } |
JackB | 0:cc1fb45bc3ad | 765 | |
JackB | 0:cc1fb45bc3ad | 766 | int TFT_22_ILI9225::columns() |
JackB | 0:cc1fb45bc3ad | 767 | { |
JackB | 0:cc1fb45bc3ad | 768 | return width() / font[FONT_HORZ]; |
JackB | 0:cc1fb45bc3ad | 769 | } |
JackB | 0:cc1fb45bc3ad | 770 | |
JackB | 0:cc1fb45bc3ad | 771 | int TFT_22_ILI9225::rows() |
JackB | 0:cc1fb45bc3ad | 772 | { |
JackB | 0:cc1fb45bc3ad | 773 | return height() / font[FONT_VERT]; |
JackB | 0:cc1fb45bc3ad | 774 | } |
JackB | 0:cc1fb45bc3ad | 775 | |
JackB | 0:cc1fb45bc3ad | 776 | //---------------------------------------------------------------------------------------------------- |
JackB | 0:cc1fb45bc3ad | 777 | //************************************* ECA 2.8 inch LCD Module ************************************** |
JackB | 0:cc1fb45bc3ad | 778 | //---------------------------------------------------------------------------------------------------- |
JackB | 0:cc1fb45bc3ad | 779 | // Make an ascii string from an unicode string |
JackB | 0:cc1fb45bc3ad | 780 | //---------------------------------------------------------------------------------------------------- |
JackB | 0:cc1fb45bc3ad | 781 | |
JackB | 0:cc1fb45bc3ad | 782 | void TFT_22_ILI9225::unicode2ascii(char *uni_str, char *ascii_str) |
JackB | 0:cc1fb45bc3ad | 783 | { |
JackB | 0:cc1fb45bc3ad | 784 | int counter = 0; |
JackB | 0:cc1fb45bc3ad | 785 | int Uch = 0; |
JackB | 0:cc1fb45bc3ad | 786 | char chl, chh; |
JackB | 0:cc1fb45bc3ad | 787 | |
JackB | 0:cc1fb45bc3ad | 788 | |
JackB | 0:cc1fb45bc3ad | 789 | while (*uni_str) |
JackB | 0:cc1fb45bc3ad | 790 | { |
JackB | 0:cc1fb45bc3ad | 791 | chl = *uni_str++; |
JackB | 0:cc1fb45bc3ad | 792 | chh = *uni_str++; |
JackB | 0:cc1fb45bc3ad | 793 | |
JackB | 0:cc1fb45bc3ad | 794 | Uch = 0; |
JackB | 0:cc1fb45bc3ad | 795 | Uch = ((Uch | chh) << 8) | chl; |
JackB | 0:cc1fb45bc3ad | 796 | |
JackB | 0:cc1fb45bc3ad | 797 | if (Uch > 1574 && Uch < 1591) |
JackB | 0:cc1fb45bc3ad | 798 | *(ascii_str + counter) = (char)(Uch - 1376); |
JackB | 0:cc1fb45bc3ad | 799 | else if (Uch > 1590 && Uch < 1595) |
JackB | 0:cc1fb45bc3ad | 800 | *(ascii_str + counter) = (char)(Uch - 1375); |
JackB | 0:cc1fb45bc3ad | 801 | else if (Uch > 1600 && Uch < 1603) |
JackB | 0:cc1fb45bc3ad | 802 | *(ascii_str + counter) = (char)(Uch - 1380); |
JackB | 0:cc1fb45bc3ad | 803 | else if (Uch == 1705) |
JackB | 0:cc1fb45bc3ad | 804 | *(ascii_str + counter) = (char)(Uch - 1482); |
JackB | 0:cc1fb45bc3ad | 805 | else if (Uch == 1604) |
JackB | 0:cc1fb45bc3ad | 806 | *(ascii_str + counter) = (char)(Uch - 1379); |
JackB | 0:cc1fb45bc3ad | 807 | else if (Uch > 1604 && Uch < 1609) |
JackB | 0:cc1fb45bc3ad | 808 | *(ascii_str + counter) = (char)(Uch - 1378); |
JackB | 0:cc1fb45bc3ad | 809 | else if (Uch == 1740) |
JackB | 0:cc1fb45bc3ad | 810 | *(ascii_str + counter) = (char)(Uch - 1503); |
JackB | 0:cc1fb45bc3ad | 811 | else if (Uch == 1574) |
JackB | 0:cc1fb45bc3ad | 812 | *(ascii_str + counter) = (char)(Uch - 1381); |
JackB | 0:cc1fb45bc3ad | 813 | else if (Uch == 1662) |
JackB | 0:cc1fb45bc3ad | 814 | *(ascii_str + counter) = (char)(Uch - 1533); |
JackB | 0:cc1fb45bc3ad | 815 | else if (Uch == 1670) |
JackB | 0:cc1fb45bc3ad | 816 | *(ascii_str + counter) = (char)(Uch - 1529); |
JackB | 0:cc1fb45bc3ad | 817 | else if (Uch == 1688) |
JackB | 0:cc1fb45bc3ad | 818 | *(ascii_str + counter) = (char)(Uch - 1546); |
JackB | 0:cc1fb45bc3ad | 819 | else if (Uch == 1711) |
JackB | 0:cc1fb45bc3ad | 820 | *(ascii_str + counter) = (char)(Uch - 1567); |
JackB | 0:cc1fb45bc3ad | 821 | else if (Uch == 1570) |
JackB | 0:cc1fb45bc3ad | 822 | *(ascii_str + counter) = (char)(Uch - 1376); |
JackB | 0:cc1fb45bc3ad | 823 | else if (Uch > 1631 && Uch < 1642) |
JackB | 0:cc1fb45bc3ad | 824 | *(ascii_str + counter) = (char)(Uch - 1584); |
JackB | 0:cc1fb45bc3ad | 825 | else if (Uch == 65536) |
JackB | 0:cc1fb45bc3ad | 826 | *(ascii_str + counter) = NULL; |
JackB | 0:cc1fb45bc3ad | 827 | else |
JackB | 0:cc1fb45bc3ad | 828 | *(ascii_str + counter) = (char)Uch; |
JackB | 0:cc1fb45bc3ad | 829 | |
JackB | 0:cc1fb45bc3ad | 830 | |
JackB | 0:cc1fb45bc3ad | 831 | counter++; |
JackB | 0:cc1fb45bc3ad | 832 | |
JackB | 0:cc1fb45bc3ad | 833 | } |
JackB | 0:cc1fb45bc3ad | 834 | *(ascii_str + counter) = NULL; |
JackB | 0:cc1fb45bc3ad | 835 | |
JackB | 0:cc1fb45bc3ad | 836 | } |
JackB | 0:cc1fb45bc3ad | 837 |