OptoLab / UniGraphic

Display

Dependents:   Termocamera_ironblack

Graphics/GraphicsDisplay.cpp@0:75ec1b3cde17, 2015-02-12 (annotated)

Committer:
Geremia
Date:
Thu Feb 12 22:22:47 2015 +0000
Revision:
0:75ec1b3cde17
Child:
2:713844a55c4e
Initial tests, LCD par and spi ok

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Geremia 0:75ec1b3cde17 1 /* mbed GraphicsDisplay Display Library Base Class
Geremia 0:75ec1b3cde17 2 * Copyright (c) 2007-2009 sford
Geremia 0:75ec1b3cde17 3 * Released under the MIT License: http://mbed.org/license/mit
Geremia 0:75ec1b3cde17 4 */
Geremia 0:75ec1b3cde17 5
Geremia 0:75ec1b3cde17 6 #include "GraphicsDisplay.h"
Geremia 0:75ec1b3cde17 7 #define SWAP(a, b) { a ^= b; b ^= a; a ^= b; }
Geremia 0:75ec1b3cde17 8 GraphicsDisplay::GraphicsDisplay(const char *name):TextDisplay(name) {
Geremia 0:75ec1b3cde17 9 set_font((unsigned char*)Terminal6x8);
Geremia 0:75ec1b3cde17 10 foreground(0xFFFF);
Geremia 0:75ec1b3cde17 11 background(0x0000);
Geremia 0:75ec1b3cde17 12 char_x = 0;
Geremia 0:75ec1b3cde17 13 char_y = 0;
Geremia 0:75ec1b3cde17 14 oriented_width=0;
Geremia 0:75ec1b3cde17 15 oriented_height=0;
Geremia 0:75ec1b3cde17 16 auto_up = true;
Geremia 0:75ec1b3cde17 17 }
Geremia 0:75ec1b3cde17 18
Geremia 0:75ec1b3cde17 19 void GraphicsDisplay::WindowMax (void)
Geremia 0:75ec1b3cde17 20 {
Geremia 0:75ec1b3cde17 21 window (0, 0, oriented_width, oriented_height);
Geremia 0:75ec1b3cde17 22 }
Geremia 0:75ec1b3cde17 23 void GraphicsDisplay::set_width(int width)
Geremia 0:75ec1b3cde17 24 {
Geremia 0:75ec1b3cde17 25 oriented_width = width;
Geremia 0:75ec1b3cde17 26 }
Geremia 0:75ec1b3cde17 27 void GraphicsDisplay::set_height(int height)
Geremia 0:75ec1b3cde17 28 {
Geremia 0:75ec1b3cde17 29 oriented_height = height;
Geremia 0:75ec1b3cde17 30 }
Geremia 0:75ec1b3cde17 31 int GraphicsDisplay::width()
Geremia 0:75ec1b3cde17 32 {
Geremia 0:75ec1b3cde17 33 return oriented_width;
Geremia 0:75ec1b3cde17 34 }
Geremia 0:75ec1b3cde17 35 int GraphicsDisplay::height()
Geremia 0:75ec1b3cde17 36 {
Geremia 0:75ec1b3cde17 37 return oriented_height;
Geremia 0:75ec1b3cde17 38 }
Geremia 0:75ec1b3cde17 39 void GraphicsDisplay::circle(int x0, int y0, int r, unsigned short color)
Geremia 0:75ec1b3cde17 40 {
Geremia 0:75ec1b3cde17 41 int x = -r, y = 0, err = 2-2*r, e2;
Geremia 0:75ec1b3cde17 42 do {
Geremia 0:75ec1b3cde17 43 pixel(x0-x, y0+y,color);
Geremia 0:75ec1b3cde17 44 pixel(x0+x, y0+y,color);
Geremia 0:75ec1b3cde17 45 pixel(x0+x, y0-y,color);
Geremia 0:75ec1b3cde17 46 pixel(x0-x, y0-y,color);
Geremia 0:75ec1b3cde17 47 e2 = err;
Geremia 0:75ec1b3cde17 48 if (e2 <= y) {
Geremia 0:75ec1b3cde17 49 err += ++y*2+1;
Geremia 0:75ec1b3cde17 50 if (-x == y && e2 <= x) e2 = 0;
Geremia 0:75ec1b3cde17 51 }
Geremia 0:75ec1b3cde17 52 if (e2 > x) err += ++x*2+1;
Geremia 0:75ec1b3cde17 53 } while (x <= 0);
Geremia 0:75ec1b3cde17 54 if(auto_up) copy_to_lcd();
Geremia 0:75ec1b3cde17 55 }
Geremia 0:75ec1b3cde17 56 void GraphicsDisplay::fillcircle(int x0, int y0, int r, unsigned short color)
Geremia 0:75ec1b3cde17 57 {
Geremia 0:75ec1b3cde17 58 bool old_auto_up=auto_up;
Geremia 0:75ec1b3cde17 59 if(auto_up) auto_up=false;
Geremia 0:75ec1b3cde17 60 int x = -r, y = 0, err = 2-2*r, e2;
Geremia 0:75ec1b3cde17 61 do {
Geremia 0:75ec1b3cde17 62 vline(x0-x, y0-y, y0+y, color);
Geremia 0:75ec1b3cde17 63 vline(x0+x, y0-y, y0+y, color);
Geremia 0:75ec1b3cde17 64 e2 = err;
Geremia 0:75ec1b3cde17 65 if (e2 <= y) {
Geremia 0:75ec1b3cde17 66 err += ++y*2+1;
Geremia 0:75ec1b3cde17 67 if (-x == y && e2 <= x) e2 = 0;
Geremia 0:75ec1b3cde17 68 }
Geremia 0:75ec1b3cde17 69 if (e2 > x) err += ++x*2+1;
Geremia 0:75ec1b3cde17 70 } while (x <= 0);
Geremia 0:75ec1b3cde17 71 if(old_auto_up)
Geremia 0:75ec1b3cde17 72 {
Geremia 0:75ec1b3cde17 73 auto_up=true;
Geremia 0:75ec1b3cde17 74 copy_to_lcd();
Geremia 0:75ec1b3cde17 75 }
Geremia 0:75ec1b3cde17 76 }
Geremia 0:75ec1b3cde17 77 void GraphicsDisplay::hline(int x0, int x1, int y, unsigned short color)
Geremia 0:75ec1b3cde17 78 {
Geremia 0:75ec1b3cde17 79 int len;
Geremia 0:75ec1b3cde17 80 len = x1 - x0 + 1;
Geremia 0:75ec1b3cde17 81 window(x0,y,len,1);
Geremia 0:75ec1b3cde17 82 for (int j=0; j<len; j++) window_pushpixel(color);
Geremia 0:75ec1b3cde17 83 if(auto_up) copy_to_lcd();
Geremia 0:75ec1b3cde17 84 return;
Geremia 0:75ec1b3cde17 85 }
Geremia 0:75ec1b3cde17 86 void GraphicsDisplay::vline(int x, int y0, int y1, unsigned short color)
Geremia 0:75ec1b3cde17 87 {
Geremia 0:75ec1b3cde17 88 int len;
Geremia 0:75ec1b3cde17 89 len = y1 - y0 + 1;
Geremia 0:75ec1b3cde17 90 window(x,y0,1,len);
Geremia 0:75ec1b3cde17 91 for (int y=0; y<len; y++) window_pushpixel(color);
Geremia 0:75ec1b3cde17 92 if(auto_up) copy_to_lcd();
Geremia 0:75ec1b3cde17 93 return;
Geremia 0:75ec1b3cde17 94 }
Geremia 0:75ec1b3cde17 95 void GraphicsDisplay::line(int x0, int y0, int x1, int y1, unsigned short color)
Geremia 0:75ec1b3cde17 96 {
Geremia 0:75ec1b3cde17 97 //WindowMax();
Geremia 0:75ec1b3cde17 98 int dx = 0, dy = 0;
Geremia 0:75ec1b3cde17 99 int dx_sym = 0, dy_sym = 0;
Geremia 0:75ec1b3cde17 100 int dx_x2 = 0, dy_x2 = 0;
Geremia 0:75ec1b3cde17 101 int di = 0;
Geremia 0:75ec1b3cde17 102
Geremia 0:75ec1b3cde17 103 dx = x1-x0;
Geremia 0:75ec1b3cde17 104 dy = y1-y0;
Geremia 0:75ec1b3cde17 105
Geremia 0:75ec1b3cde17 106 if (dx == 0) { /* vertical line */
Geremia 0:75ec1b3cde17 107 if (y1 < y0) SWAP(y0,y1);
Geremia 0:75ec1b3cde17 108 vline(x0,y0,y1,color);
Geremia 0:75ec1b3cde17 109 return;
Geremia 0:75ec1b3cde17 110 }
Geremia 0:75ec1b3cde17 111
Geremia 0:75ec1b3cde17 112 if (dx > 0) {
Geremia 0:75ec1b3cde17 113 dx_sym = 1;
Geremia 0:75ec1b3cde17 114 } else {
Geremia 0:75ec1b3cde17 115 dx_sym = -1;
Geremia 0:75ec1b3cde17 116 }
Geremia 0:75ec1b3cde17 117 if (dy == 0) { /* horizontal line */
Geremia 0:75ec1b3cde17 118 if (x1 < x0) SWAP(x1,x0);
Geremia 0:75ec1b3cde17 119 hline(x0,x1,y0,color);
Geremia 0:75ec1b3cde17 120 return;
Geremia 0:75ec1b3cde17 121 }
Geremia 0:75ec1b3cde17 122
Geremia 0:75ec1b3cde17 123 if (dy > 0) {
Geremia 0:75ec1b3cde17 124 dy_sym = 1;
Geremia 0:75ec1b3cde17 125 } else {
Geremia 0:75ec1b3cde17 126 dy_sym = -1;
Geremia 0:75ec1b3cde17 127 }
Geremia 0:75ec1b3cde17 128
Geremia 0:75ec1b3cde17 129 dx = dx_sym*dx;
Geremia 0:75ec1b3cde17 130 dy = dy_sym*dy;
Geremia 0:75ec1b3cde17 131
Geremia 0:75ec1b3cde17 132 dx_x2 = dx*2;
Geremia 0:75ec1b3cde17 133 dy_x2 = dy*2;
Geremia 0:75ec1b3cde17 134
Geremia 0:75ec1b3cde17 135 if (dx >= dy) {
Geremia 0:75ec1b3cde17 136 di = dy_x2 - dx;
Geremia 0:75ec1b3cde17 137 while (x0 != x1) {
Geremia 0:75ec1b3cde17 138
Geremia 0:75ec1b3cde17 139 pixel(x0, y0, color);
Geremia 0:75ec1b3cde17 140 x0 += dx_sym;
Geremia 0:75ec1b3cde17 141 if (di<0) {
Geremia 0:75ec1b3cde17 142 di += dy_x2;
Geremia 0:75ec1b3cde17 143 } else {
Geremia 0:75ec1b3cde17 144 di += dy_x2 - dx_x2;
Geremia 0:75ec1b3cde17 145 y0 += dy_sym;
Geremia 0:75ec1b3cde17 146 }
Geremia 0:75ec1b3cde17 147 }
Geremia 0:75ec1b3cde17 148 pixel(x0, y0, color);
Geremia 0:75ec1b3cde17 149 } else {
Geremia 0:75ec1b3cde17 150 di = dx_x2 - dy;
Geremia 0:75ec1b3cde17 151 while (y0 != y1) {
Geremia 0:75ec1b3cde17 152 pixel(x0, y0, color);
Geremia 0:75ec1b3cde17 153 y0 += dy_sym;
Geremia 0:75ec1b3cde17 154 if (di < 0) {
Geremia 0:75ec1b3cde17 155 di += dx_x2;
Geremia 0:75ec1b3cde17 156 } else {
Geremia 0:75ec1b3cde17 157 di += dx_x2 - dy_x2;
Geremia 0:75ec1b3cde17 158 x0 += dx_sym;
Geremia 0:75ec1b3cde17 159 }
Geremia 0:75ec1b3cde17 160 }
Geremia 0:75ec1b3cde17 161 pixel(x0, y0, color);
Geremia 0:75ec1b3cde17 162 }
Geremia 0:75ec1b3cde17 163 if(auto_up) copy_to_lcd();
Geremia 0:75ec1b3cde17 164 return;
Geremia 0:75ec1b3cde17 165 }
Geremia 0:75ec1b3cde17 166 void GraphicsDisplay::rect(int x0, int y0, int x1, int y1, unsigned short color)
Geremia 0:75ec1b3cde17 167 {
Geremia 0:75ec1b3cde17 168 bool old_auto_up=auto_up;
Geremia 0:75ec1b3cde17 169 if(auto_up) auto_up=0;
Geremia 0:75ec1b3cde17 170 if (x1 > x0) hline(x0,x1,y0,color);
Geremia 0:75ec1b3cde17 171 else hline(x1,x0,y0,color);
Geremia 0:75ec1b3cde17 172
Geremia 0:75ec1b3cde17 173 if (y1 > y0) vline(x0,y0,y1,color);
Geremia 0:75ec1b3cde17 174 else vline(x0,y1,y0,color);
Geremia 0:75ec1b3cde17 175
Geremia 0:75ec1b3cde17 176 if (x1 > x0) hline(x0,x1,y1,color);
Geremia 0:75ec1b3cde17 177 else hline(x1,x0,y1,color);
Geremia 0:75ec1b3cde17 178
Geremia 0:75ec1b3cde17 179 if (y1 > y0) vline(x1,y0,y1,color);
Geremia 0:75ec1b3cde17 180 else vline(x1,y1,y0,color);
Geremia 0:75ec1b3cde17 181 if(old_auto_up)
Geremia 0:75ec1b3cde17 182 {
Geremia 0:75ec1b3cde17 183 auto_up=true;
Geremia 0:75ec1b3cde17 184 copy_to_lcd();
Geremia 0:75ec1b3cde17 185 }
Geremia 0:75ec1b3cde17 186 return;
Geremia 0:75ec1b3cde17 187 }
Geremia 0:75ec1b3cde17 188 void GraphicsDisplay::fillrect(int x0, int y0, int x1, int y1, unsigned short color)
Geremia 0:75ec1b3cde17 189 {
Geremia 0:75ec1b3cde17 190 if(x0 > x1) SWAP(x0,x1);
Geremia 0:75ec1b3cde17 191 if(y0 > y1) SWAP(y0,y1);
Geremia 0:75ec1b3cde17 192
Geremia 0:75ec1b3cde17 193 int h = y1 - y0 + 1;
Geremia 0:75ec1b3cde17 194 int w = x1 - x0 + 1;
Geremia 0:75ec1b3cde17 195 unsigned int pixels = h * w;
Geremia 0:75ec1b3cde17 196 window(x0,y0,w,h);
Geremia 0:75ec1b3cde17 197 for (unsigned int p=0; p<pixels; p++) window_pushpixel(color);
Geremia 0:75ec1b3cde17 198 if(auto_up) copy_to_lcd();
Geremia 0:75ec1b3cde17 199 return;
Geremia 0:75ec1b3cde17 200 }
Geremia 0:75ec1b3cde17 201 void GraphicsDisplay::locate(int x, int y)
Geremia 0:75ec1b3cde17 202 {
Geremia 0:75ec1b3cde17 203 char_x = x;
Geremia 0:75ec1b3cde17 204 char_y = y;
Geremia 0:75ec1b3cde17 205 }
Geremia 0:75ec1b3cde17 206 int GraphicsDisplay::columns()
Geremia 0:75ec1b3cde17 207 {
Geremia 0:75ec1b3cde17 208 return oriented_width / fonthor;
Geremia 0:75ec1b3cde17 209 }
Geremia 0:75ec1b3cde17 210 int GraphicsDisplay::rows()
Geremia 0:75ec1b3cde17 211 {
Geremia 0:75ec1b3cde17 212 return oriented_height / fontvert;
Geremia 0:75ec1b3cde17 213 }
Geremia 0:75ec1b3cde17 214 void GraphicsDisplay::set_font(unsigned char* f, unsigned char firstascii, unsigned char lastascii)
Geremia 0:75ec1b3cde17 215 {
Geremia 0:75ec1b3cde17 216 font = f;
Geremia 0:75ec1b3cde17 217 // read font parameter from start of array
Geremia 0:75ec1b3cde17 218 //fontoffset = font[0]; // bytes / char
Geremia 0:75ec1b3cde17 219 fonthor = font[1]; // get hor size of font
Geremia 0:75ec1b3cde17 220 fontvert = font[2]; // get vert size of font
Geremia 0:75ec1b3cde17 221 //fontbpl = font[3]; // bytes per line
Geremia 0:75ec1b3cde17 222 fontbpl = (fontvert+7)>>3; //bytes per line, rounded up to multiple of 8
Geremia 0:75ec1b3cde17 223 fontoffset = (fonthor*fontbpl)+1;
Geremia 0:75ec1b3cde17 224 firstch = firstascii; // first ascii code present in font array (usually 32)
Geremia 0:75ec1b3cde17 225 lastch = lastascii; // last ascii code present in font array (usually 127)
Geremia 0:75ec1b3cde17 226 }
Geremia 0:75ec1b3cde17 227 int GraphicsDisplay::_putc(int value)
Geremia 0:75ec1b3cde17 228 {
Geremia 0:75ec1b3cde17 229 if (value == '\n') { // new line
Geremia 0:75ec1b3cde17 230 char_x = 0;
Geremia 0:75ec1b3cde17 231 char_y = char_y + fontvert;
Geremia 0:75ec1b3cde17 232 if (char_y >= oriented_height - fontvert) {
Geremia 0:75ec1b3cde17 233 char_y = 0;
Geremia 0:75ec1b3cde17 234 }
Geremia 0:75ec1b3cde17 235 } else {
Geremia 0:75ec1b3cde17 236 character(char_x, char_y, value);
Geremia 0:75ec1b3cde17 237 if(auto_up) copy_to_lcd();
Geremia 0:75ec1b3cde17 238 }
Geremia 0:75ec1b3cde17 239 return value;
Geremia 0:75ec1b3cde17 240 }
Geremia 0:75ec1b3cde17 241 void GraphicsDisplay::character(int x, int y, int c)
Geremia 0:75ec1b3cde17 242 {
Geremia 0:75ec1b3cde17 243 char_x=x;
Geremia 0:75ec1b3cde17 244 char_y=y;
Geremia 0:75ec1b3cde17 245 int j,i,b;
Geremia 0:75ec1b3cde17 246 unsigned char* zeichen;
Geremia 0:75ec1b3cde17 247 unsigned char z,w;
Geremia 0:75ec1b3cde17 248
Geremia 0:75ec1b3cde17 249 if ((c < firstch) || (c > lastch)) return; // test char range
Geremia 0:75ec1b3cde17 250
Geremia 0:75ec1b3cde17 251 /* // read font parameter from start of array
Geremia 0:75ec1b3cde17 252 offset = font[0]; // bytes / char
Geremia 0:75ec1b3cde17 253 hor = font[1]; // get hor size of font
Geremia 0:75ec1b3cde17 254 vert = font[2]; // get vert size of font
Geremia 0:75ec1b3cde17 255 bpl = font[3]; // bytes per line
Geremia 0:75ec1b3cde17 256 */
Geremia 0:75ec1b3cde17 257 if (char_x + fonthor > oriented_width) {
Geremia 0:75ec1b3cde17 258 char_x = 0;
Geremia 0:75ec1b3cde17 259 char_y = char_y + fontvert;
Geremia 0:75ec1b3cde17 260 if (char_y > oriented_height - fontvert) {
Geremia 0:75ec1b3cde17 261 char_y = 0;
Geremia 0:75ec1b3cde17 262 }
Geremia 0:75ec1b3cde17 263 }
Geremia 0:75ec1b3cde17 264 window(char_x, char_y,fonthor,fontvert); // char box
Geremia 0:75ec1b3cde17 265 zeichen = &font[((c-firstch) * fontoffset) + 4]; // start of char bitmap
Geremia 0:75ec1b3cde17 266 w = zeichen[0]; // width of actual char
Geremia 0:75ec1b3cde17 267 // construct the char into the buffer
Geremia 0:75ec1b3cde17 268 for (j=0; j<fontvert; j++) { // vert line
Geremia 0:75ec1b3cde17 269 for (i=0; i<fonthor; i++) { // horz line
Geremia 0:75ec1b3cde17 270 z = zeichen[(fontbpl * i) + ((j & 0xF8) >> 3)+1];
Geremia 0:75ec1b3cde17 271 b = 1 << (j & 0x07);
Geremia 0:75ec1b3cde17 272 if (( z & b ) == 0x00) {
Geremia 0:75ec1b3cde17 273 // pixel(char_x+i,char_y+j,0);
Geremia 0:75ec1b3cde17 274 window_pushpixel(_background);
Geremia 0:75ec1b3cde17 275 } else {
Geremia 0:75ec1b3cde17 276 // pixel(char_x+i,char_y+j,1);
Geremia 0:75ec1b3cde17 277 window_pushpixel(_foreground);
Geremia 0:75ec1b3cde17 278 }
Geremia 0:75ec1b3cde17 279 }
Geremia 0:75ec1b3cde17 280 }
Geremia 0:75ec1b3cde17 281 char_x += w;
Geremia 0:75ec1b3cde17 282 }
Geremia 0:75ec1b3cde17 283 void GraphicsDisplay::Bitmap_BW(Bitmap_s bm, int x, int y)
Geremia 0:75ec1b3cde17 284 {
Geremia 0:75ec1b3cde17 285 int h,v,b;
Geremia 0:75ec1b3cde17 286 // int cropX;
Geremia 0:75ec1b3cde17 287 char d;
Geremia 0:75ec1b3cde17 288 if(x<0) x=0;
Geremia 0:75ec1b3cde17 289 if(y<0) y=0;
Geremia 0:75ec1b3cde17 290 int cropX = (x+bm.xSize)-oriented_width;
Geremia 0:75ec1b3cde17 291 if(cropX<0) cropX=0;
Geremia 0:75ec1b3cde17 292 window(x, y, bm.xSize-cropX, bm.ySize);
Geremia 0:75ec1b3cde17 293 for(v=0; v < bm.ySize; v++) { // lines
Geremia 0:75ec1b3cde17 294 if((v + y) >= oriented_height) break; // no need to crop Y
Geremia 0:75ec1b3cde17 295 for(h=0; h < bm.xSize; h++) { // pixel
Geremia 0:75ec1b3cde17 296 if((h + x) >= oriented_width) break;
Geremia 0:75ec1b3cde17 297 d = bm.data[bm.Byte_in_Line * v + ((h & 0xF8) >> 3)];
Geremia 0:75ec1b3cde17 298 b = 0x80 >> (h & 0x07);
Geremia 0:75ec1b3cde17 299 if((d & b) == 0) {
Geremia 0:75ec1b3cde17 300 window_pushpixel(_background);
Geremia 0:75ec1b3cde17 301 } else {
Geremia 0:75ec1b3cde17 302 window_pushpixel(_foreground);
Geremia 0:75ec1b3cde17 303 }
Geremia 0:75ec1b3cde17 304 }
Geremia 0:75ec1b3cde17 305 }
Geremia 0:75ec1b3cde17 306 if(auto_up) copy_to_lcd();
Geremia 0:75ec1b3cde17 307 }
Geremia 0:75ec1b3cde17 308 void GraphicsDisplay::Bitmap(int x, int y, int w, int h,unsigned char *bitmap)
Geremia 0:75ec1b3cde17 309 {
Geremia 0:75ec1b3cde17 310 int j,i;
Geremia 0:75ec1b3cde17 311 int padd;
Geremia 0:75ec1b3cde17 312 unsigned short *bitmap_ptr = (unsigned short *)bitmap;
Geremia 0:75ec1b3cde17 313 // unsigned short i;
Geremia 0:75ec1b3cde17 314
Geremia 0:75ec1b3cde17 315 // the lines are padded to multiple of 4 bytes in a bitmap
Geremia 0:75ec1b3cde17 316 padd = -1;
Geremia 0:75ec1b3cde17 317 do {
Geremia 0:75ec1b3cde17 318 padd ++;
Geremia 0:75ec1b3cde17 319 } while (2*(w + padd)%4 != 0);
Geremia 0:75ec1b3cde17 320 if(x<0) x=0;
Geremia 0:75ec1b3cde17 321 if(y<0) y=0;
Geremia 0:75ec1b3cde17 322 int cropX = (x+w)-oriented_width;
Geremia 0:75ec1b3cde17 323 if(cropX<0) cropX=0;
Geremia 0:75ec1b3cde17 324 window(x, y, w-cropX, h);
Geremia 0:75ec1b3cde17 325 bitmap_ptr += ((h - 1)* (w + padd));
Geremia 0:75ec1b3cde17 326 // wr_cmd(0x2C); // send pixel
Geremia 0:75ec1b3cde17 327 for (j = 0; j < h; j++) { //Lines
Geremia 0:75ec1b3cde17 328 if((h + y) >= oriented_height) break; // no need to crop Y
Geremia 0:75ec1b3cde17 329 for (i = 0; i < w; i++) { // one line
Geremia 0:75ec1b3cde17 330 if((w + x) < oriented_width) window_pushpixel(*bitmap_ptr);
Geremia 0:75ec1b3cde17 331 bitmap_ptr++;
Geremia 0:75ec1b3cde17 332 }
Geremia 0:75ec1b3cde17 333 bitmap_ptr -= 2*w;
Geremia 0:75ec1b3cde17 334 bitmap_ptr -= padd;
Geremia 0:75ec1b3cde17 335 }
Geremia 0:75ec1b3cde17 336 if(auto_up) copy_to_lcd();
Geremia 0:75ec1b3cde17 337 }
Geremia 0:75ec1b3cde17 338 // local filesystem is not implemented in kinetis board , but you can add a SD card
Geremia 0:75ec1b3cde17 339
Geremia 0:75ec1b3cde17 340 int GraphicsDisplay::BMP_16(int x, int y, const char *Name_BMP)
Geremia 0:75ec1b3cde17 341 {
Geremia 0:75ec1b3cde17 342
Geremia 0:75ec1b3cde17 343 #define OffsetPixelWidth 18
Geremia 0:75ec1b3cde17 344 #define OffsetPixelHeigh 22
Geremia 0:75ec1b3cde17 345 #define OffsetFileSize 34
Geremia 0:75ec1b3cde17 346 #define OffsetPixData 10
Geremia 0:75ec1b3cde17 347 #define OffsetBPP 28
Geremia 0:75ec1b3cde17 348
Geremia 0:75ec1b3cde17 349 char filename[50];
Geremia 0:75ec1b3cde17 350 unsigned char BMP_Header[54];
Geremia 0:75ec1b3cde17 351 unsigned short BPP_t;
Geremia 0:75ec1b3cde17 352 unsigned int PixelWidth,PixelHeigh,start_data;
Geremia 0:75ec1b3cde17 353 unsigned int i,off;
Geremia 0:75ec1b3cde17 354 int padd,j;
Geremia 0:75ec1b3cde17 355 unsigned short *line;
Geremia 0:75ec1b3cde17 356
Geremia 0:75ec1b3cde17 357 // get the filename
Geremia 0:75ec1b3cde17 358 i=0;
Geremia 0:75ec1b3cde17 359 while (*Name_BMP!='\0') {
Geremia 0:75ec1b3cde17 360 filename[i++]=*Name_BMP++;
Geremia 0:75ec1b3cde17 361 }
Geremia 0:75ec1b3cde17 362 filename[i] = 0;
Geremia 0:75ec1b3cde17 363
Geremia 0:75ec1b3cde17 364 FILE *Image = fopen((const char *)&filename[0], "rb"); // open the bmp file
Geremia 0:75ec1b3cde17 365 if (!Image) {
Geremia 0:75ec1b3cde17 366 return(0); // error file not found !
Geremia 0:75ec1b3cde17 367 }
Geremia 0:75ec1b3cde17 368
Geremia 0:75ec1b3cde17 369 fread(&BMP_Header[0],1,54,Image); // get the BMP Header
Geremia 0:75ec1b3cde17 370
Geremia 0:75ec1b3cde17 371 if (BMP_Header[0] != 0x42 || BMP_Header[1] != 0x4D) { // check magic byte
Geremia 0:75ec1b3cde17 372 fclose(Image);
Geremia 0:75ec1b3cde17 373 return(-1); // error no BMP file
Geremia 0:75ec1b3cde17 374 }
Geremia 0:75ec1b3cde17 375
Geremia 0:75ec1b3cde17 376 BPP_t = BMP_Header[OffsetBPP] + (BMP_Header[OffsetBPP + 1] << 8);
Geremia 0:75ec1b3cde17 377 if (BPP_t != 0x0010) {
Geremia 0:75ec1b3cde17 378 fclose(Image);
Geremia 0:75ec1b3cde17 379 return(-2); // error no 16 bit BMP
Geremia 0:75ec1b3cde17 380 }
Geremia 0:75ec1b3cde17 381
Geremia 0:75ec1b3cde17 382 PixelHeigh = BMP_Header[OffsetPixelHeigh] + (BMP_Header[OffsetPixelHeigh + 1] << 8) + (BMP_Header[OffsetPixelHeigh + 2] << 16) + (BMP_Header[OffsetPixelHeigh + 3] << 24);
Geremia 0:75ec1b3cde17 383 PixelWidth = BMP_Header[OffsetPixelWidth] + (BMP_Header[OffsetPixelWidth + 1] << 8) + (BMP_Header[OffsetPixelWidth + 2] << 16) + (BMP_Header[OffsetPixelWidth + 3] << 24);
Geremia 0:75ec1b3cde17 384 if (PixelHeigh > oriented_height + y || PixelWidth > oriented_width + x) {
Geremia 0:75ec1b3cde17 385 fclose(Image);
Geremia 0:75ec1b3cde17 386 return(-3); // to big
Geremia 0:75ec1b3cde17 387 }
Geremia 0:75ec1b3cde17 388
Geremia 0:75ec1b3cde17 389 start_data = BMP_Header[OffsetPixData] + (BMP_Header[OffsetPixData + 1] << 8) + (BMP_Header[OffsetPixData + 2] << 16) + (BMP_Header[OffsetPixData + 3] << 24);
Geremia 0:75ec1b3cde17 390
Geremia 0:75ec1b3cde17 391 line = (unsigned short *) malloc (2 * PixelWidth); // we need a buffer for a line
Geremia 0:75ec1b3cde17 392 if (line == NULL) {
Geremia 0:75ec1b3cde17 393 return(-4); // error no memory
Geremia 0:75ec1b3cde17 394 }
Geremia 0:75ec1b3cde17 395
Geremia 0:75ec1b3cde17 396 // the bmp lines are padded to multiple of 4 bytes
Geremia 0:75ec1b3cde17 397 padd = -1;
Geremia 0:75ec1b3cde17 398 do {
Geremia 0:75ec1b3cde17 399 padd ++;
Geremia 0:75ec1b3cde17 400 } while ((PixelWidth * 2 + padd)%4 != 0);
Geremia 0:75ec1b3cde17 401
Geremia 0:75ec1b3cde17 402 window(x, y,PixelWidth ,PixelHeigh);
Geremia 0:75ec1b3cde17 403 // wr_cmd(0x2C); // send pixel
Geremia 0:75ec1b3cde17 404 for (j = PixelHeigh - 1; j >= 0; j--) { //Lines bottom up
Geremia 0:75ec1b3cde17 405 off = j * (PixelWidth * 2 + padd) + start_data; // start of line
Geremia 0:75ec1b3cde17 406 fseek(Image, off ,SEEK_SET);
Geremia 0:75ec1b3cde17 407 fread(line,1,PixelWidth * 2,Image); // read a line - slow
Geremia 0:75ec1b3cde17 408 for (i = 0; i < PixelWidth; i++) { // copy pixel data to TFT
Geremia 0:75ec1b3cde17 409 // wr_16(line[i]); // one 16 bit pixel
Geremia 0:75ec1b3cde17 410 window_pushpixel(line[i]);
Geremia 0:75ec1b3cde17 411 }
Geremia 0:75ec1b3cde17 412 }
Geremia 0:75ec1b3cde17 413 free (line);
Geremia 0:75ec1b3cde17 414 fclose(Image);
Geremia 0:75ec1b3cde17 415 if(auto_up) copy_to_lcd();
Geremia 0:75ec1b3cde17 416 return(1);
Geremia 0:75ec1b3cde17 417 }
Geremia 0:75ec1b3cde17 418
Geremia 0:75ec1b3cde17 419 void GraphicsDisplay::cls (void)
Geremia 0:75ec1b3cde17 420 {
Geremia 0:75ec1b3cde17 421 unsigned int pixels = ( oriented_width * oriented_height);
Geremia 0:75ec1b3cde17 422 WindowMax();
Geremia 0:75ec1b3cde17 423 for (unsigned int i = 0; i < pixels; i++)
Geremia 0:75ec1b3cde17 424 {
Geremia 0:75ec1b3cde17 425 window_pushpixel(_background);
Geremia 0:75ec1b3cde17 426 }
Geremia 0:75ec1b3cde17 427 }
Geremia 0:75ec1b3cde17 428
Geremia 0:75ec1b3cde17 429
Geremia 0:75ec1b3cde17 430