Kevin Braun / Mbed 2 deprecated AnalogMeter-100

- ANALOG METER, initial offering - Emulation of an analog/mechanical meter using the SPI TFT display \"http://mbed.org/cookbook/SPI-driven-QVGA-TFT\" (touch not used) Meter takes an integer number from 0 - 100 and uses that number to position the meter\'s needle - An additional auto-scaling feature allows for + floating numbers from 0.0 - 10000.0 in \"NewfNumb\" Scaling is noted two ways a. Color of the meter body changes b. A text scale factor is displayed in the upper, right-hand corner, near the full scale reading Value of \"NewfNumb\" Meter_Body Scale_Factor < -0.0 Blue 0 0.1 - 9.9 Green x1 10.0 - 99.0 Yellow x10 100.0 - 999.0 Orange x100 1000.0 - 9990.0 Red x1k >= 10000.0 Red peg! - If NewfNumb is > 600.0, a flashing yellow warning message appears in the center of the meter movement - The date and time are displayed in the lower right corner of the display - The value of NewfNumb being shown in the movement is also displayed in the lower left coener of the display - A timer ISR automatically updates the meter\'s movement Other Stuff: - Additional demo test program, walks analog meter up and down through all auto scales by manipulating the value of NewfNumb - USB serial port used to dump a few messages. Not needed, set to 921600 BAUD - LED1 slowly gets brighter and dimmer as main loop runs - If for some reason, the \"MeterNumber\" int register ends up >100 or <0, a Purple display appears at 50% movement with a \"bad#\" scale factor - There is NO provision for setting the RTC. Note that TimeZone and DST are added to the RTC number

Dependencies:   mbed

SPI_TFT/SPI_TFT.cpp@0:fc70640071d2, 2012-01-31 (annotated)

Committer:
loopsva
Date:
Tue Jan 31 19:40:57 2012 +0000
Revision:
0:fc70640071d2
100

Who changed what in which revision?

UserRevisionLine numberNew contents of line
loopsva 0:fc70640071d2 1 /* mbed library for 240*320 pixel display TFT based on HX8347D LCD Controller
loopsva 0:fc70640071d2 2 * Copyright (c) 2011 Peter Drescher - DC2PD
loopsva 0:fc70640071d2 3 *
loopsva 0:fc70640071d2 4 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
loopsva 0:fc70640071d2 5 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
loopsva 0:fc70640071d2 6 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
loopsva 0:fc70640071d2 7 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
loopsva 0:fc70640071d2 8 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
loopsva 0:fc70640071d2 9 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
loopsva 0:fc70640071d2 10 * THE SOFTWARE.
loopsva 0:fc70640071d2 11 */
loopsva 0:fc70640071d2 12
loopsva 0:fc70640071d2 13
loopsva 0:fc70640071d2 14 // fix bmp padding for Bitmap function
loopsva 0:fc70640071d2 15 // speed up pixel
loopsva 0:fc70640071d2 16 // 30.12.11 fix cls
loopsva 0:fc70640071d2 17
loopsva 0:fc70640071d2 18
loopsva 0:fc70640071d2 19 #include "SPI_TFT.h"
loopsva 0:fc70640071d2 20 #include "mbed.h"
loopsva 0:fc70640071d2 21
loopsva 0:fc70640071d2 22
loopsva 0:fc70640071d2 23 #define BPP 16 // Bits per pixel
loopsva 0:fc70640071d2 24
loopsva 0:fc70640071d2 25 //DigitalOut led(LED1);
loopsva 0:fc70640071d2 26
loopsva 0:fc70640071d2 27 SPI_TFT::SPI_TFT(PinName mosi, PinName miso, PinName sclk, PinName cs, PinName reset, const char *name)
loopsva 0:fc70640071d2 28 : _spi(mosi, miso, sclk), _cs(cs), _reset(reset),GraphicsDisplay(name) {
loopsva 0:fc70640071d2 29 tft_reset();
loopsva 0:fc70640071d2 30 orientation = 0;
loopsva 0:fc70640071d2 31 char_x = 0;
loopsva 0:fc70640071d2 32 }
loopsva 0:fc70640071d2 33
loopsva 0:fc70640071d2 34 int SPI_TFT::width() {
loopsva 0:fc70640071d2 35 if (orientation == 0 || orientation == 2) return 240;
loopsva 0:fc70640071d2 36 else return 320;
loopsva 0:fc70640071d2 37 }
loopsva 0:fc70640071d2 38
loopsva 0:fc70640071d2 39
loopsva 0:fc70640071d2 40 int SPI_TFT::height() {
loopsva 0:fc70640071d2 41 if (orientation == 0 || orientation == 2) return 320;
loopsva 0:fc70640071d2 42 else return 240;
loopsva 0:fc70640071d2 43 }
loopsva 0:fc70640071d2 44
loopsva 0:fc70640071d2 45
loopsva 0:fc70640071d2 46
loopsva 0:fc70640071d2 47 void SPI_TFT::set_orientation(unsigned int o) {
loopsva 0:fc70640071d2 48 orientation = o;
loopsva 0:fc70640071d2 49 switch (orientation) {
loopsva 0:fc70640071d2 50 case 0:
loopsva 0:fc70640071d2 51 wr_reg(0x16, 0x0008);
loopsva 0:fc70640071d2 52 break;
loopsva 0:fc70640071d2 53 case 1:
loopsva 0:fc70640071d2 54 wr_reg(0x16, 0x0068);
loopsva 0:fc70640071d2 55 break;
loopsva 0:fc70640071d2 56 case 2:
loopsva 0:fc70640071d2 57 wr_reg(0x16, 0x00C8);
loopsva 0:fc70640071d2 58 break;
loopsva 0:fc70640071d2 59 case 3:
loopsva 0:fc70640071d2 60 wr_reg(0x16, 0x00A8);
loopsva 0:fc70640071d2 61 break;
loopsva 0:fc70640071d2 62 }
loopsva 0:fc70640071d2 63 WindowMax();
loopsva 0:fc70640071d2 64 }
loopsva 0:fc70640071d2 65
loopsva 0:fc70640071d2 66
loopsva 0:fc70640071d2 67
loopsva 0:fc70640071d2 68 void SPI_TFT::wr_cmd(int cmd) {
loopsva 0:fc70640071d2 69 _cs = 0;
loopsva 0:fc70640071d2 70 _spi.write(SPI_START | SPI_WR | SPI_INDEX); /* Write : RS = 0, RW = 0 */
loopsva 0:fc70640071d2 71 _spi.write(cmd);
loopsva 0:fc70640071d2 72 _cs = 1;
loopsva 0:fc70640071d2 73 }
loopsva 0:fc70640071d2 74
loopsva 0:fc70640071d2 75
loopsva 0:fc70640071d2 76
loopsva 0:fc70640071d2 77 void SPI_TFT::wr_dat(int dat) {
loopsva 0:fc70640071d2 78 _cs = 0;
loopsva 0:fc70640071d2 79 _spi.write(SPI_START | SPI_WR | SPI_DATA); // Write : RS = 1, RW = 0
loopsva 0:fc70640071d2 80 _spi.format(16,3); // switch to 16 bit Mode 3
loopsva 0:fc70640071d2 81 _spi.write(dat); // Write D0..D15
loopsva 0:fc70640071d2 82 _spi.format(8,3); // 8 bit Mode 3
loopsva 0:fc70640071d2 83 _cs = 1;
loopsva 0:fc70640071d2 84 }
loopsva 0:fc70640071d2 85
loopsva 0:fc70640071d2 86
loopsva 0:fc70640071d2 87
loopsva 0:fc70640071d2 88 void SPI_TFT::wr_dat_start(void) {
loopsva 0:fc70640071d2 89 _cs = 0;
loopsva 0:fc70640071d2 90 _spi.write(SPI_START | SPI_WR | SPI_DATA); /* Write : RS = 1, RW = 0 */
loopsva 0:fc70640071d2 91 }
loopsva 0:fc70640071d2 92
loopsva 0:fc70640071d2 93
loopsva 0:fc70640071d2 94
loopsva 0:fc70640071d2 95 void SPI_TFT::wr_dat_stop (void) {
loopsva 0:fc70640071d2 96 _cs = 1;
loopsva 0:fc70640071d2 97 }
loopsva 0:fc70640071d2 98
loopsva 0:fc70640071d2 99
loopsva 0:fc70640071d2 100
loopsva 0:fc70640071d2 101 void SPI_TFT::wr_dat_only (unsigned short dat) {
loopsva 0:fc70640071d2 102
loopsva 0:fc70640071d2 103 _spi.format(16,3); // switch to 16 bit Mode 3
loopsva 0:fc70640071d2 104 _spi.write(dat); // Write D0..D15
loopsva 0:fc70640071d2 105 _spi.format(8,3); // 8 bit Mode 3
loopsva 0:fc70640071d2 106 }
loopsva 0:fc70640071d2 107
loopsva 0:fc70640071d2 108
loopsva 0:fc70640071d2 109
loopsva 0:fc70640071d2 110 unsigned short SPI_TFT::rd_dat (void) {
loopsva 0:fc70640071d2 111 unsigned short val = 0;
loopsva 0:fc70640071d2 112
loopsva 0:fc70640071d2 113 _cs = 0;
loopsva 0:fc70640071d2 114 _spi.write(SPI_START | SPI_RD | SPI_DATA); /* Read: RS = 1, RW = 1 */
loopsva 0:fc70640071d2 115 _spi.write(0); /* Dummy read 1 */
loopsva 0:fc70640071d2 116 val = _spi.write(0); /* Read D8..D15 */
loopsva 0:fc70640071d2 117 val <<= 8;
loopsva 0:fc70640071d2 118 val |= _spi.write(0); /* Read D0..D7 */
loopsva 0:fc70640071d2 119 _cs = 1;
loopsva 0:fc70640071d2 120 return (val);
loopsva 0:fc70640071d2 121 }
loopsva 0:fc70640071d2 122
loopsva 0:fc70640071d2 123
loopsva 0:fc70640071d2 124
loopsva 0:fc70640071d2 125 void SPI_TFT::wr_reg (unsigned char reg, unsigned short val) {
loopsva 0:fc70640071d2 126
loopsva 0:fc70640071d2 127 wr_cmd(reg);
loopsva 0:fc70640071d2 128 wr_dat(val);
loopsva 0:fc70640071d2 129 }
loopsva 0:fc70640071d2 130
loopsva 0:fc70640071d2 131
loopsva 0:fc70640071d2 132
loopsva 0:fc70640071d2 133 unsigned short SPI_TFT::rd_reg (unsigned char reg) {
loopsva 0:fc70640071d2 134
loopsva 0:fc70640071d2 135 wr_cmd(reg);
loopsva 0:fc70640071d2 136 return(rd_dat());
loopsva 0:fc70640071d2 137 }
loopsva 0:fc70640071d2 138
loopsva 0:fc70640071d2 139
loopsva 0:fc70640071d2 140
loopsva 0:fc70640071d2 141 void SPI_TFT::tft_reset() {
loopsva 0:fc70640071d2 142 static unsigned short driverCode;
loopsva 0:fc70640071d2 143 _spi.format(8,3); // 8 bit spi mode 3
loopsva 0:fc70640071d2 144 _spi.frequency(48000000); // 48Mhz SPI clock
loopsva 0:fc70640071d2 145 _reset = 0; // reset
loopsva 0:fc70640071d2 146 _cs = 1;
loopsva 0:fc70640071d2 147 wait_us(50);
loopsva 0:fc70640071d2 148 _reset = 1; // end reset
loopsva 0:fc70640071d2 149 wait_ms(5);
loopsva 0:fc70640071d2 150
loopsva 0:fc70640071d2 151 driverCode = rd_reg(0x00); // read controller ID
loopsva 0:fc70640071d2 152 //printf("Disp_ID = %x",driverCode);
loopsva 0:fc70640071d2 153
loopsva 0:fc70640071d2 154 /* Start Initial Sequence ----------------------------------------------------*/
loopsva 0:fc70640071d2 155 wr_reg(0xEA, 0x0000); /* Reset Power Control 1 */
loopsva 0:fc70640071d2 156 wr_reg(0xEB, 0x0020); /* Power Control 2 */
loopsva 0:fc70640071d2 157 wr_reg(0xEC, 0x000C); /* Power Control 3 */
loopsva 0:fc70640071d2 158 wr_reg(0xED, 0x00C4); /* Power Control 4 */
loopsva 0:fc70640071d2 159 wr_reg(0xE8, 0x0040); /* Source OPON_N */
loopsva 0:fc70640071d2 160 wr_reg(0xE9, 0x0038); /* Source OPON_I */
loopsva 0:fc70640071d2 161 wr_reg(0xF1, 0x0001); /* */
loopsva 0:fc70640071d2 162 wr_reg(0xF2, 0x0010); /* */
loopsva 0:fc70640071d2 163 wr_reg(0x27, 0x00A3); /* Display Control 2 */
loopsva 0:fc70640071d2 164
loopsva 0:fc70640071d2 165 /* Power On sequence ---------------------------------------------------------*/
loopsva 0:fc70640071d2 166 wr_reg(0x1B, 0x001B); /* Power Control 2 */
loopsva 0:fc70640071d2 167 wr_reg(0x1A, 0x0001); /* Power Control 1 */
loopsva 0:fc70640071d2 168 wr_reg(0x24, 0x002F); /* Vcom Control 2 */
loopsva 0:fc70640071d2 169 wr_reg(0x25, 0x0057); /* Vcom Control 3 */
loopsva 0:fc70640071d2 170 wr_reg(0x23, 0x008D); /* Vcom Control 1 */
loopsva 0:fc70640071d2 171
loopsva 0:fc70640071d2 172 /* Gamma settings -----------------------------------------------------------*/
loopsva 0:fc70640071d2 173 wr_reg(0x40,0x00); //
loopsva 0:fc70640071d2 174 wr_reg(0x41,0x00); //
loopsva 0:fc70640071d2 175 wr_reg(0x42,0x01); //
loopsva 0:fc70640071d2 176 wr_reg(0x43,0x13); //
loopsva 0:fc70640071d2 177 wr_reg(0x44,0x10); //
loopsva 0:fc70640071d2 178 wr_reg(0x45,0x26); //
loopsva 0:fc70640071d2 179 wr_reg(0x46,0x08); //
loopsva 0:fc70640071d2 180 wr_reg(0x47,0x51); //
loopsva 0:fc70640071d2 181 wr_reg(0x48,0x02); //
loopsva 0:fc70640071d2 182 wr_reg(0x49,0x12); //
loopsva 0:fc70640071d2 183 wr_reg(0x4A,0x18); //
loopsva 0:fc70640071d2 184 wr_reg(0x4B,0x19); //
loopsva 0:fc70640071d2 185 wr_reg(0x4C,0x14); //
loopsva 0:fc70640071d2 186 wr_reg(0x50,0x19); //
loopsva 0:fc70640071d2 187 wr_reg(0x51,0x2F); //
loopsva 0:fc70640071d2 188 wr_reg(0x52,0x2C); //
loopsva 0:fc70640071d2 189 wr_reg(0x53,0x3E); //
loopsva 0:fc70640071d2 190 wr_reg(0x54,0x3F); //
loopsva 0:fc70640071d2 191 wr_reg(0x55,0x3F); //
loopsva 0:fc70640071d2 192 wr_reg(0x56,0x2E); //
loopsva 0:fc70640071d2 193 wr_reg(0x57,0x77); //
loopsva 0:fc70640071d2 194 wr_reg(0x58,0x0B); //
loopsva 0:fc70640071d2 195 wr_reg(0x59,0x06); //
loopsva 0:fc70640071d2 196 wr_reg(0x5A,0x07); //
loopsva 0:fc70640071d2 197 wr_reg(0x5B,0x0D); //
loopsva 0:fc70640071d2 198 wr_reg(0x5C,0x1D); //
loopsva 0:fc70640071d2 199 wr_reg(0x5D,0xCC); //
loopsva 0:fc70640071d2 200
loopsva 0:fc70640071d2 201 /* Power + Osc ---------------------------------------------------------------*/
loopsva 0:fc70640071d2 202 wr_reg(0x18, 0x0036); /* OSC Control 1 */
loopsva 0:fc70640071d2 203 wr_reg(0x19, 0x0001); /* OSC Control 2 */
loopsva 0:fc70640071d2 204 wr_reg(0x01, 0x0000); /* Display Mode Control */
loopsva 0:fc70640071d2 205 wr_reg(0x1F, 0x0088); /* Power Control 6 */
loopsva 0:fc70640071d2 206 wait_ms(5); /* Delay 5 ms */
loopsva 0:fc70640071d2 207 wr_reg(0x1F, 0x0080); /* Power Control 6 */
loopsva 0:fc70640071d2 208 wait_ms(5); /* Delay 5 ms */
loopsva 0:fc70640071d2 209 wr_reg(0x1F, 0x0090); /* Power Control 6 */
loopsva 0:fc70640071d2 210 wait_ms(5); /* Delay 5 ms */
loopsva 0:fc70640071d2 211 wr_reg(0x1F, 0x00D0); /* Power Control 6 */
loopsva 0:fc70640071d2 212 wait_ms(5); /* Delay 5 ms */
loopsva 0:fc70640071d2 213
loopsva 0:fc70640071d2 214 wr_reg(0x17, 0x0005); /* Colmod 16Bit/Pixel */
loopsva 0:fc70640071d2 215
loopsva 0:fc70640071d2 216 wr_reg(0x36, 0x0000); /* Panel Characteristic */
loopsva 0:fc70640071d2 217 wr_reg(0x28, 0x0038); /* Display Control 3 */
loopsva 0:fc70640071d2 218 wait_ms(40);
loopsva 0:fc70640071d2 219 wr_reg(0x28, 0x003C); /* Display Control 3 */
loopsva 0:fc70640071d2 220 switch (orientation) {
loopsva 0:fc70640071d2 221 case 0:
loopsva 0:fc70640071d2 222 wr_reg(0x16, 0x0008);
loopsva 0:fc70640071d2 223 break;
loopsva 0:fc70640071d2 224 case 1:
loopsva 0:fc70640071d2 225 wr_reg(0x16, 0x0068);
loopsva 0:fc70640071d2 226 break;
loopsva 0:fc70640071d2 227 case 2:
loopsva 0:fc70640071d2 228 wr_reg(0x16, 0x00C8);
loopsva 0:fc70640071d2 229 break;
loopsva 0:fc70640071d2 230 case 3:
loopsva 0:fc70640071d2 231 wr_reg(0x16, 0x00A8);
loopsva 0:fc70640071d2 232 break;
loopsva 0:fc70640071d2 233 }
loopsva 0:fc70640071d2 234
loopsva 0:fc70640071d2 235 WindowMax ();
loopsva 0:fc70640071d2 236 }
loopsva 0:fc70640071d2 237
loopsva 0:fc70640071d2 238
loopsva 0:fc70640071d2 239
loopsva 0:fc70640071d2 240
loopsva 0:fc70640071d2 241 void SPI_TFT::pixel(int x, int y, int color) {
loopsva 0:fc70640071d2 242 wr_reg(0x03, (x >> 0));
loopsva 0:fc70640071d2 243 wr_reg(0x02, (x >> 8));
loopsva 0:fc70640071d2 244 wr_reg(0x07, (y >> 0));
loopsva 0:fc70640071d2 245 wr_reg(0x06, (y >> 8));
loopsva 0:fc70640071d2 246 //wr_reg(0x05, (x+1 >> 0));
loopsva 0:fc70640071d2 247 //wr_reg(0x04, (x+1 >> 8));
loopsva 0:fc70640071d2 248 //wr_reg(0x09, (y+1 >> 0));
loopsva 0:fc70640071d2 249 //wr_reg(0x08, (y+1 >> 8));
loopsva 0:fc70640071d2 250 wr_cmd(0x22);
loopsva 0:fc70640071d2 251 wr_dat(color);
loopsva 0:fc70640071d2 252 }
loopsva 0:fc70640071d2 253
loopsva 0:fc70640071d2 254
loopsva 0:fc70640071d2 255
loopsva 0:fc70640071d2 256
loopsva 0:fc70640071d2 257 void SPI_TFT::window (unsigned int x, unsigned int y, unsigned int w, unsigned int h) {
loopsva 0:fc70640071d2 258 wr_reg(0x03, (x >> 0));
loopsva 0:fc70640071d2 259 wr_reg(0x02, (x >> 8));
loopsva 0:fc70640071d2 260 wr_reg(0x05, (x+w-1 >> 0));
loopsva 0:fc70640071d2 261 wr_reg(0x04, (x+w-1 >> 8));
loopsva 0:fc70640071d2 262 wr_reg(0x07, ( y >> 0));
loopsva 0:fc70640071d2 263 wr_reg(0x06, ( y >> 8));
loopsva 0:fc70640071d2 264 wr_reg(0x09, ( y+h-1 >> 0));
loopsva 0:fc70640071d2 265 wr_reg(0x08, ( y+h-1 >> 8));
loopsva 0:fc70640071d2 266 //wr_cmd(0x22);
loopsva 0:fc70640071d2 267 }
loopsva 0:fc70640071d2 268
loopsva 0:fc70640071d2 269
loopsva 0:fc70640071d2 270 void SPI_TFT::WindowMax (void) {
loopsva 0:fc70640071d2 271 window (0, 0, width(), height());
loopsva 0:fc70640071d2 272 }
loopsva 0:fc70640071d2 273
loopsva 0:fc70640071d2 274
loopsva 0:fc70640071d2 275 void SPI_TFT::cls (void) {
loopsva 0:fc70640071d2 276 unsigned int i;
loopsva 0:fc70640071d2 277 WindowMax();
loopsva 0:fc70640071d2 278 wr_cmd(0x22);
loopsva 0:fc70640071d2 279 wr_dat_start();
loopsva 0:fc70640071d2 280 _spi.format(16,3); // 16 bit Mode 3
loopsva 0:fc70640071d2 281 for (i = 0; i < ( width() * height()); i++)
loopsva 0:fc70640071d2 282 _spi.write(_background);
loopsva 0:fc70640071d2 283 _spi.format(8,3); // 8 bit Mode 3
loopsva 0:fc70640071d2 284 wr_dat_stop();
loopsva 0:fc70640071d2 285 }
loopsva 0:fc70640071d2 286
loopsva 0:fc70640071d2 287
loopsva 0:fc70640071d2 288 void SPI_TFT::circle(int x0, int y0, int r, int color) {
loopsva 0:fc70640071d2 289
loopsva 0:fc70640071d2 290 int draw_x0, draw_y0;
loopsva 0:fc70640071d2 291 int draw_x1, draw_y1;
loopsva 0:fc70640071d2 292 int draw_x2, draw_y2;
loopsva 0:fc70640071d2 293 int draw_x3, draw_y3;
loopsva 0:fc70640071d2 294 int draw_x4, draw_y4;
loopsva 0:fc70640071d2 295 int draw_x5, draw_y5;
loopsva 0:fc70640071d2 296 int draw_x6, draw_y6;
loopsva 0:fc70640071d2 297 int draw_x7, draw_y7;
loopsva 0:fc70640071d2 298 int xx, yy;
loopsva 0:fc70640071d2 299 int di;
loopsva 0:fc70640071d2 300 //WindowMax();
loopsva 0:fc70640071d2 301 if (r == 0) { /* no radius */
loopsva 0:fc70640071d2 302 return;
loopsva 0:fc70640071d2 303 }
loopsva 0:fc70640071d2 304
loopsva 0:fc70640071d2 305 draw_x0 = draw_x1 = x0;
loopsva 0:fc70640071d2 306 draw_y0 = draw_y1 = y0 + r;
loopsva 0:fc70640071d2 307 if (draw_y0 < height()) {
loopsva 0:fc70640071d2 308 pixel(draw_x0, draw_y0, color); /* 90 degree */
loopsva 0:fc70640071d2 309 }
loopsva 0:fc70640071d2 310
loopsva 0:fc70640071d2 311 draw_x2 = draw_x3 = x0;
loopsva 0:fc70640071d2 312 draw_y2 = draw_y3 = y0 - r;
loopsva 0:fc70640071d2 313 if (draw_y2 >= 0) {
loopsva 0:fc70640071d2 314 pixel(draw_x2, draw_y2, color); /* 270 degree */
loopsva 0:fc70640071d2 315 }
loopsva 0:fc70640071d2 316
loopsva 0:fc70640071d2 317 draw_x4 = draw_x6 = x0 + r;
loopsva 0:fc70640071d2 318 draw_y4 = draw_y6 = y0;
loopsva 0:fc70640071d2 319 if (draw_x4 < width()) {
loopsva 0:fc70640071d2 320 pixel(draw_x4, draw_y4, color); /* 0 degree */
loopsva 0:fc70640071d2 321 }
loopsva 0:fc70640071d2 322
loopsva 0:fc70640071d2 323 draw_x5 = draw_x7 = x0 - r;
loopsva 0:fc70640071d2 324 draw_y5 = draw_y7 = y0;
loopsva 0:fc70640071d2 325 if (draw_x5>=0) {
loopsva 0:fc70640071d2 326 pixel(draw_x5, draw_y5, color); /* 180 degree */
loopsva 0:fc70640071d2 327 }
loopsva 0:fc70640071d2 328
loopsva 0:fc70640071d2 329 if (r == 1) {
loopsva 0:fc70640071d2 330 return;
loopsva 0:fc70640071d2 331 }
loopsva 0:fc70640071d2 332
loopsva 0:fc70640071d2 333 di = 3 - 2*r;
loopsva 0:fc70640071d2 334 xx = 0;
loopsva 0:fc70640071d2 335 yy = r;
loopsva 0:fc70640071d2 336 while (xx < yy) {
loopsva 0:fc70640071d2 337
loopsva 0:fc70640071d2 338 if (di < 0) {
loopsva 0:fc70640071d2 339 di += 4*xx + 6;
loopsva 0:fc70640071d2 340 } else {
loopsva 0:fc70640071d2 341 di += 4*(xx - yy) + 10;
loopsva 0:fc70640071d2 342 yy--;
loopsva 0:fc70640071d2 343 draw_y0--;
loopsva 0:fc70640071d2 344 draw_y1--;
loopsva 0:fc70640071d2 345 draw_y2++;
loopsva 0:fc70640071d2 346 draw_y3++;
loopsva 0:fc70640071d2 347 draw_x4--;
loopsva 0:fc70640071d2 348 draw_x5++;
loopsva 0:fc70640071d2 349 draw_x6--;
loopsva 0:fc70640071d2 350 draw_x7++;
loopsva 0:fc70640071d2 351 }
loopsva 0:fc70640071d2 352 xx++;
loopsva 0:fc70640071d2 353 draw_x0++;
loopsva 0:fc70640071d2 354 draw_x1--;
loopsva 0:fc70640071d2 355 draw_x2++;
loopsva 0:fc70640071d2 356 draw_x3--;
loopsva 0:fc70640071d2 357 draw_y4++;
loopsva 0:fc70640071d2 358 draw_y5++;
loopsva 0:fc70640071d2 359 draw_y6--;
loopsva 0:fc70640071d2 360 draw_y7--;
loopsva 0:fc70640071d2 361
loopsva 0:fc70640071d2 362 if ( (draw_x0 <= width()) && (draw_y0>=0) ) {
loopsva 0:fc70640071d2 363 pixel(draw_x0, draw_y0, color);
loopsva 0:fc70640071d2 364 }
loopsva 0:fc70640071d2 365
loopsva 0:fc70640071d2 366 if ( (draw_x1 >= 0) && (draw_y1 >= 0) ) {
loopsva 0:fc70640071d2 367 pixel(draw_x1, draw_y1, color);
loopsva 0:fc70640071d2 368 }
loopsva 0:fc70640071d2 369
loopsva 0:fc70640071d2 370 if ( (draw_x2 <= width()) && (draw_y2 <= height()) ) {
loopsva 0:fc70640071d2 371 pixel(draw_x2, draw_y2, color);
loopsva 0:fc70640071d2 372 }
loopsva 0:fc70640071d2 373
loopsva 0:fc70640071d2 374 if ( (draw_x3 >=0 ) && (draw_y3 <= height()) ) {
loopsva 0:fc70640071d2 375 pixel(draw_x3, draw_y3, color);
loopsva 0:fc70640071d2 376 }
loopsva 0:fc70640071d2 377
loopsva 0:fc70640071d2 378 if ( (draw_x4 <= width()) && (draw_y4 >= 0) ) {
loopsva 0:fc70640071d2 379 pixel(draw_x4, draw_y4, color);
loopsva 0:fc70640071d2 380 }
loopsva 0:fc70640071d2 381
loopsva 0:fc70640071d2 382 if ( (draw_x5 >= 0) && (draw_y5 >= 0) ) {
loopsva 0:fc70640071d2 383 pixel(draw_x5, draw_y5, color);
loopsva 0:fc70640071d2 384 }
loopsva 0:fc70640071d2 385 if ( (draw_x6 <=width()) && (draw_y6 <= height()) ) {
loopsva 0:fc70640071d2 386 pixel(draw_x6, draw_y6, color);
loopsva 0:fc70640071d2 387 }
loopsva 0:fc70640071d2 388 if ( (draw_x7 >= 0) && (draw_y7 <= height()) ) {
loopsva 0:fc70640071d2 389 pixel(draw_x7, draw_y7, color);
loopsva 0:fc70640071d2 390 }
loopsva 0:fc70640071d2 391 }
loopsva 0:fc70640071d2 392 return;
loopsva 0:fc70640071d2 393 }
loopsva 0:fc70640071d2 394
loopsva 0:fc70640071d2 395 void SPI_TFT::fillcircle(int x, int y, int r, int color) {
loopsva 0:fc70640071d2 396 int i;
loopsva 0:fc70640071d2 397 for (i = 0; i <= r; i++)
loopsva 0:fc70640071d2 398 circle(x,y,i,color);
loopsva 0:fc70640071d2 399 }
loopsva 0:fc70640071d2 400
loopsva 0:fc70640071d2 401
loopsva 0:fc70640071d2 402
loopsva 0:fc70640071d2 403 void SPI_TFT::hline(int x0, int x1, int y, int color) {
loopsva 0:fc70640071d2 404 int w;
loopsva 0:fc70640071d2 405 w = x1 - x0 + 1;
loopsva 0:fc70640071d2 406 window(x0,y,w,1);
loopsva 0:fc70640071d2 407 wr_cmd(0x22);
loopsva 0:fc70640071d2 408 wr_dat_start();
loopsva 0:fc70640071d2 409 _spi.format(16,3); // pixel are send in 16 bit mode to speed up
loopsva 0:fc70640071d2 410 for (int x=0; x<w; x++) {
loopsva 0:fc70640071d2 411 _spi.write(color);
loopsva 0:fc70640071d2 412 }
loopsva 0:fc70640071d2 413 _spi.format(8,3);
loopsva 0:fc70640071d2 414 wr_dat_stop();
loopsva 0:fc70640071d2 415 WindowMax();
loopsva 0:fc70640071d2 416 return;
loopsva 0:fc70640071d2 417 }
loopsva 0:fc70640071d2 418
loopsva 0:fc70640071d2 419
loopsva 0:fc70640071d2 420
loopsva 0:fc70640071d2 421 void SPI_TFT::vline(int x, int y0, int y1, int color) {
loopsva 0:fc70640071d2 422 int h;
loopsva 0:fc70640071d2 423 h = y1 - y0 + 1;
loopsva 0:fc70640071d2 424 window(x,y0,1,h);
loopsva 0:fc70640071d2 425 wr_cmd(0x22);
loopsva 0:fc70640071d2 426 wr_dat_start();
loopsva 0:fc70640071d2 427 _spi.format(16,3); // pixel are send in 16 bit mode to speed up
loopsva 0:fc70640071d2 428 for (int y=0; y<h; y++) {
loopsva 0:fc70640071d2 429 _spi.write(color);
loopsva 0:fc70640071d2 430 }
loopsva 0:fc70640071d2 431 _spi.format(8,3);
loopsva 0:fc70640071d2 432 wr_dat_stop();
loopsva 0:fc70640071d2 433 WindowMax();
loopsva 0:fc70640071d2 434 return;
loopsva 0:fc70640071d2 435 }
loopsva 0:fc70640071d2 436
loopsva 0:fc70640071d2 437
loopsva 0:fc70640071d2 438
loopsva 0:fc70640071d2 439 void SPI_TFT::line(int x0, int y0, int x1, int y1, int color) {
loopsva 0:fc70640071d2 440 //WindowMax();
loopsva 0:fc70640071d2 441 int dx = 0, dy = 0;
loopsva 0:fc70640071d2 442 int dx_sym = 0, dy_sym = 0;
loopsva 0:fc70640071d2 443 int dx_x2 = 0, dy_x2 = 0;
loopsva 0:fc70640071d2 444 int di = 0;
loopsva 0:fc70640071d2 445
loopsva 0:fc70640071d2 446 dx = x1-x0;
loopsva 0:fc70640071d2 447 dy = y1-y0;
loopsva 0:fc70640071d2 448
loopsva 0:fc70640071d2 449 if (dx == 0) { /* vertical line */
loopsva 0:fc70640071d2 450 if (y1 > y0) vline(x0,y0,y1,color);
loopsva 0:fc70640071d2 451 else vline(x0,y1,y0,color);
loopsva 0:fc70640071d2 452 return;
loopsva 0:fc70640071d2 453 }
loopsva 0:fc70640071d2 454
loopsva 0:fc70640071d2 455 if (dx > 0) {
loopsva 0:fc70640071d2 456 dx_sym = 1;
loopsva 0:fc70640071d2 457 } else {
loopsva 0:fc70640071d2 458 dx_sym = -1;
loopsva 0:fc70640071d2 459 }
loopsva 0:fc70640071d2 460 if (dy == 0) { /* horizontal line */
loopsva 0:fc70640071d2 461 if (x1 > x0) hline(x0,x1,y0,color);
loopsva 0:fc70640071d2 462 else hline(x1,x0,y0,color);
loopsva 0:fc70640071d2 463 return;
loopsva 0:fc70640071d2 464 }
loopsva 0:fc70640071d2 465
loopsva 0:fc70640071d2 466 if (dy > 0) {
loopsva 0:fc70640071d2 467 dy_sym = 1;
loopsva 0:fc70640071d2 468 } else {
loopsva 0:fc70640071d2 469 dy_sym = -1;
loopsva 0:fc70640071d2 470 }
loopsva 0:fc70640071d2 471
loopsva 0:fc70640071d2 472 dx = dx_sym*dx;
loopsva 0:fc70640071d2 473 dy = dy_sym*dy;
loopsva 0:fc70640071d2 474
loopsva 0:fc70640071d2 475 dx_x2 = dx*2;
loopsva 0:fc70640071d2 476 dy_x2 = dy*2;
loopsva 0:fc70640071d2 477
loopsva 0:fc70640071d2 478 if (dx >= dy) {
loopsva 0:fc70640071d2 479 di = dy_x2 - dx;
loopsva 0:fc70640071d2 480 while (x0 != x1) {
loopsva 0:fc70640071d2 481
loopsva 0:fc70640071d2 482 pixel(x0, y0, color);
loopsva 0:fc70640071d2 483 x0 += dx_sym;
loopsva 0:fc70640071d2 484 if (di<0) {
loopsva 0:fc70640071d2 485 di += dy_x2;
loopsva 0:fc70640071d2 486 } else {
loopsva 0:fc70640071d2 487 di += dy_x2 - dx_x2;
loopsva 0:fc70640071d2 488 y0 += dy_sym;
loopsva 0:fc70640071d2 489 }
loopsva 0:fc70640071d2 490 }
loopsva 0:fc70640071d2 491 pixel(x0, y0, color);
loopsva 0:fc70640071d2 492 } else {
loopsva 0:fc70640071d2 493 di = dx_x2 - dy;
loopsva 0:fc70640071d2 494 while (y0 != y1) {
loopsva 0:fc70640071d2 495 pixel(x0, y0, color);
loopsva 0:fc70640071d2 496 y0 += dy_sym;
loopsva 0:fc70640071d2 497 if (di < 0) {
loopsva 0:fc70640071d2 498 di += dx_x2;
loopsva 0:fc70640071d2 499 } else {
loopsva 0:fc70640071d2 500 di += dx_x2 - dy_x2;
loopsva 0:fc70640071d2 501 x0 += dx_sym;
loopsva 0:fc70640071d2 502 }
loopsva 0:fc70640071d2 503 }
loopsva 0:fc70640071d2 504 pixel(x0, y0, color);
loopsva 0:fc70640071d2 505 }
loopsva 0:fc70640071d2 506 return;
loopsva 0:fc70640071d2 507 }
loopsva 0:fc70640071d2 508
loopsva 0:fc70640071d2 509
loopsva 0:fc70640071d2 510
loopsva 0:fc70640071d2 511
loopsva 0:fc70640071d2 512 void SPI_TFT::rect(int x0, int y0, int x1, int y1, int color) {
loopsva 0:fc70640071d2 513
loopsva 0:fc70640071d2 514 if (x1 > x0) hline(x0,x1,y0,color);
loopsva 0:fc70640071d2 515 else hline(x1,x0,y0,color);
loopsva 0:fc70640071d2 516
loopsva 0:fc70640071d2 517 if (y1 > y0) vline(x0,y0,y1,color);
loopsva 0:fc70640071d2 518 else vline(x0,y1,y0,color);
loopsva 0:fc70640071d2 519
loopsva 0:fc70640071d2 520 if (x1 > x0) hline(x0,x1,y1,color);
loopsva 0:fc70640071d2 521 else hline(x1,x0,y1,color);
loopsva 0:fc70640071d2 522
loopsva 0:fc70640071d2 523 if (y1 > y0) vline(x1,y0,y1,color);
loopsva 0:fc70640071d2 524 else vline(x1,y1,y0,color);
loopsva 0:fc70640071d2 525
loopsva 0:fc70640071d2 526 return;
loopsva 0:fc70640071d2 527 }
loopsva 0:fc70640071d2 528
loopsva 0:fc70640071d2 529
loopsva 0:fc70640071d2 530
loopsva 0:fc70640071d2 531 void SPI_TFT::fillrect(int x0, int y0, int x1, int y1, int color) {
loopsva 0:fc70640071d2 532
loopsva 0:fc70640071d2 533 int h = y1 - y0 + 1;
loopsva 0:fc70640071d2 534 int w = x1 - x0 + 1;
loopsva 0:fc70640071d2 535 int pixel = h * w;
loopsva 0:fc70640071d2 536 window(x0,y0,w,h);
loopsva 0:fc70640071d2 537 wr_cmd(0x22);
loopsva 0:fc70640071d2 538 wr_dat_start();
loopsva 0:fc70640071d2 539 _spi.format(16,3); // pixel are send in 16 bit mode to speed up
loopsva 0:fc70640071d2 540 for (int p=0; p<pixel; p++) {
loopsva 0:fc70640071d2 541 _spi.write(color);
loopsva 0:fc70640071d2 542 }
loopsva 0:fc70640071d2 543 _spi.format(8,3);
loopsva 0:fc70640071d2 544 wr_dat_stop();
loopsva 0:fc70640071d2 545 WindowMax();
loopsva 0:fc70640071d2 546 return;
loopsva 0:fc70640071d2 547 }
loopsva 0:fc70640071d2 548
loopsva 0:fc70640071d2 549
loopsva 0:fc70640071d2 550
loopsva 0:fc70640071d2 551 void SPI_TFT::locate(int x, int y) {
loopsva 0:fc70640071d2 552 char_x = x;
loopsva 0:fc70640071d2 553 char_y = y;
loopsva 0:fc70640071d2 554 }
loopsva 0:fc70640071d2 555
loopsva 0:fc70640071d2 556
loopsva 0:fc70640071d2 557
loopsva 0:fc70640071d2 558 int SPI_TFT::columns() {
loopsva 0:fc70640071d2 559 return width() / font[1];
loopsva 0:fc70640071d2 560 }
loopsva 0:fc70640071d2 561
loopsva 0:fc70640071d2 562
loopsva 0:fc70640071d2 563
loopsva 0:fc70640071d2 564 int SPI_TFT::rows() {
loopsva 0:fc70640071d2 565 return height() / font[2];
loopsva 0:fc70640071d2 566 }
loopsva 0:fc70640071d2 567
loopsva 0:fc70640071d2 568
loopsva 0:fc70640071d2 569
loopsva 0:fc70640071d2 570 int SPI_TFT::_putc(int value) {
loopsva 0:fc70640071d2 571 if (value == '\n') { // new line
loopsva 0:fc70640071d2 572 char_x = 0;
loopsva 0:fc70640071d2 573 char_y = char_y + font[2];
loopsva 0:fc70640071d2 574 if (char_y >= height() - font[2]) {
loopsva 0:fc70640071d2 575 char_y = 0;
loopsva 0:fc70640071d2 576 }
loopsva 0:fc70640071d2 577 } else {
loopsva 0:fc70640071d2 578 character(char_x, char_y, value);
loopsva 0:fc70640071d2 579 }
loopsva 0:fc70640071d2 580 return value;
loopsva 0:fc70640071d2 581 }
loopsva 0:fc70640071d2 582
loopsva 0:fc70640071d2 583
loopsva 0:fc70640071d2 584
loopsva 0:fc70640071d2 585
loopsva 0:fc70640071d2 586 void SPI_TFT::character(int x, int y, int c) {
loopsva 0:fc70640071d2 587 unsigned int hor,vert,offset,bpl,j,i,b;
loopsva 0:fc70640071d2 588 unsigned char* zeichen;
loopsva 0:fc70640071d2 589 unsigned char z,w;
loopsva 0:fc70640071d2 590
loopsva 0:fc70640071d2 591 if ((c < 31) || (c > 127)) return; // test char range
loopsva 0:fc70640071d2 592
loopsva 0:fc70640071d2 593 // read font parameter from start of array
loopsva 0:fc70640071d2 594 offset = font[0]; // bytes / char
loopsva 0:fc70640071d2 595 hor = font[1]; // get hor size of font
loopsva 0:fc70640071d2 596 vert = font[2]; // get vert size of font
loopsva 0:fc70640071d2 597 bpl = font[3]; // bytes per line
loopsva 0:fc70640071d2 598
loopsva 0:fc70640071d2 599 if (char_x + hor > width()) {
loopsva 0:fc70640071d2 600 char_x = 0;
loopsva 0:fc70640071d2 601 char_y = char_y + vert;
loopsva 0:fc70640071d2 602 if (char_y >= height() - font[2]) {
loopsva 0:fc70640071d2 603 char_y = 0;
loopsva 0:fc70640071d2 604 }
loopsva 0:fc70640071d2 605 }
loopsva 0:fc70640071d2 606
loopsva 0:fc70640071d2 607 window(char_x, char_y,hor,vert); // char box
loopsva 0:fc70640071d2 608 wr_cmd(0x22);
loopsva 0:fc70640071d2 609 wr_dat_start();
loopsva 0:fc70640071d2 610 zeichen = &font[((c -32) * offset) + 4]; // start of char bitmap
loopsva 0:fc70640071d2 611 w = zeichen[0]; // width of actual char
loopsva 0:fc70640071d2 612 _spi.format(16,3); // pixel are 16 bit
loopsva 0:fc70640071d2 613
loopsva 0:fc70640071d2 614 for (j=0; j<vert; j++) { // vert line
loopsva 0:fc70640071d2 615 for (i=0; i<hor; i++) { // horz line
loopsva 0:fc70640071d2 616 z = zeichen[bpl * i + ((j & 0xF8) >> 3)+1];
loopsva 0:fc70640071d2 617 b = 1 << (j & 0x07);
loopsva 0:fc70640071d2 618 if (( z & b ) == 0x00) {
loopsva 0:fc70640071d2 619 _spi.write(_background);
loopsva 0:fc70640071d2 620 } else {
loopsva 0:fc70640071d2 621 _spi.write(_foreground);
loopsva 0:fc70640071d2 622 }
loopsva 0:fc70640071d2 623 }
loopsva 0:fc70640071d2 624 }
loopsva 0:fc70640071d2 625 _spi.format(8,3); // 8 bit
loopsva 0:fc70640071d2 626 wr_dat_stop();
loopsva 0:fc70640071d2 627 WindowMax();
loopsva 0:fc70640071d2 628 if ((w + 2) < hor) { // x offset to next char
loopsva 0:fc70640071d2 629 char_x += w + 2;
loopsva 0:fc70640071d2 630 } else char_x += hor;
loopsva 0:fc70640071d2 631 }
loopsva 0:fc70640071d2 632
loopsva 0:fc70640071d2 633
loopsva 0:fc70640071d2 634
loopsva 0:fc70640071d2 635
loopsva 0:fc70640071d2 636
loopsva 0:fc70640071d2 637 void SPI_TFT::set_font(unsigned char* f) {
loopsva 0:fc70640071d2 638 font = f;
loopsva 0:fc70640071d2 639 }
loopsva 0:fc70640071d2 640
loopsva 0:fc70640071d2 641
loopsva 0:fc70640071d2 642
loopsva 0:fc70640071d2 643 void SPI_TFT::Bitmap(unsigned int x, unsigned int y, unsigned int w, unsigned int h,unsigned char *bitmap) {
loopsva 0:fc70640071d2 644 unsigned int i,j,padd;
loopsva 0:fc70640071d2 645 unsigned short *bitmap_ptr = (unsigned short *)bitmap;
loopsva 0:fc70640071d2 646 // the lines are padded to multiple of 4 bytes in a bitmap
loopsva 0:fc70640071d2 647 padd = -1;
loopsva 0:fc70640071d2 648 do {
loopsva 0:fc70640071d2 649 padd ++;
loopsva 0:fc70640071d2 650 } while (2*(w + padd)%4 != 0);
loopsva 0:fc70640071d2 651 window(x, y, w, h);
loopsva 0:fc70640071d2 652 wr_cmd(0x22);
loopsva 0:fc70640071d2 653 wr_dat_start();
loopsva 0:fc70640071d2 654 _spi.format(16,3);
loopsva 0:fc70640071d2 655 bitmap_ptr += ((h - 1)* (w + padd));
loopsva 0:fc70640071d2 656 //bitmap_ptr -= padd;
loopsva 0:fc70640071d2 657 for (j = 0; j < h; j++) { //Lines
loopsva 0:fc70640071d2 658 for (i = 0; i < w; i++) { // copy pixel data to TFT
loopsva 0:fc70640071d2 659 _spi.write(*bitmap_ptr); // one line
loopsva 0:fc70640071d2 660 bitmap_ptr++;
loopsva 0:fc70640071d2 661 }
loopsva 0:fc70640071d2 662 bitmap_ptr -= 2*w;
loopsva 0:fc70640071d2 663 bitmap_ptr -= padd;
loopsva 0:fc70640071d2 664 }
loopsva 0:fc70640071d2 665 _spi.format(8,3);
loopsva 0:fc70640071d2 666 wr_dat_stop();
loopsva 0:fc70640071d2 667 WindowMax();
loopsva 0:fc70640071d2 668 }
loopsva 0:fc70640071d2 669
loopsva 0:fc70640071d2 670
loopsva 0:fc70640071d2 671 int SPI_TFT::BMP_16(unsigned int x, unsigned int y, const char *Name_BMP) {
loopsva 0:fc70640071d2 672
loopsva 0:fc70640071d2 673 #define OffsetPixelWidth 18
loopsva 0:fc70640071d2 674 #define OffsetPixelHeigh 22
loopsva 0:fc70640071d2 675 #define OffsetFileSize 34
loopsva 0:fc70640071d2 676 #define OffsetPixData 10
loopsva 0:fc70640071d2 677 #define OffsetBPP 28
loopsva 0:fc70640071d2 678
loopsva 0:fc70640071d2 679 char filename[50];
loopsva 0:fc70640071d2 680 unsigned char BMP_Header[54];
loopsva 0:fc70640071d2 681 unsigned short BPP_t;
loopsva 0:fc70640071d2 682 unsigned int PixelWidth,PixelHeigh,start_data;
loopsva 0:fc70640071d2 683 unsigned int i,off;
loopsva 0:fc70640071d2 684 int padd,j;
loopsva 0:fc70640071d2 685 unsigned short *line;
loopsva 0:fc70640071d2 686
loopsva 0:fc70640071d2 687 // get the filename
loopsva 0:fc70640071d2 688 LocalFileSystem local("local");
loopsva 0:fc70640071d2 689 sprintf(&filename[0],"/local/");
loopsva 0:fc70640071d2 690 i=7;
loopsva 0:fc70640071d2 691 while (*Name_BMP!='\0') {
loopsva 0:fc70640071d2 692 filename[i++]=*Name_BMP++;
loopsva 0:fc70640071d2 693 }
loopsva 0:fc70640071d2 694 FILE *Image = fopen((const char *)&filename[0], "r"); // open the bmp file
loopsva 0:fc70640071d2 695 if (!Image) {
loopsva 0:fc70640071d2 696 return(0); // error file not found !
loopsva 0:fc70640071d2 697 }
loopsva 0:fc70640071d2 698
loopsva 0:fc70640071d2 699 fread(&BMP_Header[0],1,54,Image); // get the BMP Header
loopsva 0:fc70640071d2 700
loopsva 0:fc70640071d2 701 if (BMP_Header[0] != 0x42 || BMP_Header[1] != 0x4D) { // check magic byte
loopsva 0:fc70640071d2 702 fclose(Image);
loopsva 0:fc70640071d2 703 return(-1); // error no BMP file
loopsva 0:fc70640071d2 704 }
loopsva 0:fc70640071d2 705
loopsva 0:fc70640071d2 706 BPP_t = BMP_Header[OffsetBPP] + (BMP_Header[OffsetBPP + 1] << 8);
loopsva 0:fc70640071d2 707 if (BPP_t != 0x0010) {
loopsva 0:fc70640071d2 708 fclose(Image);
loopsva 0:fc70640071d2 709 return(-2); // error no 16 bit BMP
loopsva 0:fc70640071d2 710 }
loopsva 0:fc70640071d2 711
loopsva 0:fc70640071d2 712 PixelHeigh = BMP_Header[OffsetPixelHeigh] + (BMP_Header[OffsetPixelHeigh + 1] << 8) + (BMP_Header[OffsetPixelHeigh + 2] << 16) + (BMP_Header[OffsetPixelHeigh + 3] << 24);
loopsva 0:fc70640071d2 713 PixelWidth = BMP_Header[OffsetPixelWidth] + (BMP_Header[OffsetPixelWidth + 1] << 8) + (BMP_Header[OffsetPixelWidth + 2] << 16) + (BMP_Header[OffsetPixelWidth + 3] << 24);
loopsva 0:fc70640071d2 714 if (PixelHeigh > height() + y || PixelWidth > width() + x) {
loopsva 0:fc70640071d2 715 fclose(Image);
loopsva 0:fc70640071d2 716 return(-3); // to big
loopsva 0:fc70640071d2 717 }
loopsva 0:fc70640071d2 718
loopsva 0:fc70640071d2 719 start_data = BMP_Header[OffsetPixData] + (BMP_Header[OffsetPixData + 1] << 8) + (BMP_Header[OffsetPixData + 2] << 16) + (BMP_Header[OffsetPixData + 3] << 24);
loopsva 0:fc70640071d2 720
loopsva 0:fc70640071d2 721 line = (unsigned short *) malloc (PixelWidth); // we need a buffer for a line
loopsva 0:fc70640071d2 722 if (line == NULL) {
loopsva 0:fc70640071d2 723 return(-4); // error no memory
loopsva 0:fc70640071d2 724 }
loopsva 0:fc70640071d2 725
loopsva 0:fc70640071d2 726 // the lines are padded to multiple of 4 bytes
loopsva 0:fc70640071d2 727 padd = -1;
loopsva 0:fc70640071d2 728 do {
loopsva 0:fc70640071d2 729 padd ++;
loopsva 0:fc70640071d2 730 } while ((PixelWidth * 2 + padd)%4 != 0);
loopsva 0:fc70640071d2 731
loopsva 0:fc70640071d2 732 window(x, y,PixelWidth,PixelHeigh);
loopsva 0:fc70640071d2 733 wr_cmd(0x22);
loopsva 0:fc70640071d2 734 wr_dat_start();
loopsva 0:fc70640071d2 735 _spi.format(16,3);
loopsva 0:fc70640071d2 736 for (j = PixelHeigh - 1; j >= 0; j--) { //Lines bottom up
loopsva 0:fc70640071d2 737 off = j * (PixelWidth * 2 + padd) + start_data; // start of line
loopsva 0:fc70640071d2 738 fseek(Image, off ,SEEK_SET);
loopsva 0:fc70640071d2 739 fread(line,1,PixelWidth * 2,Image); // read a line - slow !
loopsva 0:fc70640071d2 740 for (i = 0; i < PixelWidth; i++) { // copy pixel data to TFT
loopsva 0:fc70640071d2 741 _spi.write(line[i]); // one 16 bit pixel
loopsva 0:fc70640071d2 742 }
loopsva 0:fc70640071d2 743 }
loopsva 0:fc70640071d2 744 _spi.format(8,3);
loopsva 0:fc70640071d2 745 wr_dat_stop();
loopsva 0:fc70640071d2 746 free (line);
loopsva 0:fc70640071d2 747 fclose(Image);
loopsva 0:fc70640071d2 748 WindowMax();
loopsva 0:fc70640071d2 749 return(1);
loopsva 0:fc70640071d2 750 }