test
Fork of UniGraphic by
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?
User | Revision | Line number | New 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 |