Juan Loreto / Mbed 2 deprecated Nucleo-F411RE-LGDP4535_TFT_Demo

Dependencies:   mbed

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?

UserRevisionLine numberNew 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