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.
Graphics/GraphicsDisplay.cpp@0:e67bf8f398ee, 2015-08-23 (annotated)
- Committer:
- jloreto
- Date:
- Sun Aug 23 15:50:19 2015 +0000
- Revision:
- 0:e67bf8f398ee
This program is to test MCU Friend shield based on LGDP4535 in Nucleo-F411RE board.; Libraries modified from Unigraphic Library
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| jloreto | 0:e67bf8f398ee | 1 | /* mbed UniGraphic library - Graphics class |
| jloreto | 0:e67bf8f398ee | 2 | * Copyright (c) 2015 Giuliano Dianda |
| jloreto | 0:e67bf8f398ee | 3 | * Released under the MIT License: http://mbed.org/license/mit |
| jloreto | 0:e67bf8f398ee | 4 | * |
| jloreto | 0:e67bf8f398ee | 5 | * Derived work of: |
| jloreto | 0:e67bf8f398ee | 6 | * |
| jloreto | 0:e67bf8f398ee | 7 | * mbed GraphicsDisplay Display Library Base Class |
| jloreto | 0:e67bf8f398ee | 8 | * Copyright (c) 2007-2009 sford |
| jloreto | 0:e67bf8f398ee | 9 | * Released under the MIT License: http://mbed.org/license/mit |
| jloreto | 0:e67bf8f398ee | 10 | * |
| jloreto | 0:e67bf8f398ee | 11 | * mbed library for 240*320 pixel display TFT based on ILI9341 LCD Controller |
| jloreto | 0:e67bf8f398ee | 12 | * Copyright (c) 2013 Peter Drescher - DC2PD |
| jloreto | 0:e67bf8f398ee | 13 | * |
| jloreto | 0:e67bf8f398ee | 14 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
| jloreto | 0:e67bf8f398ee | 15 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
| jloreto | 0:e67bf8f398ee | 16 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE |
| jloreto | 0:e67bf8f398ee | 17 | * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
| jloreto | 0:e67bf8f398ee | 18 | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
| jloreto | 0:e67bf8f398ee | 19 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN |
| jloreto | 0:e67bf8f398ee | 20 | * THE SOFTWARE. |
| jloreto | 0:e67bf8f398ee | 21 | */ |
| jloreto | 0:e67bf8f398ee | 22 | |
| jloreto | 0:e67bf8f398ee | 23 | |
| jloreto | 0:e67bf8f398ee | 24 | |
| jloreto | 0:e67bf8f398ee | 25 | #include "GraphicsDisplay.h" |
| jloreto | 0:e67bf8f398ee | 26 | #define SWAP(a, b) { a ^= b; b ^= a; a ^= b; } |
| jloreto | 0:e67bf8f398ee | 27 | GraphicsDisplay::GraphicsDisplay(const char *name):TextDisplay(name) { |
| jloreto | 0:e67bf8f398ee | 28 | set_font((unsigned char*)Terminal6x8,32,127,true); |
| jloreto | 0:e67bf8f398ee | 29 | // foreground(0xFFFF); |
| jloreto | 0:e67bf8f398ee | 30 | // background(0x0000); |
| jloreto | 0:e67bf8f398ee | 31 | char_x = 0; |
| jloreto | 0:e67bf8f398ee | 32 | char_y = 0; |
| jloreto | 0:e67bf8f398ee | 33 | oriented_width=0; |
| jloreto | 0:e67bf8f398ee | 34 | oriented_height=0; |
| jloreto | 0:e67bf8f398ee | 35 | fontzoomver=1; |
| jloreto | 0:e67bf8f398ee | 36 | fontzoomhor=1; |
| jloreto | 0:e67bf8f398ee | 37 | auto_up = true; |
| jloreto | 0:e67bf8f398ee | 38 | } |
| jloreto | 0:e67bf8f398ee | 39 | |
| jloreto | 0:e67bf8f398ee | 40 | void GraphicsDisplay::WindowMax (void) |
| jloreto | 0:e67bf8f398ee | 41 | { |
| jloreto | 0:e67bf8f398ee | 42 | window (0, 0, oriented_width, oriented_height); |
| jloreto | 0:e67bf8f398ee | 43 | } |
| jloreto | 0:e67bf8f398ee | 44 | void GraphicsDisplay::set_width(int width) |
| jloreto | 0:e67bf8f398ee | 45 | { |
| jloreto | 0:e67bf8f398ee | 46 | oriented_width = width; |
| jloreto | 0:e67bf8f398ee | 47 | } |
| jloreto | 0:e67bf8f398ee | 48 | void GraphicsDisplay::set_height(int height) |
| jloreto | 0:e67bf8f398ee | 49 | { |
| jloreto | 0:e67bf8f398ee | 50 | oriented_height = height; |
| jloreto | 0:e67bf8f398ee | 51 | } |
| jloreto | 0:e67bf8f398ee | 52 | int GraphicsDisplay::width() |
| jloreto | 0:e67bf8f398ee | 53 | { |
| jloreto | 0:e67bf8f398ee | 54 | return oriented_width; |
| jloreto | 0:e67bf8f398ee | 55 | } |
| jloreto | 0:e67bf8f398ee | 56 | int GraphicsDisplay::height() |
| jloreto | 0:e67bf8f398ee | 57 | { |
| jloreto | 0:e67bf8f398ee | 58 | return oriented_height; |
| jloreto | 0:e67bf8f398ee | 59 | } |
| jloreto | 0:e67bf8f398ee | 60 | void GraphicsDisplay::circle(int x0, int y0, int r, unsigned short color) |
| jloreto | 0:e67bf8f398ee | 61 | { |
| jloreto | 0:e67bf8f398ee | 62 | int x = -r, y = 0, err = 2-2*r, e2; |
| jloreto | 0:e67bf8f398ee | 63 | do { |
| jloreto | 0:e67bf8f398ee | 64 | pixel(x0-x, y0+y,color); |
| jloreto | 0:e67bf8f398ee | 65 | pixel(x0+x, y0+y,color); |
| jloreto | 0:e67bf8f398ee | 66 | pixel(x0+x, y0-y,color); |
| jloreto | 0:e67bf8f398ee | 67 | pixel(x0-x, y0-y,color); |
| jloreto | 0:e67bf8f398ee | 68 | e2 = err; |
| jloreto | 0:e67bf8f398ee | 69 | if (e2 <= y) { |
| jloreto | 0:e67bf8f398ee | 70 | err += ++y*2+1; |
| jloreto | 0:e67bf8f398ee | 71 | if (-x == y && e2 <= x) e2 = 0; |
| jloreto | 0:e67bf8f398ee | 72 | } |
| jloreto | 0:e67bf8f398ee | 73 | if (e2 > x) err += ++x*2+1; |
| jloreto | 0:e67bf8f398ee | 74 | } while (x <= 0); |
| jloreto | 0:e67bf8f398ee | 75 | if(auto_up) copy_to_lcd(); |
| jloreto | 0:e67bf8f398ee | 76 | } |
| jloreto | 0:e67bf8f398ee | 77 | void GraphicsDisplay::fillcircle(int x0, int y0, int r, unsigned short color) |
| jloreto | 0:e67bf8f398ee | 78 | { |
| jloreto | 0:e67bf8f398ee | 79 | bool old_auto_up=auto_up; |
| jloreto | 0:e67bf8f398ee | 80 | if(auto_up) auto_up=false; |
| jloreto | 0:e67bf8f398ee | 81 | int x = -r, y = 0, err = 2-2*r, e2; |
| jloreto | 0:e67bf8f398ee | 82 | do { |
| jloreto | 0:e67bf8f398ee | 83 | vline(x0-x, y0-y, y0+y, color); |
| jloreto | 0:e67bf8f398ee | 84 | vline(x0+x, y0-y, y0+y, color); |
| jloreto | 0:e67bf8f398ee | 85 | e2 = err; |
| jloreto | 0:e67bf8f398ee | 86 | if (e2 <= y) { |
| jloreto | 0:e67bf8f398ee | 87 | err += ++y*2+1; |
| jloreto | 0:e67bf8f398ee | 88 | if (-x == y && e2 <= x) e2 = 0; |
| jloreto | 0:e67bf8f398ee | 89 | } |
| jloreto | 0:e67bf8f398ee | 90 | if (e2 > x) err += ++x*2+1; |
| jloreto | 0:e67bf8f398ee | 91 | } while (x <= 0); |
| jloreto | 0:e67bf8f398ee | 92 | if(old_auto_up) |
| jloreto | 0:e67bf8f398ee | 93 | { |
| jloreto | 0:e67bf8f398ee | 94 | auto_up=true; |
| jloreto | 0:e67bf8f398ee | 95 | copy_to_lcd(); |
| jloreto | 0:e67bf8f398ee | 96 | } |
| jloreto | 0:e67bf8f398ee | 97 | } |
| jloreto | 0:e67bf8f398ee | 98 | void GraphicsDisplay::hline(int x0, int x1, int y, unsigned short color) |
| jloreto | 0:e67bf8f398ee | 99 | { |
| jloreto | 0:e67bf8f398ee | 100 | int len = x1 - x0 + 1; |
| jloreto | 0:e67bf8f398ee | 101 | window(x0,y,len,1); |
| jloreto | 0:e67bf8f398ee | 102 | // for (int j=0; j<len; j++) window_pushpixel(color); |
| jloreto | 0:e67bf8f398ee | 103 | window_pushpixel(color, len); |
| jloreto | 0:e67bf8f398ee | 104 | if(auto_up) copy_to_lcd(); |
| jloreto | 0:e67bf8f398ee | 105 | return; |
| jloreto | 0:e67bf8f398ee | 106 | } |
| jloreto | 0:e67bf8f398ee | 107 | void GraphicsDisplay::vline(int x, int y0, int y1, unsigned short color) |
| jloreto | 0:e67bf8f398ee | 108 | { |
| jloreto | 0:e67bf8f398ee | 109 | int len = y1 - y0 + 1; |
| jloreto | 0:e67bf8f398ee | 110 | window(x,y0,1,len); |
| jloreto | 0:e67bf8f398ee | 111 | // for (int y=0; y<len; y++) window_pushpixel(color); |
| jloreto | 0:e67bf8f398ee | 112 | window_pushpixel(color, len); |
| jloreto | 0:e67bf8f398ee | 113 | if(auto_up) copy_to_lcd(); |
| jloreto | 0:e67bf8f398ee | 114 | return; |
| jloreto | 0:e67bf8f398ee | 115 | } |
| jloreto | 0:e67bf8f398ee | 116 | void GraphicsDisplay::line(int x0, int y0, int x1, int y1, unsigned short color) |
| jloreto | 0:e67bf8f398ee | 117 | { |
| jloreto | 0:e67bf8f398ee | 118 | //WindowMax(); |
| jloreto | 0:e67bf8f398ee | 119 | int dx = 0, dy = 0; |
| jloreto | 0:e67bf8f398ee | 120 | int dx_sym = 0, dy_sym = 0; |
| jloreto | 0:e67bf8f398ee | 121 | int dx_x2 = 0, dy_x2 = 0; |
| jloreto | 0:e67bf8f398ee | 122 | int di = 0; |
| jloreto | 0:e67bf8f398ee | 123 | |
| jloreto | 0:e67bf8f398ee | 124 | dx = x1-x0; |
| jloreto | 0:e67bf8f398ee | 125 | dy = y1-y0; |
| jloreto | 0:e67bf8f398ee | 126 | |
| jloreto | 0:e67bf8f398ee | 127 | if (dx == 0) { /* vertical line */ |
| jloreto | 0:e67bf8f398ee | 128 | if (y1 < y0) SWAP(y0,y1); |
| jloreto | 0:e67bf8f398ee | 129 | vline(x0,y0,y1,color); |
| jloreto | 0:e67bf8f398ee | 130 | return; |
| jloreto | 0:e67bf8f398ee | 131 | } |
| jloreto | 0:e67bf8f398ee | 132 | |
| jloreto | 0:e67bf8f398ee | 133 | if (dx > 0) { |
| jloreto | 0:e67bf8f398ee | 134 | dx_sym = 1; |
| jloreto | 0:e67bf8f398ee | 135 | } else { |
| jloreto | 0:e67bf8f398ee | 136 | dx_sym = -1; |
| jloreto | 0:e67bf8f398ee | 137 | } |
| jloreto | 0:e67bf8f398ee | 138 | if (dy == 0) { /* horizontal line */ |
| jloreto | 0:e67bf8f398ee | 139 | if (x1 < x0) SWAP(x1,x0); |
| jloreto | 0:e67bf8f398ee | 140 | hline(x0,x1,y0,color); |
| jloreto | 0:e67bf8f398ee | 141 | return; |
| jloreto | 0:e67bf8f398ee | 142 | } |
| jloreto | 0:e67bf8f398ee | 143 | |
| jloreto | 0:e67bf8f398ee | 144 | if (dy > 0) { |
| jloreto | 0:e67bf8f398ee | 145 | dy_sym = 1; |
| jloreto | 0:e67bf8f398ee | 146 | } else { |
| jloreto | 0:e67bf8f398ee | 147 | dy_sym = -1; |
| jloreto | 0:e67bf8f398ee | 148 | } |
| jloreto | 0:e67bf8f398ee | 149 | |
| jloreto | 0:e67bf8f398ee | 150 | dx = dx_sym*dx; |
| jloreto | 0:e67bf8f398ee | 151 | dy = dy_sym*dy; |
| jloreto | 0:e67bf8f398ee | 152 | |
| jloreto | 0:e67bf8f398ee | 153 | dx_x2 = dx*2; |
| jloreto | 0:e67bf8f398ee | 154 | dy_x2 = dy*2; |
| jloreto | 0:e67bf8f398ee | 155 | |
| jloreto | 0:e67bf8f398ee | 156 | if (dx >= dy) { |
| jloreto | 0:e67bf8f398ee | 157 | di = dy_x2 - dx; |
| jloreto | 0:e67bf8f398ee | 158 | while (x0 != x1) { |
| jloreto | 0:e67bf8f398ee | 159 | |
| jloreto | 0:e67bf8f398ee | 160 | pixel(x0, y0, color); |
| jloreto | 0:e67bf8f398ee | 161 | x0 += dx_sym; |
| jloreto | 0:e67bf8f398ee | 162 | if (di<0) { |
| jloreto | 0:e67bf8f398ee | 163 | di += dy_x2; |
| jloreto | 0:e67bf8f398ee | 164 | } else { |
| jloreto | 0:e67bf8f398ee | 165 | di += dy_x2 - dx_x2; |
| jloreto | 0:e67bf8f398ee | 166 | y0 += dy_sym; |
| jloreto | 0:e67bf8f398ee | 167 | } |
| jloreto | 0:e67bf8f398ee | 168 | } |
| jloreto | 0:e67bf8f398ee | 169 | pixel(x0, y0, color); |
| jloreto | 0:e67bf8f398ee | 170 | } else { |
| jloreto | 0:e67bf8f398ee | 171 | di = dx_x2 - dy; |
| jloreto | 0:e67bf8f398ee | 172 | while (y0 != y1) { |
| jloreto | 0:e67bf8f398ee | 173 | pixel(x0, y0, color); |
| jloreto | 0:e67bf8f398ee | 174 | y0 += dy_sym; |
| jloreto | 0:e67bf8f398ee | 175 | if (di < 0) { |
| jloreto | 0:e67bf8f398ee | 176 | di += dx_x2; |
| jloreto | 0:e67bf8f398ee | 177 | } else { |
| jloreto | 0:e67bf8f398ee | 178 | di += dx_x2 - dy_x2; |
| jloreto | 0:e67bf8f398ee | 179 | x0 += dx_sym; |
| jloreto | 0:e67bf8f398ee | 180 | } |
| jloreto | 0:e67bf8f398ee | 181 | } |
| jloreto | 0:e67bf8f398ee | 182 | pixel(x0, y0, color); |
| jloreto | 0:e67bf8f398ee | 183 | } |
| jloreto | 0:e67bf8f398ee | 184 | if(auto_up) copy_to_lcd(); |
| jloreto | 0:e67bf8f398ee | 185 | return; |
| jloreto | 0:e67bf8f398ee | 186 | } |
| jloreto | 0:e67bf8f398ee | 187 | void GraphicsDisplay::rect(int x0, int y0, int x1, int y1, unsigned short color) |
| jloreto | 0:e67bf8f398ee | 188 | { |
| jloreto | 0:e67bf8f398ee | 189 | bool old_auto_up=auto_up; |
| jloreto | 0:e67bf8f398ee | 190 | if(auto_up) auto_up=0; |
| jloreto | 0:e67bf8f398ee | 191 | if (x1 > x0) hline(x0,x1,y0,color); |
| jloreto | 0:e67bf8f398ee | 192 | else hline(x1,x0,y0,color); |
| jloreto | 0:e67bf8f398ee | 193 | |
| jloreto | 0:e67bf8f398ee | 194 | if (y1 > y0) vline(x0,y0,y1,color); |
| jloreto | 0:e67bf8f398ee | 195 | else vline(x0,y1,y0,color); |
| jloreto | 0:e67bf8f398ee | 196 | |
| jloreto | 0:e67bf8f398ee | 197 | if (x1 > x0) hline(x0,x1,y1,color); |
| jloreto | 0:e67bf8f398ee | 198 | else hline(x1,x0,y1,color); |
| jloreto | 0:e67bf8f398ee | 199 | |
| jloreto | 0:e67bf8f398ee | 200 | if (y1 > y0) vline(x1,y0,y1,color); |
| jloreto | 0:e67bf8f398ee | 201 | else vline(x1,y1,y0,color); |
| jloreto | 0:e67bf8f398ee | 202 | if(old_auto_up) |
| jloreto | 0:e67bf8f398ee | 203 | { |
| jloreto | 0:e67bf8f398ee | 204 | auto_up=true; |
| jloreto | 0:e67bf8f398ee | 205 | copy_to_lcd(); |
| jloreto | 0:e67bf8f398ee | 206 | } |
| jloreto | 0:e67bf8f398ee | 207 | return; |
| jloreto | 0:e67bf8f398ee | 208 | } |
| jloreto | 0:e67bf8f398ee | 209 | void GraphicsDisplay::fillrect(int x0, int y0, int x1, int y1, unsigned short color) |
| jloreto | 0:e67bf8f398ee | 210 | { |
| jloreto | 0:e67bf8f398ee | 211 | if(x0 > x1) SWAP(x0,x1); |
| jloreto | 0:e67bf8f398ee | 212 | if(y0 > y1) SWAP(y0,y1); |
| jloreto | 0:e67bf8f398ee | 213 | |
| jloreto | 0:e67bf8f398ee | 214 | int h = y1 - y0 + 1; |
| jloreto | 0:e67bf8f398ee | 215 | int w = x1 - x0 + 1; |
| jloreto | 0:e67bf8f398ee | 216 | unsigned int pixels = h * w; |
| jloreto | 0:e67bf8f398ee | 217 | window(x0,y0,w,h); |
| jloreto | 0:e67bf8f398ee | 218 | // for (unsigned int p=0; p<pixels; p++) window_pushpixel(color); |
| jloreto | 0:e67bf8f398ee | 219 | window_pushpixel(color, pixels); |
| jloreto | 0:e67bf8f398ee | 220 | if(auto_up) copy_to_lcd(); |
| jloreto | 0:e67bf8f398ee | 221 | return; |
| jloreto | 0:e67bf8f398ee | 222 | } |
| jloreto | 0:e67bf8f398ee | 223 | void GraphicsDisplay::locate(int x, int y) |
| jloreto | 0:e67bf8f398ee | 224 | { |
| jloreto | 0:e67bf8f398ee | 225 | char_x = x; |
| jloreto | 0:e67bf8f398ee | 226 | char_y = y; |
| jloreto | 0:e67bf8f398ee | 227 | } |
| jloreto | 0:e67bf8f398ee | 228 | int GraphicsDisplay::columns() |
| jloreto | 0:e67bf8f398ee | 229 | { |
| jloreto | 0:e67bf8f398ee | 230 | return oriented_width / fonthor; |
| jloreto | 0:e67bf8f398ee | 231 | } |
| jloreto | 0:e67bf8f398ee | 232 | int GraphicsDisplay::rows() |
| jloreto | 0:e67bf8f398ee | 233 | { |
| jloreto | 0:e67bf8f398ee | 234 | return oriented_height / fontvert; |
| jloreto | 0:e67bf8f398ee | 235 | } |
| jloreto | 0:e67bf8f398ee | 236 | void GraphicsDisplay::set_font(unsigned char* f, unsigned char firstascii, unsigned char lastascii, bool proportional) |
| jloreto | 0:e67bf8f398ee | 237 | { |
| jloreto | 0:e67bf8f398ee | 238 | font = f; |
| jloreto | 0:e67bf8f398ee | 239 | // read font parameter from start of array |
| jloreto | 0:e67bf8f398ee | 240 | //fontoffset = font[0]; // bytes / char |
| jloreto | 0:e67bf8f398ee | 241 | fonthor = font[1]; // get hor size of font |
| jloreto | 0:e67bf8f398ee | 242 | fontvert = font[2]; // get vert size of font |
| jloreto | 0:e67bf8f398ee | 243 | //fontbpl = font[3]; // bytes per line |
| jloreto | 0:e67bf8f398ee | 244 | fontbpl = (fontvert+7)>>3; //bytes per line, rounded up to multiple of 8 |
| jloreto | 0:e67bf8f398ee | 245 | fontoffset = (fonthor*fontbpl)+1; |
| jloreto | 0:e67bf8f398ee | 246 | firstch = firstascii; // first ascii code present in font array (usually 32) |
| jloreto | 0:e67bf8f398ee | 247 | lastch = lastascii; // last ascii code present in font array (usually 127) |
| jloreto | 0:e67bf8f398ee | 248 | fontprop=proportional; |
| jloreto | 0:e67bf8f398ee | 249 | set_font_zoom(1,1); |
| jloreto | 0:e67bf8f398ee | 250 | } |
| jloreto | 0:e67bf8f398ee | 251 | void GraphicsDisplay::set_font_zoom(unsigned char x_mul, unsigned char y_mul) |
| jloreto | 0:e67bf8f398ee | 252 | { |
| jloreto | 0:e67bf8f398ee | 253 | fontzoomhor=((x_mul==0) ? 1:x_mul); |
| jloreto | 0:e67bf8f398ee | 254 | fontzoomver=((y_mul==0) ? 1:y_mul); |
| jloreto | 0:e67bf8f398ee | 255 | } |
| jloreto | 0:e67bf8f398ee | 256 | int GraphicsDisplay::_putc(int value) |
| jloreto | 0:e67bf8f398ee | 257 | { |
| jloreto | 0:e67bf8f398ee | 258 | if (value == '\n') { // new line |
| jloreto | 0:e67bf8f398ee | 259 | char_x = 0; |
| jloreto | 0:e67bf8f398ee | 260 | char_y = char_y + fontvert*fontzoomver; |
| jloreto | 0:e67bf8f398ee | 261 | if (char_y >= oriented_height - fontvert*fontzoomver) { |
| jloreto | 0:e67bf8f398ee | 262 | char_y = 0; |
| jloreto | 0:e67bf8f398ee | 263 | } |
| jloreto | 0:e67bf8f398ee | 264 | } else { |
| jloreto | 0:e67bf8f398ee | 265 | character(char_x, char_y, value); |
| jloreto | 0:e67bf8f398ee | 266 | if(auto_up) copy_to_lcd(); |
| jloreto | 0:e67bf8f398ee | 267 | } |
| jloreto | 0:e67bf8f398ee | 268 | return value; |
| jloreto | 0:e67bf8f398ee | 269 | } |
| jloreto | 0:e67bf8f398ee | 270 | void GraphicsDisplay::character(int x, int y, int c) |
| jloreto | 0:e67bf8f398ee | 271 | { |
| jloreto | 0:e67bf8f398ee | 272 | char_x=x; |
| jloreto | 0:e67bf8f398ee | 273 | char_y=y; |
| jloreto | 0:e67bf8f398ee | 274 | int j,i,b; |
| jloreto | 0:e67bf8f398ee | 275 | unsigned char* zeichen; |
| jloreto | 0:e67bf8f398ee | 276 | unsigned char z,w,v; |
| jloreto | 0:e67bf8f398ee | 277 | |
| jloreto | 0:e67bf8f398ee | 278 | if ((c < firstch) || (c > lastch)) return; // test char range |
| jloreto | 0:e67bf8f398ee | 279 | |
| jloreto | 0:e67bf8f398ee | 280 | /* // read font parameter from start of array |
| jloreto | 0:e67bf8f398ee | 281 | offset = font[0]; // bytes / char |
| jloreto | 0:e67bf8f398ee | 282 | hor = font[1]; // get hor size of font |
| jloreto | 0:e67bf8f398ee | 283 | vert = font[2]; // get vert size of font |
| jloreto | 0:e67bf8f398ee | 284 | bpl = font[3]; // bytes per line |
| jloreto | 0:e67bf8f398ee | 285 | */ |
| jloreto | 0:e67bf8f398ee | 286 | if (char_x + fonthor*fontzoomhor > oriented_width) { |
| jloreto | 0:e67bf8f398ee | 287 | char_x = 0; |
| jloreto | 0:e67bf8f398ee | 288 | char_y = char_y + fontvert*fontzoomver; |
| jloreto | 0:e67bf8f398ee | 289 | if (char_y > oriented_height - fontvert*fontzoomver) { |
| jloreto | 0:e67bf8f398ee | 290 | char_y = 0; |
| jloreto | 0:e67bf8f398ee | 291 | } |
| jloreto | 0:e67bf8f398ee | 292 | } |
| jloreto | 0:e67bf8f398ee | 293 | window(char_x, char_y,fonthor*fontzoomhor,fontvert*fontzoomver); // char box |
| jloreto | 0:e67bf8f398ee | 294 | zeichen = &font[((c-firstch) * fontoffset) + 4]; // start of char bitmap |
| jloreto | 0:e67bf8f398ee | 295 | w = zeichen[0]; // width of actual char |
| jloreto | 0:e67bf8f398ee | 296 | // construct the char into the buffer |
| jloreto | 0:e67bf8f398ee | 297 | for (j=0; j<fontvert; j++) { // vert line |
| jloreto | 0:e67bf8f398ee | 298 | for (v=0; v<fontzoomver; v++) { // repeat horiz line for vertical zooming |
| jloreto | 0:e67bf8f398ee | 299 | for (i=0; i<fonthor; i++) { // horz line |
| jloreto | 0:e67bf8f398ee | 300 | z = zeichen[(fontbpl * i) + ((j & 0xF8) >> 3)+1]; |
| jloreto | 0:e67bf8f398ee | 301 | b = 1 << (j & 0x07); |
| jloreto | 0:e67bf8f398ee | 302 | if (( z & b ) == 0x00) { |
| jloreto | 0:e67bf8f398ee | 303 | // pixel(char_x+i,char_y+j,0); |
| jloreto | 0:e67bf8f398ee | 304 | window_pushpixel(_background, fontzoomhor); //(color, howmany) |
| jloreto | 0:e67bf8f398ee | 305 | } else { |
| jloreto | 0:e67bf8f398ee | 306 | // pixel(char_x+i,char_y+j,1); |
| jloreto | 0:e67bf8f398ee | 307 | window_pushpixel(_foreground, fontzoomhor); |
| jloreto | 0:e67bf8f398ee | 308 | } |
| jloreto | 0:e67bf8f398ee | 309 | } |
| jloreto | 0:e67bf8f398ee | 310 | } //for each zoomed vert |
| jloreto | 0:e67bf8f398ee | 311 | } |
| jloreto | 0:e67bf8f398ee | 312 | if(fontprop) |
| jloreto | 0:e67bf8f398ee | 313 | { |
| jloreto | 0:e67bf8f398ee | 314 | if((w+1)<fonthor) char_x += (w*fontzoomhor)+1; // put at least 1 blank after variable-width characters, except characters that occupy whole fonthor space like "_" |
| jloreto | 0:e67bf8f398ee | 315 | else char_x += fonthor*fontzoomhor; |
| jloreto | 0:e67bf8f398ee | 316 | } |
| jloreto | 0:e67bf8f398ee | 317 | else char_x += fonthor*fontzoomhor; // fixed width |
| jloreto | 0:e67bf8f398ee | 318 | } |
| jloreto | 0:e67bf8f398ee | 319 | void GraphicsDisplay::Bitmap_BW(Bitmap_s bm, int x, int y) |
| jloreto | 0:e67bf8f398ee | 320 | { |
| jloreto | 0:e67bf8f398ee | 321 | int h,v,b; |
| jloreto | 0:e67bf8f398ee | 322 | // int cropX; |
| jloreto | 0:e67bf8f398ee | 323 | char d; |
| jloreto | 0:e67bf8f398ee | 324 | if(x<0) x=0; |
| jloreto | 0:e67bf8f398ee | 325 | if(y<0) y=0; |
| jloreto | 0:e67bf8f398ee | 326 | int cropX = (x+bm.xSize)-oriented_width; |
| jloreto | 0:e67bf8f398ee | 327 | if(cropX<0) cropX=0; |
| jloreto | 0:e67bf8f398ee | 328 | window(x, y, bm.xSize-cropX, bm.ySize); |
| jloreto | 0:e67bf8f398ee | 329 | for(v=0; v < bm.ySize; v++) { // lines |
| jloreto | 0:e67bf8f398ee | 330 | if((v + y) >= oriented_height) break; // no need to crop Y |
| jloreto | 0:e67bf8f398ee | 331 | for(h=0; h < bm.xSize; h++) { // pixel |
| jloreto | 0:e67bf8f398ee | 332 | if((h + x) >= oriented_width) break; |
| jloreto | 0:e67bf8f398ee | 333 | d = bm.data[bm.Byte_in_Line * v + ((h & 0xF8) >> 3)]; |
| jloreto | 0:e67bf8f398ee | 334 | b = 0x80 >> (h & 0x07); |
| jloreto | 0:e67bf8f398ee | 335 | if((d & b) == 0) { |
| jloreto | 0:e67bf8f398ee | 336 | window_pushpixel(_background); |
| jloreto | 0:e67bf8f398ee | 337 | } else { |
| jloreto | 0:e67bf8f398ee | 338 | window_pushpixel(_foreground); |
| jloreto | 0:e67bf8f398ee | 339 | } |
| jloreto | 0:e67bf8f398ee | 340 | } |
| jloreto | 0:e67bf8f398ee | 341 | } |
| jloreto | 0:e67bf8f398ee | 342 | if(auto_up) copy_to_lcd(); |
| jloreto | 0:e67bf8f398ee | 343 | } |
| jloreto | 0:e67bf8f398ee | 344 | void GraphicsDisplay::Bitmap(int x, int y, int w, int h,unsigned char *bitmap) |
| jloreto | 0:e67bf8f398ee | 345 | { |
| jloreto | 0:e67bf8f398ee | 346 | int j; |
| jloreto | 0:e67bf8f398ee | 347 | unsigned char padd; |
| jloreto | 0:e67bf8f398ee | 348 | unsigned short *bitmap_ptr = (unsigned short *)bitmap; |
| jloreto | 0:e67bf8f398ee | 349 | |
| jloreto | 0:e67bf8f398ee | 350 | padd = w%2; // the lines are padded to multiple of 4 bytes in a bitmap |
| jloreto | 0:e67bf8f398ee | 351 | if(x<0) x=0; |
| jloreto | 0:e67bf8f398ee | 352 | else if(x>=oriented_width) return; |
| jloreto | 0:e67bf8f398ee | 353 | if(y<0) y=0; |
| jloreto | 0:e67bf8f398ee | 354 | else if(y>=oriented_height) return; |
| jloreto | 0:e67bf8f398ee | 355 | int cropX = (x+w)-oriented_width; |
| jloreto | 0:e67bf8f398ee | 356 | if(cropX<0) cropX=0; |
| jloreto | 0:e67bf8f398ee | 357 | int cropY = (y+h)-oriented_height; |
| jloreto | 0:e67bf8f398ee | 358 | if(cropY<0) cropY=0; |
| jloreto | 0:e67bf8f398ee | 359 | window(x, y, w-cropX, h-cropY); |
| jloreto | 0:e67bf8f398ee | 360 | bitmap_ptr += ((h - 1)* (w + padd)); // begin of last line in array (first line of image)(standard bmp scan direction is left->right bottom->top) |
| jloreto | 0:e67bf8f398ee | 361 | for (j = 0; j < h-cropY; j++) { //Lines |
| jloreto | 0:e67bf8f398ee | 362 | window_pushpixelbuf(bitmap_ptr, w-cropX); |
| jloreto | 0:e67bf8f398ee | 363 | bitmap_ptr -= w+padd; |
| jloreto | 0:e67bf8f398ee | 364 | } |
| jloreto | 0:e67bf8f398ee | 365 | if(auto_up) copy_to_lcd(); |
| jloreto | 0:e67bf8f398ee | 366 | } |
| jloreto | 0:e67bf8f398ee | 367 | |
| jloreto | 0:e67bf8f398ee | 368 | // local filesystem is not implemented in kinetis board , but you can add a SD card |
| jloreto | 0:e67bf8f398ee | 369 | // fixme this whole functions needs testing and speedup |
| jloreto | 0:e67bf8f398ee | 370 | int GraphicsDisplay::BMP_16(int x, int y, const char *Name_BMP) |
| jloreto | 0:e67bf8f398ee | 371 | { |
| jloreto | 0:e67bf8f398ee | 372 | |
| jloreto | 0:e67bf8f398ee | 373 | #define OffsetPixelWidth 18 |
| jloreto | 0:e67bf8f398ee | 374 | #define OffsetPixelHeigh 22 |
| jloreto | 0:e67bf8f398ee | 375 | #define OffsetFileSize 34 |
| jloreto | 0:e67bf8f398ee | 376 | #define OffsetPixData 10 |
| jloreto | 0:e67bf8f398ee | 377 | #define OffsetBPP 28 |
| jloreto | 0:e67bf8f398ee | 378 | |
| jloreto | 0:e67bf8f398ee | 379 | char filename[50]; |
| jloreto | 0:e67bf8f398ee | 380 | unsigned char BMP_Header[54]; |
| jloreto | 0:e67bf8f398ee | 381 | unsigned short BPP_t; |
| jloreto | 0:e67bf8f398ee | 382 | unsigned int PixelWidth,PixelHeigh,start_data; |
| jloreto | 0:e67bf8f398ee | 383 | unsigned int i,off; |
| jloreto | 0:e67bf8f398ee | 384 | int padd,j; |
| jloreto | 0:e67bf8f398ee | 385 | unsigned short *line; |
| jloreto | 0:e67bf8f398ee | 386 | |
| jloreto | 0:e67bf8f398ee | 387 | // get the filename |
| jloreto | 0:e67bf8f398ee | 388 | i=0; |
| jloreto | 0:e67bf8f398ee | 389 | while (*Name_BMP!='\0') { |
| jloreto | 0:e67bf8f398ee | 390 | filename[i++]=*Name_BMP++; |
| jloreto | 0:e67bf8f398ee | 391 | } |
| jloreto | 0:e67bf8f398ee | 392 | filename[i] = 0; |
| jloreto | 0:e67bf8f398ee | 393 | |
| jloreto | 0:e67bf8f398ee | 394 | FILE *Image = fopen((const char *)&filename[0], "rb"); // open the bmp file |
| jloreto | 0:e67bf8f398ee | 395 | if (!Image) { |
| jloreto | 0:e67bf8f398ee | 396 | return(0); // error file not found ! |
| jloreto | 0:e67bf8f398ee | 397 | } |
| jloreto | 0:e67bf8f398ee | 398 | |
| jloreto | 0:e67bf8f398ee | 399 | fread(&BMP_Header[0],1,54,Image); // get the BMP Header |
| jloreto | 0:e67bf8f398ee | 400 | |
| jloreto | 0:e67bf8f398ee | 401 | if (BMP_Header[0] != 0x42 || BMP_Header[1] != 0x4D) { // check magic byte |
| jloreto | 0:e67bf8f398ee | 402 | fclose(Image); |
| jloreto | 0:e67bf8f398ee | 403 | return(-1); // error no BMP file |
| jloreto | 0:e67bf8f398ee | 404 | } |
| jloreto | 0:e67bf8f398ee | 405 | |
| jloreto | 0:e67bf8f398ee | 406 | BPP_t = BMP_Header[OffsetBPP] + (BMP_Header[OffsetBPP + 1] << 8); |
| jloreto | 0:e67bf8f398ee | 407 | if (BPP_t != 0x0010) { |
| jloreto | 0:e67bf8f398ee | 408 | fclose(Image); |
| jloreto | 0:e67bf8f398ee | 409 | return(-2); // error no 16 bit BMP |
| jloreto | 0:e67bf8f398ee | 410 | } |
| jloreto | 0:e67bf8f398ee | 411 | |
| jloreto | 0:e67bf8f398ee | 412 | PixelHeigh = BMP_Header[OffsetPixelHeigh] + (BMP_Header[OffsetPixelHeigh + 1] << 8) + (BMP_Header[OffsetPixelHeigh + 2] << 16) + (BMP_Header[OffsetPixelHeigh + 3] << 24); |
| jloreto | 0:e67bf8f398ee | 413 | PixelWidth = BMP_Header[OffsetPixelWidth] + (BMP_Header[OffsetPixelWidth + 1] << 8) + (BMP_Header[OffsetPixelWidth + 2] << 16) + (BMP_Header[OffsetPixelWidth + 3] << 24); |
| jloreto | 0:e67bf8f398ee | 414 | if (PixelHeigh > oriented_height + y || PixelWidth > oriented_width + x) { |
| jloreto | 0:e67bf8f398ee | 415 | fclose(Image); |
| jloreto | 0:e67bf8f398ee | 416 | return(-3); // to big |
| jloreto | 0:e67bf8f398ee | 417 | } |
| jloreto | 0:e67bf8f398ee | 418 | |
| jloreto | 0:e67bf8f398ee | 419 | start_data = BMP_Header[OffsetPixData] + (BMP_Header[OffsetPixData + 1] << 8) + (BMP_Header[OffsetPixData + 2] << 16) + (BMP_Header[OffsetPixData + 3] << 24); |
| jloreto | 0:e67bf8f398ee | 420 | |
| jloreto | 0:e67bf8f398ee | 421 | line = (unsigned short *) malloc (2 * PixelWidth); // we need a buffer for a line |
| jloreto | 0:e67bf8f398ee | 422 | if (line == NULL) { |
| jloreto | 0:e67bf8f398ee | 423 | return(-4); // error no memory |
| jloreto | 0:e67bf8f398ee | 424 | } |
| jloreto | 0:e67bf8f398ee | 425 | |
| jloreto | 0:e67bf8f398ee | 426 | // the bmp lines are padded to multiple of 4 bytes |
| jloreto | 0:e67bf8f398ee | 427 | padd = -1; |
| jloreto | 0:e67bf8f398ee | 428 | do { |
| jloreto | 0:e67bf8f398ee | 429 | padd ++; |
| jloreto | 0:e67bf8f398ee | 430 | } while ((PixelWidth * 2 + padd)%4 != 0); |
| jloreto | 0:e67bf8f398ee | 431 | |
| jloreto | 0:e67bf8f398ee | 432 | window(x, y,PixelWidth ,PixelHeigh); |
| jloreto | 0:e67bf8f398ee | 433 | // wr_cmd(0x2C); // send pixel |
| jloreto | 0:e67bf8f398ee | 434 | for (j = PixelHeigh - 1; j >= 0; j--) { //Lines bottom up |
| jloreto | 0:e67bf8f398ee | 435 | off = j * (PixelWidth * 2 + padd) + start_data; // start of line |
| jloreto | 0:e67bf8f398ee | 436 | fseek(Image, off ,SEEK_SET); |
| jloreto | 0:e67bf8f398ee | 437 | fread(line,1,PixelWidth * 2,Image); // read a line - slow |
| jloreto | 0:e67bf8f398ee | 438 | /* for (i = 0; i < PixelWidth; i++) |
| jloreto | 0:e67bf8f398ee | 439 | { // copy pixel data to TFT |
| jloreto | 0:e67bf8f398ee | 440 | // wr_16(line[i]); // one 16 bit pixel |
| jloreto | 0:e67bf8f398ee | 441 | window_pushpixel(line[i]); |
| jloreto | 0:e67bf8f398ee | 442 | |
| jloreto | 0:e67bf8f398ee | 443 | } */ |
| jloreto | 0:e67bf8f398ee | 444 | window_pushpixelbuf(line, PixelWidth); |
| jloreto | 0:e67bf8f398ee | 445 | } |
| jloreto | 0:e67bf8f398ee | 446 | free (line); |
| jloreto | 0:e67bf8f398ee | 447 | fclose(Image); |
| jloreto | 0:e67bf8f398ee | 448 | if(auto_up) copy_to_lcd(); |
| jloreto | 0:e67bf8f398ee | 449 | return(1); |
| jloreto | 0:e67bf8f398ee | 450 | } |
| jloreto | 0:e67bf8f398ee | 451 | |
| jloreto | 0:e67bf8f398ee | 452 | void GraphicsDisplay::cls (void) |
| jloreto | 0:e67bf8f398ee | 453 | { |
| jloreto | 0:e67bf8f398ee | 454 | unsigned int pixels = ( oriented_width * oriented_height); |
| jloreto | 0:e67bf8f398ee | 455 | WindowMax(); |
| jloreto | 0:e67bf8f398ee | 456 | for (unsigned int i = 0; i < pixels; i++) |
| jloreto | 0:e67bf8f398ee | 457 | { |
| jloreto | 0:e67bf8f398ee | 458 | window_pushpixel(_background); |
| jloreto | 0:e67bf8f398ee | 459 | } |
| jloreto | 0:e67bf8f398ee | 460 | } |
| jloreto | 0:e67bf8f398ee | 461 | void GraphicsDisplay::set_auto_up(bool up) |
| jloreto | 0:e67bf8f398ee | 462 | { |
| jloreto | 0:e67bf8f398ee | 463 | if(up) auto_up = true; |
| jloreto | 0:e67bf8f398ee | 464 | else auto_up = false; |
| jloreto | 0:e67bf8f398ee | 465 | } |
| jloreto | 0:e67bf8f398ee | 466 | bool GraphicsDisplay::get_auto_up(void) |
| jloreto | 0:e67bf8f398ee | 467 | { |
| jloreto | 0:e67bf8f398ee | 468 | return (auto_up); |
| jloreto | 0:e67bf8f398ee | 469 | } |
| jloreto | 0:e67bf8f398ee | 470 | |
| jloreto | 0:e67bf8f398ee | 471 |