Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Fork of UniGraphicCyrillic 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 |