AB&T / SPI_TFT_ILI9341

Added SPI speed parameter

Dependents:   EasyCAT_LAB_simple EasyCAT_LAB

  • The default SPI speed has been set to 27MHz, but it can be configured using the last parameter of the constructor.
  • This is an optimization for the EasyCAT LAB , a complete educational and experimental EtherCAT® system, composed of one master and two slaves .

SPI_TFT_ILI9341.cpp@5:93cc09de603a, 2013-10-21 (annotated)

Committer:
mazgch
Date:
Mon Oct 21 19:38:10 2013 +0000
Revision:
5:93cc09de603a
Parent:
4:f018e272220b
Child:
7:3ac45671dc77
make reset optional by constructing the DigitalOut only when needed and not NC.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
dreschpe 0:da1bf437cbc1 1 /* mbed library for 240*320 pixel display TFT based on ILI9341 LCD Controller
dreschpe 0:da1bf437cbc1 2 * Copyright (c) 2013 Peter Drescher - DC2PD
dreschpe 0:da1bf437cbc1 3 *
dreschpe 0:da1bf437cbc1 4 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
dreschpe 0:da1bf437cbc1 5 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
dreschpe 0:da1bf437cbc1 6 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
dreschpe 0:da1bf437cbc1 7 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
dreschpe 0:da1bf437cbc1 8 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
dreschpe 0:da1bf437cbc1 9 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
dreschpe 0:da1bf437cbc1 10 * THE SOFTWARE.
dreschpe 0:da1bf437cbc1 11 */
dreschpe 0:da1bf437cbc1 12
dreschpe 0:da1bf437cbc1 13 // 12.06.13 fork from SPI_TFT code because controller is different ...
dreschpe 2:0a16083193a4 14 // 14.07.13 Test with real display and bugfix
dreschpe 4:f018e272220b 15 // 18.10.13 Better Circle function from Michael Ammann
dreschpe 0:da1bf437cbc1 16
dreschpe 0:da1bf437cbc1 17 #include "SPI_TFT_ILI9341.h"
dreschpe 0:da1bf437cbc1 18 #include "mbed.h"
dreschpe 0:da1bf437cbc1 19
dreschpe 0:da1bf437cbc1 20 #define BPP 16 // Bits per pixel
dreschpe 0:da1bf437cbc1 21
dreschpe 0:da1bf437cbc1 22
dreschpe 0:da1bf437cbc1 23 //extern Serial pc;
dreschpe 0:da1bf437cbc1 24 //extern DigitalOut xx; // debug !!
dreschpe 0:da1bf437cbc1 25
dreschpe 0:da1bf437cbc1 26 SPI_TFT_ILI9341::SPI_TFT_ILI9341(PinName mosi, PinName miso, PinName sclk, PinName cs, PinName reset, PinName dc, const char *name)
mazgch 5:93cc09de603a 27 : _spi(mosi, miso, sclk), _cs(cs), _dc(dc), GraphicsDisplay(name)
dreschpe 0:da1bf437cbc1 28 {
dreschpe 0:da1bf437cbc1 29 orientation = 0;
dreschpe 0:da1bf437cbc1 30 char_x = 0;
mazgch 5:93cc09de603a 31 _reset = reset;
dreschpe 0:da1bf437cbc1 32 tft_reset();
dreschpe 0:da1bf437cbc1 33 }
dreschpe 0:da1bf437cbc1 34
dreschpe 0:da1bf437cbc1 35 int SPI_TFT_ILI9341::width()
dreschpe 0:da1bf437cbc1 36 {
dreschpe 0:da1bf437cbc1 37 if (orientation == 0 || orientation == 2) return 240;
dreschpe 0:da1bf437cbc1 38 else return 320;
dreschpe 0:da1bf437cbc1 39 }
dreschpe 0:da1bf437cbc1 40
dreschpe 0:da1bf437cbc1 41
dreschpe 0:da1bf437cbc1 42 int SPI_TFT_ILI9341::height()
dreschpe 0:da1bf437cbc1 43 {
dreschpe 0:da1bf437cbc1 44 if (orientation == 0 || orientation == 2) return 320;
dreschpe 0:da1bf437cbc1 45 else return 240;
dreschpe 0:da1bf437cbc1 46 }
dreschpe 0:da1bf437cbc1 47
dreschpe 0:da1bf437cbc1 48
dreschpe 2:0a16083193a4 49 void SPI_TFT_ILI9341::set_orientation(unsigned int o)
dreschpe 0:da1bf437cbc1 50 {
dreschpe 0:da1bf437cbc1 51 orientation = o;
dreschpe 2:0a16083193a4 52 wr_cmd(0x36); // MEMORY_ACCESS_CONTROL
dreschpe 0:da1bf437cbc1 53 switch (orientation) {
dreschpe 0:da1bf437cbc1 54 case 0:
dreschpe 2:0a16083193a4 55 _spi.write(0x48);
dreschpe 0:da1bf437cbc1 56 break;
dreschpe 0:da1bf437cbc1 57 case 1:
dreschpe 2:0a16083193a4 58 _spi.write(0x28);
dreschpe 0:da1bf437cbc1 59 break;
dreschpe 0:da1bf437cbc1 60 case 2:
dreschpe 2:0a16083193a4 61 _spi.write(0x88);
dreschpe 0:da1bf437cbc1 62 break;
dreschpe 0:da1bf437cbc1 63 case 3:
dreschpe 2:0a16083193a4 64 _spi.write(0xE8);
dreschpe 0:da1bf437cbc1 65 break;
dreschpe 0:da1bf437cbc1 66 }
dreschpe 2:0a16083193a4 67 _cs = 1;
dreschpe 0:da1bf437cbc1 68 WindowMax();
dreschpe 2:0a16083193a4 69 }
dreschpe 0:da1bf437cbc1 70
dreschpe 0:da1bf437cbc1 71
dreschpe 0:da1bf437cbc1 72 // write command to tft register
dreschpe 0:da1bf437cbc1 73
dreschpe 0:da1bf437cbc1 74 void SPI_TFT_ILI9341::wr_cmd(unsigned char cmd)
dreschpe 0:da1bf437cbc1 75 {
dreschpe 0:da1bf437cbc1 76 _dc = 0;
dreschpe 0:da1bf437cbc1 77 _cs = 0;
dreschpe 0:da1bf437cbc1 78 _spi.write(cmd); // mbed lib
dreschpe 0:da1bf437cbc1 79 _dc = 1;
dreschpe 0:da1bf437cbc1 80 }
dreschpe 0:da1bf437cbc1 81
dreschpe 0:da1bf437cbc1 82
dreschpe 0:da1bf437cbc1 83
dreschpe 0:da1bf437cbc1 84 void SPI_TFT_ILI9341::wr_dat(unsigned char dat)
dreschpe 0:da1bf437cbc1 85 {
dreschpe 0:da1bf437cbc1 86 _spi.write(dat); // mbed lib
dreschpe 0:da1bf437cbc1 87 }
dreschpe 0:da1bf437cbc1 88
dreschpe 0:da1bf437cbc1 89
dreschpe 0:da1bf437cbc1 90
dreschpe 0:da1bf437cbc1 91 // the ILI9341 can read - has to be implemented later
dreschpe 0:da1bf437cbc1 92 // A read will return 0 at the moment
dreschpe 0:da1bf437cbc1 93
dreschpe 0:da1bf437cbc1 94 //unsigned short SPI_TFT_ILI9341::rd_dat (void)
dreschpe 0:da1bf437cbc1 95 //{
dreschpe 0:da1bf437cbc1 96 // unsigned short val = 0;
dreschpe 0:da1bf437cbc1 97
dreschpe 0:da1bf437cbc1 98 //val = _spi.write(0x73ff); /* Dummy read 1 */
dreschpe 0:da1bf437cbc1 99 //val = _spi.write(0x0000); /* Read D8..D15 */
dreschpe 0:da1bf437cbc1 100 // return (val);
dreschpe 0:da1bf437cbc1 101 //}
dreschpe 0:da1bf437cbc1 102
dreschpe 0:da1bf437cbc1 103
dreschpe 0:da1bf437cbc1 104
dreschpe 1:6d6125e88de7 105 // Init code based on MI0283QT datasheet
dreschpe 1:6d6125e88de7 106
dreschpe 0:da1bf437cbc1 107 void SPI_TFT_ILI9341::tft_reset()
dreschpe 0:da1bf437cbc1 108 {
dreschpe 2:0a16083193a4 109 _spi.format(8,3); // 8 bit spi mode 3
dreschpe 1:6d6125e88de7 110 _spi.frequency(10000000); // 10 Mhz SPI clock
dreschpe 0:da1bf437cbc1 111 _cs = 1; // cs high
dreschpe 0:da1bf437cbc1 112 _dc = 1; // dc high
mazgch 5:93cc09de603a 113 if (_reset != NC)
mazgch 5:93cc09de603a 114 {
mazgch 5:93cc09de603a 115 DigitalOut rst(_reset);
mazgch 5:93cc09de603a 116 rst = 0; // display reset
mazgch 5:93cc09de603a 117 wait_us(50);
mazgch 5:93cc09de603a 118 rst = 1; // end hardware reset
mazgch 5:93cc09de603a 119 }
dreschpe 0:da1bf437cbc1 120 wait_ms(5);
dreschpe 1:6d6125e88de7 121
dreschpe 1:6d6125e88de7 122 wr_cmd(0x01); // SW reset
dreschpe 1:6d6125e88de7 123 wait_ms(5);
dreschpe 1:6d6125e88de7 124 wr_cmd(0x28); // display off
dreschpe 0:da1bf437cbc1 125
dreschpe 0:da1bf437cbc1 126 /* Start Initial Sequence ----------------------------------------------------*/
dreschpe 1:6d6125e88de7 127 wr_cmd(0xCF);
dreschpe 1:6d6125e88de7 128 _spi.write(0x00);
dreschpe 1:6d6125e88de7 129 _spi.write(0x83);
dreschpe 1:6d6125e88de7 130 _spi.write(0x30);
dreschpe 1:6d6125e88de7 131 _cs = 1;
dreschpe 1:6d6125e88de7 132
dreschpe 1:6d6125e88de7 133 wr_cmd(0xED);
dreschpe 1:6d6125e88de7 134 _spi.write(0x64);
dreschpe 1:6d6125e88de7 135 _spi.write(0x03);
dreschpe 1:6d6125e88de7 136 _spi.write(0x12);
dreschpe 1:6d6125e88de7 137 _spi.write(0x81);
dreschpe 1:6d6125e88de7 138 _cs = 1;
dreschpe 1:6d6125e88de7 139
dreschpe 1:6d6125e88de7 140 wr_cmd(0xE8);
dreschpe 1:6d6125e88de7 141 _spi.write(0x85);
dreschpe 1:6d6125e88de7 142 _spi.write(0x01);
dreschpe 1:6d6125e88de7 143 _spi.write(0x79);
dreschpe 1:6d6125e88de7 144 _cs = 1;
dreschpe 1:6d6125e88de7 145
dreschpe 1:6d6125e88de7 146 wr_cmd(0xCB);
dreschpe 0:da1bf437cbc1 147 _spi.write(0x39);
dreschpe 0:da1bf437cbc1 148 _spi.write(0x2C);
dreschpe 0:da1bf437cbc1 149 _spi.write(0x00);
dreschpe 0:da1bf437cbc1 150 _spi.write(0x34);
dreschpe 0:da1bf437cbc1 151 _spi.write(0x02);
dreschpe 0:da1bf437cbc1 152 _cs = 1;
dreschpe 1:6d6125e88de7 153
dreschpe 1:6d6125e88de7 154 wr_cmd(0xF7);
dreschpe 1:6d6125e88de7 155 _spi.write(0x20);
dreschpe 0:da1bf437cbc1 156 _cs = 1;
dreschpe 1:6d6125e88de7 157
dreschpe 1:6d6125e88de7 158 wr_cmd(0xEA);
dreschpe 1:6d6125e88de7 159 _spi.write(0x00);
dreschpe 1:6d6125e88de7 160 _spi.write(0x00);
dreschpe 0:da1bf437cbc1 161 _cs = 1;
dreschpe 1:6d6125e88de7 162
dreschpe 0:da1bf437cbc1 163 wr_cmd(0xC0); // POWER_CONTROL_1
dreschpe 1:6d6125e88de7 164 _spi.write(0x26);
dreschpe 0:da1bf437cbc1 165 _cs = 1;
dreschpe 1:6d6125e88de7 166
dreschpe 0:da1bf437cbc1 167 wr_cmd(0xC1); // POWER_CONTROL_2
dreschpe 0:da1bf437cbc1 168 _spi.write(0x11);
dreschpe 0:da1bf437cbc1 169 _cs = 1;
dreschpe 1:6d6125e88de7 170
dreschpe 0:da1bf437cbc1 171 wr_cmd(0xC5); // VCOM_CONTROL_1
dreschpe 1:6d6125e88de7 172 _spi.write(0x35);
dreschpe 1:6d6125e88de7 173 _spi.write(0x3E);
dreschpe 0:da1bf437cbc1 174 _cs = 1;
dreschpe 1:6d6125e88de7 175
dreschpe 0:da1bf437cbc1 176 wr_cmd(0xC7); // VCOM_CONTROL_2
dreschpe 1:6d6125e88de7 177 _spi.write(0xBE);
dreschpe 0:da1bf437cbc1 178 _cs = 1;
dreschpe 1:6d6125e88de7 179
dreschpe 0:da1bf437cbc1 180 wr_cmd(0x36); // MEMORY_ACCESS_CONTROL
dreschpe 0:da1bf437cbc1 181 _spi.write(0x48);
dreschpe 0:da1bf437cbc1 182 _cs = 1;
dreschpe 1:6d6125e88de7 183
dreschpe 1:6d6125e88de7 184 wr_cmd(0x3A); // COLMOD_PIXEL_FORMAT_SET
dreschpe 1:6d6125e88de7 185 _spi.write(0x55); // 16 bit pixel
dreschpe 1:6d6125e88de7 186 _cs = 1;
dreschpe 1:6d6125e88de7 187
dreschpe 1:6d6125e88de7 188 wr_cmd(0xB1); // Frame Rate
dreschpe 1:6d6125e88de7 189 _spi.write(0x00);
dreschpe 1:6d6125e88de7 190 _spi.write(0x1B);
dreschpe 1:6d6125e88de7 191 _cs = 1;
dreschpe 1:6d6125e88de7 192
dreschpe 1:6d6125e88de7 193 wr_cmd(0xF2); // Gamma Function Disable
dreschpe 1:6d6125e88de7 194 _spi.write(0x08);
dreschpe 1:6d6125e88de7 195 _cs = 1;
dreschpe 1:6d6125e88de7 196
dreschpe 1:6d6125e88de7 197 wr_cmd(0x26);
dreschpe 1:6d6125e88de7 198 _spi.write(0x01); // gamma set for curve 01/2/04/08
dreschpe 1:6d6125e88de7 199 _cs = 1;
dreschpe 1:6d6125e88de7 200
dreschpe 1:6d6125e88de7 201 wr_cmd(0xE0); // positive gamma correction
dreschpe 1:6d6125e88de7 202 _spi.write(0x1F);
dreschpe 1:6d6125e88de7 203 _spi.write(0x1A);
dreschpe 1:6d6125e88de7 204 _spi.write(0x18);
dreschpe 1:6d6125e88de7 205 _spi.write(0x0A);
dreschpe 1:6d6125e88de7 206 _spi.write(0x0F);
dreschpe 1:6d6125e88de7 207 _spi.write(0x06);
dreschpe 1:6d6125e88de7 208 _spi.write(0x45);
dreschpe 1:6d6125e88de7 209 _spi.write(0x87);
dreschpe 1:6d6125e88de7 210 _spi.write(0x32);
dreschpe 1:6d6125e88de7 211 _spi.write(0x0A);
dreschpe 1:6d6125e88de7 212 _spi.write(0x07);
dreschpe 1:6d6125e88de7 213 _spi.write(0x02);
dreschpe 1:6d6125e88de7 214 _spi.write(0x07);
dreschpe 1:6d6125e88de7 215 _spi.write(0x05);
dreschpe 1:6d6125e88de7 216 _spi.write(0x00);
dreschpe 1:6d6125e88de7 217 _cs = 1;
dreschpe 1:6d6125e88de7 218
dreschpe 1:6d6125e88de7 219 wr_cmd(0xE1); // negativ gamma correction
dreschpe 1:6d6125e88de7 220 _spi.write(0x00);
dreschpe 1:6d6125e88de7 221 _spi.write(0x25);
dreschpe 1:6d6125e88de7 222 _spi.write(0x27);
dreschpe 1:6d6125e88de7 223 _spi.write(0x05);
dreschpe 1:6d6125e88de7 224 _spi.write(0x10);
dreschpe 1:6d6125e88de7 225 _spi.write(0x09);
dreschpe 1:6d6125e88de7 226 _spi.write(0x3A);
dreschpe 1:6d6125e88de7 227 _spi.write(0x78);
dreschpe 1:6d6125e88de7 228 _spi.write(0x4D);
dreschpe 1:6d6125e88de7 229 _spi.write(0x05);
dreschpe 1:6d6125e88de7 230 _spi.write(0x18);
dreschpe 1:6d6125e88de7 231 _spi.write(0x0D);
dreschpe 1:6d6125e88de7 232 _spi.write(0x38);
dreschpe 1:6d6125e88de7 233 _spi.write(0x3A);
dreschpe 1:6d6125e88de7 234 _spi.write(0x1F);
dreschpe 1:6d6125e88de7 235 _cs = 1;
dreschpe 1:6d6125e88de7 236
dreschpe 1:6d6125e88de7 237 WindowMax ();
dreschpe 1:6d6125e88de7 238
dreschpe 1:6d6125e88de7 239 //wr_cmd(0x34); // tearing effect off
dreschpe 1:6d6125e88de7 240 //_cs = 1;
dreschpe 1:6d6125e88de7 241
dreschpe 1:6d6125e88de7 242 //wr_cmd(0x35); // tearing effect on
dreschpe 1:6d6125e88de7 243 //_cs = 1;
dreschpe 1:6d6125e88de7 244
dreschpe 1:6d6125e88de7 245 wr_cmd(0xB7); // entry mode
dreschpe 1:6d6125e88de7 246 _spi.write(0x07);
dreschpe 1:6d6125e88de7 247 _cs = 1;
dreschpe 1:6d6125e88de7 248
dreschpe 1:6d6125e88de7 249 wr_cmd(0xB6); // display function control
dreschpe 1:6d6125e88de7 250 _spi.write(0x0A);
dreschpe 1:6d6125e88de7 251 _spi.write(0x82);
dreschpe 1:6d6125e88de7 252 _spi.write(0x27);
dreschpe 1:6d6125e88de7 253 _spi.write(0x00);
dreschpe 1:6d6125e88de7 254 _cs = 1;
dreschpe 1:6d6125e88de7 255
dreschpe 1:6d6125e88de7 256 wr_cmd(0x11); // sleep out
dreschpe 1:6d6125e88de7 257 _cs = 1;
dreschpe 1:6d6125e88de7 258
dreschpe 1:6d6125e88de7 259 wait_ms(100);
dreschpe 1:6d6125e88de7 260
dreschpe 1:6d6125e88de7 261 wr_cmd(0x29); // display on
dreschpe 1:6d6125e88de7 262 _cs = 1;
dreschpe 1:6d6125e88de7 263
dreschpe 1:6d6125e88de7 264 wait_ms(100);
dreschpe 1:6d6125e88de7 265
dreschpe 1:6d6125e88de7 266 }
dreschpe 0:da1bf437cbc1 267
dreschpe 0:da1bf437cbc1 268
dreschpe 0:da1bf437cbc1 269 void SPI_TFT_ILI9341::pixel(int x, int y, int color)
dreschpe 0:da1bf437cbc1 270 {
dreschpe 0:da1bf437cbc1 271 wr_cmd(0x2A);
dreschpe 0:da1bf437cbc1 272 _spi.write(x >> 8);
dreschpe 0:da1bf437cbc1 273 _spi.write(x);
dreschpe 0:da1bf437cbc1 274 _cs = 1;
dreschpe 0:da1bf437cbc1 275 wr_cmd(0x2B);
dreschpe 0:da1bf437cbc1 276 _spi.write(y >> 8);
dreschpe 0:da1bf437cbc1 277 _spi.write(y);
dreschpe 0:da1bf437cbc1 278 _cs = 1;
dreschpe 0:da1bf437cbc1 279 wr_cmd(0x2C); // send pixel
dreschpe 0:da1bf437cbc1 280 _spi.format(16,3); // switch to 16 bit Mode 3
dreschpe 0:da1bf437cbc1 281 _spi.write(color); // Write D0..D15
dreschpe 0:da1bf437cbc1 282 _spi.format(8,3);
dreschpe 0:da1bf437cbc1 283 _cs = 1;
dreschpe 0:da1bf437cbc1 284 }
dreschpe 0:da1bf437cbc1 285
dreschpe 0:da1bf437cbc1 286
dreschpe 0:da1bf437cbc1 287 void SPI_TFT_ILI9341::window (unsigned int x, unsigned int y, unsigned int w, unsigned int h)
dreschpe 0:da1bf437cbc1 288 {
dreschpe 0:da1bf437cbc1 289 wr_cmd(0x2A);
dreschpe 0:da1bf437cbc1 290 _spi.write(x >> 8);
dreschpe 0:da1bf437cbc1 291 _spi.write(x);
dreschpe 0:da1bf437cbc1 292 _spi.write((x+w-1) >> 8);
dreschpe 0:da1bf437cbc1 293 _spi.write(x+w-1);
dreschpe 0:da1bf437cbc1 294
dreschpe 0:da1bf437cbc1 295 _cs = 1;
dreschpe 0:da1bf437cbc1 296 wr_cmd(0x2B);
dreschpe 0:da1bf437cbc1 297 _spi.write(y >> 8);
dreschpe 0:da1bf437cbc1 298 _spi.write(y);
dreschpe 0:da1bf437cbc1 299 _spi.write((y+h-1) >> 8);
dreschpe 0:da1bf437cbc1 300 _spi.write(y+h-1);
dreschpe 0:da1bf437cbc1 301 _cs = 1;
dreschpe 0:da1bf437cbc1 302 }
dreschpe 0:da1bf437cbc1 303
dreschpe 0:da1bf437cbc1 304
dreschpe 0:da1bf437cbc1 305 void SPI_TFT_ILI9341::WindowMax (void)
dreschpe 0:da1bf437cbc1 306 {
dreschpe 0:da1bf437cbc1 307 window (0, 0, width(), height());
dreschpe 0:da1bf437cbc1 308 }
dreschpe 0:da1bf437cbc1 309
dreschpe 0:da1bf437cbc1 310
dreschpe 0:da1bf437cbc1 311
dreschpe 0:da1bf437cbc1 312 void SPI_TFT_ILI9341::cls (void)
dreschpe 0:da1bf437cbc1 313 {
dreschpe 0:da1bf437cbc1 314 int pixel = ( width() * height());
dreschpe 0:da1bf437cbc1 315 WindowMax();
dreschpe 0:da1bf437cbc1 316 wr_cmd(0x2C); // send pixel
dreschpe 0:da1bf437cbc1 317 _spi.format(16,3); // switch to 16 bit Mode 3
dreschpe 0:da1bf437cbc1 318 unsigned int i;
dreschpe 0:da1bf437cbc1 319 for (i = 0; i < ( width() * height()); i++)
dreschpe 0:da1bf437cbc1 320 _spi.write(_background);
dreschpe 0:da1bf437cbc1 321 _cs = 1;
dreschpe 0:da1bf437cbc1 322 _spi.format(8,3);
dreschpe 0:da1bf437cbc1 323 }
dreschpe 0:da1bf437cbc1 324
dreschpe 0:da1bf437cbc1 325
dreschpe 0:da1bf437cbc1 326 void SPI_TFT_ILI9341::circle(int x0, int y0, int r, int color)
dreschpe 0:da1bf437cbc1 327 {
dreschpe 0:da1bf437cbc1 328
mazgch 3:3d7298360e45 329 int x = -r, y = 0, err = 2-2*r, e2;
mazgch 3:3d7298360e45 330 do {
mazgch 3:3d7298360e45 331 pixel(x0-x, y0+y,color);
mazgch 3:3d7298360e45 332 pixel(x0+x, y0+y,color);
mazgch 3:3d7298360e45 333 pixel(x0+x, y0-y,color);
mazgch 3:3d7298360e45 334 pixel(x0-x, y0-y,color);
mazgch 3:3d7298360e45 335 e2 = err;
mazgch 3:3d7298360e45 336 if (e2 <= y) {
mazgch 3:3d7298360e45 337 err += ++y*2+1;
mazgch 3:3d7298360e45 338 if (-x == y && e2 <= x) e2 = 0;
mazgch 3:3d7298360e45 339 }
mazgch 3:3d7298360e45 340 if (e2 > x) err += ++x*2+1;
mazgch 3:3d7298360e45 341 } while (x <= 0);
dreschpe 4:f018e272220b 342
dreschpe 0:da1bf437cbc1 343 }
dreschpe 0:da1bf437cbc1 344
mazgch 3:3d7298360e45 345 void SPI_TFT_ILI9341::fillcircle(int x0, int y0, int r, int color)
dreschpe 0:da1bf437cbc1 346 {
mazgch 3:3d7298360e45 347 int x = -r, y = 0, err = 2-2*r, e2;
mazgch 3:3d7298360e45 348 do {
mazgch 3:3d7298360e45 349 vline(x0-x, y0-y, y0+y, color);
mazgch 3:3d7298360e45 350 vline(x0+x, y0-y, y0+y, color);
mazgch 3:3d7298360e45 351 e2 = err;
mazgch 3:3d7298360e45 352 if (e2 <= y) {
mazgch 3:3d7298360e45 353 err += ++y*2+1;
mazgch 3:3d7298360e45 354 if (-x == y && e2 <= x) e2 = 0;
mazgch 3:3d7298360e45 355 }
mazgch 3:3d7298360e45 356 if (e2 > x) err += ++x*2+1;
mazgch 3:3d7298360e45 357 } while (x <= 0);
dreschpe 0:da1bf437cbc1 358 }
dreschpe 0:da1bf437cbc1 359
dreschpe 0:da1bf437cbc1 360
dreschpe 0:da1bf437cbc1 361 void SPI_TFT_ILI9341::hline(int x0, int x1, int y, int color)
dreschpe 0:da1bf437cbc1 362 {
dreschpe 0:da1bf437cbc1 363 int w;
dreschpe 0:da1bf437cbc1 364 w = x1 - x0 + 1;
dreschpe 0:da1bf437cbc1 365 window(x0,y,w,1);
dreschpe 0:da1bf437cbc1 366 wr_cmd(0x2C); // send pixel
dreschpe 0:da1bf437cbc1 367 _spi.format(16,3); // switch to 16 bit Mode 3
dreschpe 0:da1bf437cbc1 368 int j;
dreschpe 0:da1bf437cbc1 369 for (j=0; j<w; j++) {
dreschpe 0:da1bf437cbc1 370 _spi.write(color);
dreschpe 0:da1bf437cbc1 371 }
dreschpe 0:da1bf437cbc1 372 _cs = 1;
dreschpe 0:da1bf437cbc1 373 _spi.format(8,3);
dreschpe 0:da1bf437cbc1 374 WindowMax();
dreschpe 0:da1bf437cbc1 375 return;
dreschpe 0:da1bf437cbc1 376 }
dreschpe 0:da1bf437cbc1 377
dreschpe 0:da1bf437cbc1 378 void SPI_TFT_ILI9341::vline(int x, int y0, int y1, int color)
dreschpe 0:da1bf437cbc1 379 {
dreschpe 0:da1bf437cbc1 380 int h;
dreschpe 0:da1bf437cbc1 381 h = y1 - y0 + 1;
dreschpe 0:da1bf437cbc1 382 window(x,y0,1,h);
dreschpe 0:da1bf437cbc1 383 wr_cmd(0x2C); // send pixel
dreschpe 0:da1bf437cbc1 384 _spi.format(16,3); // switch to 16 bit Mode 3
dreschpe 0:da1bf437cbc1 385 for (int y=0; y<h; y++) {
dreschpe 0:da1bf437cbc1 386 _spi.write(color);
dreschpe 0:da1bf437cbc1 387 }
dreschpe 0:da1bf437cbc1 388 _cs = 1;
dreschpe 0:da1bf437cbc1 389 _spi.format(8,3);
dreschpe 0:da1bf437cbc1 390 WindowMax();
dreschpe 0:da1bf437cbc1 391 return;
dreschpe 0:da1bf437cbc1 392 }
dreschpe 0:da1bf437cbc1 393
dreschpe 0:da1bf437cbc1 394
dreschpe 0:da1bf437cbc1 395
dreschpe 0:da1bf437cbc1 396 void SPI_TFT_ILI9341::line(int x0, int y0, int x1, int y1, int color)
dreschpe 0:da1bf437cbc1 397 {
dreschpe 0:da1bf437cbc1 398 //WindowMax();
dreschpe 0:da1bf437cbc1 399 int dx = 0, dy = 0;
dreschpe 0:da1bf437cbc1 400 int dx_sym = 0, dy_sym = 0;
dreschpe 0:da1bf437cbc1 401 int dx_x2 = 0, dy_x2 = 0;
dreschpe 0:da1bf437cbc1 402 int di = 0;
dreschpe 0:da1bf437cbc1 403
dreschpe 0:da1bf437cbc1 404 dx = x1-x0;
dreschpe 0:da1bf437cbc1 405 dy = y1-y0;
dreschpe 0:da1bf437cbc1 406
dreschpe 0:da1bf437cbc1 407 if (dx == 0) { /* vertical line */
dreschpe 0:da1bf437cbc1 408 if (y1 > y0) vline(x0,y0,y1,color);
dreschpe 0:da1bf437cbc1 409 else vline(x0,y1,y0,color);
dreschpe 0:da1bf437cbc1 410 return;
dreschpe 0:da1bf437cbc1 411 }
dreschpe 0:da1bf437cbc1 412
dreschpe 0:da1bf437cbc1 413 if (dx > 0) {
dreschpe 0:da1bf437cbc1 414 dx_sym = 1;
dreschpe 0:da1bf437cbc1 415 } else {
dreschpe 0:da1bf437cbc1 416 dx_sym = -1;
dreschpe 0:da1bf437cbc1 417 }
dreschpe 0:da1bf437cbc1 418 if (dy == 0) { /* horizontal line */
dreschpe 0:da1bf437cbc1 419 if (x1 > x0) hline(x0,x1,y0,color);
dreschpe 0:da1bf437cbc1 420 else hline(x1,x0,y0,color);
dreschpe 0:da1bf437cbc1 421 return;
dreschpe 0:da1bf437cbc1 422 }
dreschpe 0:da1bf437cbc1 423
dreschpe 0:da1bf437cbc1 424 if (dy > 0) {
dreschpe 0:da1bf437cbc1 425 dy_sym = 1;
dreschpe 0:da1bf437cbc1 426 } else {
dreschpe 0:da1bf437cbc1 427 dy_sym = -1;
dreschpe 0:da1bf437cbc1 428 }
dreschpe 0:da1bf437cbc1 429
dreschpe 0:da1bf437cbc1 430 dx = dx_sym*dx;
dreschpe 0:da1bf437cbc1 431 dy = dy_sym*dy;
dreschpe 0:da1bf437cbc1 432
dreschpe 0:da1bf437cbc1 433 dx_x2 = dx*2;
dreschpe 0:da1bf437cbc1 434 dy_x2 = dy*2;
dreschpe 0:da1bf437cbc1 435
dreschpe 0:da1bf437cbc1 436 if (dx >= dy) {
dreschpe 0:da1bf437cbc1 437 di = dy_x2 - dx;
dreschpe 0:da1bf437cbc1 438 while (x0 != x1) {
dreschpe 0:da1bf437cbc1 439
dreschpe 0:da1bf437cbc1 440 pixel(x0, y0, color);
dreschpe 0:da1bf437cbc1 441 x0 += dx_sym;
dreschpe 0:da1bf437cbc1 442 if (di<0) {
dreschpe 0:da1bf437cbc1 443 di += dy_x2;
dreschpe 0:da1bf437cbc1 444 } else {
dreschpe 0:da1bf437cbc1 445 di += dy_x2 - dx_x2;
dreschpe 0:da1bf437cbc1 446 y0 += dy_sym;
dreschpe 0:da1bf437cbc1 447 }
dreschpe 0:da1bf437cbc1 448 }
dreschpe 0:da1bf437cbc1 449 pixel(x0, y0, color);
dreschpe 0:da1bf437cbc1 450 } else {
dreschpe 0:da1bf437cbc1 451 di = dx_x2 - dy;
dreschpe 0:da1bf437cbc1 452 while (y0 != y1) {
dreschpe 0:da1bf437cbc1 453 pixel(x0, y0, color);
dreschpe 0:da1bf437cbc1 454 y0 += dy_sym;
dreschpe 0:da1bf437cbc1 455 if (di < 0) {
dreschpe 0:da1bf437cbc1 456 di += dx_x2;
dreschpe 0:da1bf437cbc1 457 } else {
dreschpe 0:da1bf437cbc1 458 di += dx_x2 - dy_x2;
dreschpe 0:da1bf437cbc1 459 x0 += dx_sym;
dreschpe 0:da1bf437cbc1 460 }
dreschpe 0:da1bf437cbc1 461 }
dreschpe 0:da1bf437cbc1 462 pixel(x0, y0, color);
dreschpe 0:da1bf437cbc1 463 }
dreschpe 0:da1bf437cbc1 464 return;
dreschpe 0:da1bf437cbc1 465 }
dreschpe 0:da1bf437cbc1 466
dreschpe 0:da1bf437cbc1 467
dreschpe 0:da1bf437cbc1 468 void SPI_TFT_ILI9341::rect(int x0, int y0, int x1, int y1, int color)
dreschpe 0:da1bf437cbc1 469 {
dreschpe 0:da1bf437cbc1 470
dreschpe 0:da1bf437cbc1 471 if (x1 > x0) hline(x0,x1,y0,color);
dreschpe 0:da1bf437cbc1 472 else hline(x1,x0,y0,color);
dreschpe 0:da1bf437cbc1 473
dreschpe 0:da1bf437cbc1 474 if (y1 > y0) vline(x0,y0,y1,color);
dreschpe 0:da1bf437cbc1 475 else vline(x0,y1,y0,color);
dreschpe 0:da1bf437cbc1 476
dreschpe 0:da1bf437cbc1 477 if (x1 > x0) hline(x0,x1,y1,color);
dreschpe 0:da1bf437cbc1 478 else hline(x1,x0,y1,color);
dreschpe 0:da1bf437cbc1 479
dreschpe 0:da1bf437cbc1 480 if (y1 > y0) vline(x1,y0,y1,color);
dreschpe 0:da1bf437cbc1 481 else vline(x1,y1,y0,color);
dreschpe 0:da1bf437cbc1 482
dreschpe 0:da1bf437cbc1 483 return;
dreschpe 0:da1bf437cbc1 484 }
dreschpe 0:da1bf437cbc1 485
dreschpe 0:da1bf437cbc1 486
dreschpe 0:da1bf437cbc1 487
dreschpe 0:da1bf437cbc1 488 void SPI_TFT_ILI9341::fillrect(int x0, int y0, int x1, int y1, int color)
dreschpe 0:da1bf437cbc1 489 {
dreschpe 0:da1bf437cbc1 490
dreschpe 0:da1bf437cbc1 491 int h = y1 - y0 + 1;
dreschpe 0:da1bf437cbc1 492 int w = x1 - x0 + 1;
dreschpe 0:da1bf437cbc1 493 int pixel = h * w;
dreschpe 0:da1bf437cbc1 494 window(x0,y0,w,h);
dreschpe 0:da1bf437cbc1 495 wr_cmd(0x2C); // send pixel
dreschpe 0:da1bf437cbc1 496 _spi.format(16,3); // switch to 16 bit Mode 3
dreschpe 0:da1bf437cbc1 497 for (int p=0; p<pixel; p++) {
dreschpe 0:da1bf437cbc1 498 _spi.write(color);
dreschpe 0:da1bf437cbc1 499 }
dreschpe 0:da1bf437cbc1 500 _cs = 1;
dreschpe 0:da1bf437cbc1 501 _spi.format(8,3);
dreschpe 0:da1bf437cbc1 502 WindowMax();
dreschpe 0:da1bf437cbc1 503 return;
dreschpe 0:da1bf437cbc1 504 }
dreschpe 0:da1bf437cbc1 505
dreschpe 0:da1bf437cbc1 506
dreschpe 0:da1bf437cbc1 507 void SPI_TFT_ILI9341::locate(int x, int y)
dreschpe 0:da1bf437cbc1 508 {
dreschpe 0:da1bf437cbc1 509 char_x = x;
dreschpe 0:da1bf437cbc1 510 char_y = y;
dreschpe 0:da1bf437cbc1 511 }
dreschpe 0:da1bf437cbc1 512
dreschpe 0:da1bf437cbc1 513
dreschpe 0:da1bf437cbc1 514
dreschpe 0:da1bf437cbc1 515 int SPI_TFT_ILI9341::columns()
dreschpe 0:da1bf437cbc1 516 {
dreschpe 0:da1bf437cbc1 517 return width() / font[1];
dreschpe 0:da1bf437cbc1 518 }
dreschpe 0:da1bf437cbc1 519
dreschpe 0:da1bf437cbc1 520
dreschpe 0:da1bf437cbc1 521
dreschpe 0:da1bf437cbc1 522 int SPI_TFT_ILI9341::rows()
dreschpe 0:da1bf437cbc1 523 {
dreschpe 0:da1bf437cbc1 524 return height() / font[2];
dreschpe 0:da1bf437cbc1 525 }
dreschpe 0:da1bf437cbc1 526
dreschpe 0:da1bf437cbc1 527
dreschpe 0:da1bf437cbc1 528
dreschpe 0:da1bf437cbc1 529 int SPI_TFT_ILI9341::_putc(int value)
dreschpe 0:da1bf437cbc1 530 {
dreschpe 0:da1bf437cbc1 531 if (value == '\n') { // new line
dreschpe 0:da1bf437cbc1 532 char_x = 0;
dreschpe 0:da1bf437cbc1 533 char_y = char_y + font[2];
dreschpe 0:da1bf437cbc1 534 if (char_y >= height() - font[2]) {
dreschpe 0:da1bf437cbc1 535 char_y = 0;
dreschpe 0:da1bf437cbc1 536 }
dreschpe 0:da1bf437cbc1 537 } else {
dreschpe 0:da1bf437cbc1 538 character(char_x, char_y, value);
dreschpe 0:da1bf437cbc1 539 }
dreschpe 0:da1bf437cbc1 540 return value;
dreschpe 0:da1bf437cbc1 541 }
dreschpe 0:da1bf437cbc1 542
dreschpe 0:da1bf437cbc1 543
dreschpe 0:da1bf437cbc1 544 void SPI_TFT_ILI9341::character(int x, int y, int c)
dreschpe 0:da1bf437cbc1 545 {
dreschpe 0:da1bf437cbc1 546 unsigned int hor,vert,offset,bpl,j,i,b;
dreschpe 0:da1bf437cbc1 547 unsigned char* zeichen;
dreschpe 0:da1bf437cbc1 548 unsigned char z,w;
dreschpe 0:da1bf437cbc1 549
dreschpe 0:da1bf437cbc1 550 if ((c < 31) || (c > 127)) return; // test char range
dreschpe 0:da1bf437cbc1 551
dreschpe 0:da1bf437cbc1 552 // read font parameter from start of array
dreschpe 0:da1bf437cbc1 553 offset = font[0]; // bytes / char
dreschpe 0:da1bf437cbc1 554 hor = font[1]; // get hor size of font
dreschpe 0:da1bf437cbc1 555 vert = font[2]; // get vert size of font
dreschpe 0:da1bf437cbc1 556 bpl = font[3]; // bytes per line
dreschpe 0:da1bf437cbc1 557
dreschpe 0:da1bf437cbc1 558 if (char_x + hor > width()) {
dreschpe 0:da1bf437cbc1 559 char_x = 0;
dreschpe 0:da1bf437cbc1 560 char_y = char_y + vert;
dreschpe 0:da1bf437cbc1 561 if (char_y >= height() - font[2]) {
dreschpe 0:da1bf437cbc1 562 char_y = 0;
dreschpe 0:da1bf437cbc1 563 }
dreschpe 0:da1bf437cbc1 564 }
dreschpe 0:da1bf437cbc1 565 window(char_x, char_y,hor,vert); // char box
dreschpe 0:da1bf437cbc1 566 wr_cmd(0x2C); // send pixel
dreschpe 0:da1bf437cbc1 567 _spi.format(16,3); // switch to 16 bit Mode 3
dreschpe 0:da1bf437cbc1 568 zeichen = &font[((c -32) * offset) + 4]; // start of char bitmap
dreschpe 0:da1bf437cbc1 569 w = zeichen[0]; // width of actual char
dreschpe 0:da1bf437cbc1 570 for (j=0; j<vert; j++) { // vert line
dreschpe 0:da1bf437cbc1 571 for (i=0; i<hor; i++) { // horz line
dreschpe 0:da1bf437cbc1 572 z = zeichen[bpl * i + ((j & 0xF8) >> 3)+1];
dreschpe 0:da1bf437cbc1 573 b = 1 << (j & 0x07);
dreschpe 0:da1bf437cbc1 574 if (( z & b ) == 0x00) {
dreschpe 0:da1bf437cbc1 575 _spi.write(_background);
dreschpe 0:da1bf437cbc1 576 } else {
dreschpe 0:da1bf437cbc1 577 _spi.write(_foreground);
dreschpe 0:da1bf437cbc1 578 }
dreschpe 0:da1bf437cbc1 579 }
dreschpe 0:da1bf437cbc1 580 }
dreschpe 0:da1bf437cbc1 581 _cs = 1;
dreschpe 0:da1bf437cbc1 582 _spi.format(8,3);
dreschpe 0:da1bf437cbc1 583 WindowMax();
dreschpe 0:da1bf437cbc1 584 if ((w + 2) < hor) { // x offset to next char
dreschpe 0:da1bf437cbc1 585 char_x += w + 2;
dreschpe 0:da1bf437cbc1 586 } else char_x += hor;
dreschpe 0:da1bf437cbc1 587 }
dreschpe 0:da1bf437cbc1 588
dreschpe 0:da1bf437cbc1 589
dreschpe 0:da1bf437cbc1 590 void SPI_TFT_ILI9341::set_font(unsigned char* f)
dreschpe 0:da1bf437cbc1 591 {
dreschpe 0:da1bf437cbc1 592 font = f;
dreschpe 0:da1bf437cbc1 593 }
dreschpe 0:da1bf437cbc1 594
dreschpe 0:da1bf437cbc1 595
dreschpe 0:da1bf437cbc1 596
dreschpe 0:da1bf437cbc1 597 void SPI_TFT_ILI9341::Bitmap(unsigned int x, unsigned int y, unsigned int w, unsigned int h,unsigned char *bitmap)
dreschpe 0:da1bf437cbc1 598 {
dreschpe 0:da1bf437cbc1 599 unsigned int j;
dreschpe 0:da1bf437cbc1 600 int padd;
dreschpe 0:da1bf437cbc1 601 unsigned short *bitmap_ptr = (unsigned short *)bitmap;
dreschpe 2:0a16083193a4 602 unsigned int i;
dreschpe 2:0a16083193a4 603
dreschpe 0:da1bf437cbc1 604 // the lines are padded to multiple of 4 bytes in a bitmap
dreschpe 0:da1bf437cbc1 605 padd = -1;
dreschpe 0:da1bf437cbc1 606 do {
dreschpe 0:da1bf437cbc1 607 padd ++;
dreschpe 0:da1bf437cbc1 608 } while (2*(w + padd)%4 != 0);
dreschpe 0:da1bf437cbc1 609 window(x, y, w, h);
dreschpe 2:0a16083193a4 610 bitmap_ptr += ((h - 1)* (w + padd));
dreschpe 0:da1bf437cbc1 611 wr_cmd(0x2C); // send pixel
dreschpe 0:da1bf437cbc1 612 _spi.format(16,3); // switch to 16 bit Mode 3
dreschpe 2:0a16083193a4 613 for (j = 0; j < h; j++) { //Lines
dreschpe 2:0a16083193a4 614 for (i = 0; i < w; i++) { // one line
dreschpe 2:0a16083193a4 615 _spi.write(*bitmap_ptr); // copy pixel data to TFT
dreschpe 0:da1bf437cbc1 616 bitmap_ptr++;
dreschpe 0:da1bf437cbc1 617 }
dreschpe 0:da1bf437cbc1 618 bitmap_ptr -= 2*w;
dreschpe 0:da1bf437cbc1 619 bitmap_ptr -= padd;
dreschpe 0:da1bf437cbc1 620 }
dreschpe 0:da1bf437cbc1 621 _cs = 1;
dreschpe 0:da1bf437cbc1 622 _spi.format(8,3);
dreschpe 0:da1bf437cbc1 623 WindowMax();
dreschpe 0:da1bf437cbc1 624 }
dreschpe 0:da1bf437cbc1 625
dreschpe 0:da1bf437cbc1 626
dreschpe 0:da1bf437cbc1 627 int SPI_TFT_ILI9341::BMP_16(unsigned int x, unsigned int y, const char *Name_BMP)
dreschpe 0:da1bf437cbc1 628 {
dreschpe 0:da1bf437cbc1 629
dreschpe 0:da1bf437cbc1 630 #define OffsetPixelWidth 18
dreschpe 0:da1bf437cbc1 631 #define OffsetPixelHeigh 22
dreschpe 0:da1bf437cbc1 632 #define OffsetFileSize 34
dreschpe 0:da1bf437cbc1 633 #define OffsetPixData 10
dreschpe 0:da1bf437cbc1 634 #define OffsetBPP 28
dreschpe 0:da1bf437cbc1 635
dreschpe 0:da1bf437cbc1 636 char filename[50];
dreschpe 0:da1bf437cbc1 637 unsigned char BMP_Header[54];
dreschpe 0:da1bf437cbc1 638 unsigned short BPP_t;
dreschpe 0:da1bf437cbc1 639 unsigned int PixelWidth,PixelHeigh,start_data;
dreschpe 0:da1bf437cbc1 640 unsigned int i,off;
dreschpe 0:da1bf437cbc1 641 int padd,j;
dreschpe 0:da1bf437cbc1 642 unsigned short *line;
dreschpe 0:da1bf437cbc1 643
dreschpe 0:da1bf437cbc1 644 // get the filename
dreschpe 0:da1bf437cbc1 645 LocalFileSystem local("local");
dreschpe 0:da1bf437cbc1 646 sprintf(&filename[0],"/local/");
dreschpe 0:da1bf437cbc1 647 i=7;
dreschpe 0:da1bf437cbc1 648 while (*Name_BMP!='\0') {
dreschpe 0:da1bf437cbc1 649 filename[i++]=*Name_BMP++;
dreschpe 0:da1bf437cbc1 650 }
dreschpe 0:da1bf437cbc1 651
dreschpe 0:da1bf437cbc1 652 fprintf(stderr, "filename : %s \n\r",filename);
dreschpe 0:da1bf437cbc1 653
dreschpe 0:da1bf437cbc1 654 FILE *Image = fopen((const char *)&filename[0], "rb"); // open the bmp file
dreschpe 0:da1bf437cbc1 655 if (!Image) {
dreschpe 0:da1bf437cbc1 656 return(0); // error file not found !
dreschpe 0:da1bf437cbc1 657 }
dreschpe 0:da1bf437cbc1 658
dreschpe 0:da1bf437cbc1 659 fread(&BMP_Header[0],1,54,Image); // get the BMP Header
dreschpe 0:da1bf437cbc1 660
dreschpe 0:da1bf437cbc1 661 if (BMP_Header[0] != 0x42 || BMP_Header[1] != 0x4D) { // check magic byte
dreschpe 0:da1bf437cbc1 662 fclose(Image);
dreschpe 0:da1bf437cbc1 663 return(-1); // error no BMP file
dreschpe 0:da1bf437cbc1 664 }
dreschpe 0:da1bf437cbc1 665
dreschpe 0:da1bf437cbc1 666 BPP_t = BMP_Header[OffsetBPP] + (BMP_Header[OffsetBPP + 1] << 8);
dreschpe 0:da1bf437cbc1 667 if (BPP_t != 0x0010) {
dreschpe 0:da1bf437cbc1 668 fclose(Image);
dreschpe 0:da1bf437cbc1 669 return(-2); // error no 16 bit BMP
dreschpe 0:da1bf437cbc1 670 }
dreschpe 0:da1bf437cbc1 671
dreschpe 0:da1bf437cbc1 672 PixelHeigh = BMP_Header[OffsetPixelHeigh] + (BMP_Header[OffsetPixelHeigh + 1] << 8) + (BMP_Header[OffsetPixelHeigh + 2] << 16) + (BMP_Header[OffsetPixelHeigh + 3] << 24);
dreschpe 0:da1bf437cbc1 673 PixelWidth = BMP_Header[OffsetPixelWidth] + (BMP_Header[OffsetPixelWidth + 1] << 8) + (BMP_Header[OffsetPixelWidth + 2] << 16) + (BMP_Header[OffsetPixelWidth + 3] << 24);
dreschpe 0:da1bf437cbc1 674 if (PixelHeigh > height() + y || PixelWidth > width() + x) {
dreschpe 0:da1bf437cbc1 675 fclose(Image);
dreschpe 0:da1bf437cbc1 676 return(-3); // to big
dreschpe 0:da1bf437cbc1 677 }
dreschpe 0:da1bf437cbc1 678
dreschpe 0:da1bf437cbc1 679 start_data = BMP_Header[OffsetPixData] + (BMP_Header[OffsetPixData + 1] << 8) + (BMP_Header[OffsetPixData + 2] << 16) + (BMP_Header[OffsetPixData + 3] << 24);
dreschpe 0:da1bf437cbc1 680
dreschpe 0:da1bf437cbc1 681 line = (unsigned short *) malloc (2 * PixelWidth); // we need a buffer for a line
dreschpe 0:da1bf437cbc1 682 if (line == NULL) {
dreschpe 0:da1bf437cbc1 683 return(-4); // error no memory
dreschpe 0:da1bf437cbc1 684 }
dreschpe 0:da1bf437cbc1 685
dreschpe 0:da1bf437cbc1 686 // the bmp lines are padded to multiple of 4 bytes
dreschpe 0:da1bf437cbc1 687 padd = -1;
dreschpe 0:da1bf437cbc1 688 do {
dreschpe 0:da1bf437cbc1 689 padd ++;
dreschpe 0:da1bf437cbc1 690 } while ((PixelWidth * 2 + padd)%4 != 0);
dreschpe 0:da1bf437cbc1 691
dreschpe 0:da1bf437cbc1 692
dreschpe 0:da1bf437cbc1 693 //fseek(Image, 70 ,SEEK_SET);
dreschpe 0:da1bf437cbc1 694 window(x, y,PixelWidth ,PixelHeigh);
dreschpe 0:da1bf437cbc1 695 wr_cmd(0x2C); // send pixel
dreschpe 0:da1bf437cbc1 696 _spi.format(16,3); // switch to 16 bit Mode 3
dreschpe 0:da1bf437cbc1 697 for (j = PixelHeigh - 1; j >= 0; j--) { //Lines bottom up
dreschpe 0:da1bf437cbc1 698 off = j * (PixelWidth * 2 + padd) + start_data; // start of line
dreschpe 0:da1bf437cbc1 699 fseek(Image, off ,SEEK_SET);
dreschpe 0:da1bf437cbc1 700 fread(line,1,PixelWidth * 2,Image); // read a line - slow !
dreschpe 0:da1bf437cbc1 701 for (i = 0; i < PixelWidth; i++) { // copy pixel data to TFT
dreschpe 0:da1bf437cbc1 702 _spi.write(line[i]); // one 16 bit pixel
dreschpe 0:da1bf437cbc1 703 }
dreschpe 0:da1bf437cbc1 704 }
dreschpe 0:da1bf437cbc1 705 _cs = 1;
dreschpe 0:da1bf437cbc1 706 _spi.format(8,3);
dreschpe 0:da1bf437cbc1 707 free (line);
dreschpe 0:da1bf437cbc1 708 fclose(Image);
dreschpe 0:da1bf437cbc1 709 WindowMax();
dreschpe 0:da1bf437cbc1 710 return(1);
dreschpe 0:da1bf437cbc1 711 }