EasyRad / TFTLCD

Programme de test pour lcd ITDB02

Fork of TFTLCD by Todor Todorov

lcd_base.cpp@10:69571adcfad5, 2012-12-11 (annotated)

Committer:
ttodorov
Date:
Tue Dec 11 03:18:43 2012 +0000
Revision:
10:69571adcfad5
Parent:
9:58b328831d0a
Child:
12:d0978272a340
- preliminary support for using 18-bit colors

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ttodorov 0:881ff0b71102 1 /*
ttodorov 0:881ff0b71102 2 * Copyright (C)2010-2012 Henning Karlsen. All right reserved.
ttodorov 0:881ff0b71102 3 * Copyright (C)2012 Todor Todorov.
ttodorov 0:881ff0b71102 4 *
ttodorov 0:881ff0b71102 5 * This library is free software; you can redistribute it and/or
ttodorov 0:881ff0b71102 6 * modify it under the terms of the GNU Lesser General Public
ttodorov 0:881ff0b71102 7 * License as published by the Free Software Foundation; either
ttodorov 0:881ff0b71102 8 * version 2.1 of the License, or (at your option) any later version.
ttodorov 0:881ff0b71102 9 *
ttodorov 0:881ff0b71102 10 * This library is distributed in the hope that it will be useful,
ttodorov 0:881ff0b71102 11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
ttodorov 0:881ff0b71102 12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
ttodorov 0:881ff0b71102 13 * Lesser General Public License for more details.
ttodorov 0:881ff0b71102 14 *
ttodorov 0:881ff0b71102 15 * You should have received a copy of the GNU Lesser General Public
ttodorov 0:881ff0b71102 16 * License along with this library; if not, write to:
ttodorov 0:881ff0b71102 17 *
ttodorov 0:881ff0b71102 18 * Free Software Foundation, Inc.
ttodorov 0:881ff0b71102 19 * 51 Franklin St, 5th Floor, Boston, MA 02110-1301, USA
ttodorov 0:881ff0b71102 20 *
ttodorov 0:881ff0b71102 21 *********************************************************************/
ttodorov 0:881ff0b71102 22 #include "lcd_base.h"
ttodorov 3:64a5b67d5b51 23 #include "helpers.h"
ttodorov 0:881ff0b71102 24
ttodorov 4:3ac4239f6c9c 25 LCD::LCD( unsigned short width, unsigned short height ,PinName CS, PinName RS, PinName RESET )
ttodorov 4:3ac4239f6c9c 26 : _disp_width( width ), _disp_height( height ), _lcd_pin_cs( CS ), _lcd_pin_rs( RS ), _lcd_pin_reset( RESET )
ttodorov 4:3ac4239f6c9c 27 {
ttodorov 4:3ac4239f6c9c 28 SetForeground();
ttodorov 4:3ac4239f6c9c 29 SetBackground();
ttodorov 4:3ac4239f6c9c 30 _font.font = 0;
ttodorov 4:3ac4239f6c9c 31 }
ttodorov 0:881ff0b71102 32
ttodorov 0:881ff0b71102 33 inline
ttodorov 9:58b328831d0a 34 void LCD::SetForeground( unsigned short color )
ttodorov 0:881ff0b71102 35 {
ttodorov 0:881ff0b71102 36 _foreground = color;
ttodorov 0:881ff0b71102 37 }
ttodorov 0:881ff0b71102 38
ttodorov 0:881ff0b71102 39 inline
ttodorov 9:58b328831d0a 40 void LCD::SetBackground( unsigned short color )
ttodorov 0:881ff0b71102 41 {
ttodorov 0:881ff0b71102 42 _background = color;
ttodorov 0:881ff0b71102 43 }
ttodorov 0:881ff0b71102 44
ttodorov 0:881ff0b71102 45 void LCD::SetFont( const char *font )
ttodorov 0:881ff0b71102 46 {
ttodorov 0:881ff0b71102 47 _font.font = font;
ttodorov 0:881ff0b71102 48 _font.width = font[ 0 ];
ttodorov 0:881ff0b71102 49 _font.height = font[ 1 ];
ttodorov 0:881ff0b71102 50 _font.offset = font[ 2 ];
ttodorov 0:881ff0b71102 51 _font.numchars = font[ 3 ];
ttodorov 0:881ff0b71102 52 }
ttodorov 0:881ff0b71102 53
ttodorov 0:881ff0b71102 54 inline
ttodorov 0:881ff0b71102 55 unsigned short LCD::GetWidth( void )
ttodorov 0:881ff0b71102 56 {
ttodorov 0:881ff0b71102 57 if ( _orientation == LANDSCAPE ) return _disp_height;
ttodorov 0:881ff0b71102 58 return _disp_width;
ttodorov 0:881ff0b71102 59 }
ttodorov 0:881ff0b71102 60
ttodorov 0:881ff0b71102 61 inline
ttodorov 0:881ff0b71102 62 unsigned short LCD::GetHeight( void )
ttodorov 0:881ff0b71102 63 {
ttodorov 0:881ff0b71102 64 if ( _orientation == LANDSCAPE ) return _disp_width;
ttodorov 0:881ff0b71102 65 return _disp_height;
ttodorov 0:881ff0b71102 66 }
ttodorov 0:881ff0b71102 67
ttodorov 0:881ff0b71102 68 void LCD::FillScreen( int color )
ttodorov 0:881ff0b71102 69 {
ttodorov 9:58b328831d0a 70 unsigned short rgb = color == -1 ? _background : color == -2 ? _foreground : ( unsigned short ) color;
ttodorov 4:3ac4239f6c9c 71 Activate();
ttodorov 2:81ed304b7e9b 72 ClearXY();
ttodorov 1:14bef43daf6f 73 for ( int i = 0; i < ( ( _disp_width ) * ( _disp_height ) ); i++ )
ttodorov 10:69571adcfad5 74 SetPixelColor( rgb );
ttodorov 4:3ac4239f6c9c 75 Deactivate();
ttodorov 0:881ff0b71102 76 }
ttodorov 0:881ff0b71102 77
ttodorov 0:881ff0b71102 78 inline
ttodorov 0:881ff0b71102 79 void LCD::ClearScreen( void )
ttodorov 0:881ff0b71102 80 {
ttodorov 0:881ff0b71102 81 FillScreen( -1 );
ttodorov 0:881ff0b71102 82 }
ttodorov 0:881ff0b71102 83
ttodorov 0:881ff0b71102 84 void LCD::DrawPixel( unsigned short x, unsigned short y, int color )
ttodorov 0:881ff0b71102 85 {
ttodorov 4:3ac4239f6c9c 86 Activate();
ttodorov 2:81ed304b7e9b 87 SetXY( x, y, x, y );
ttodorov 10:69571adcfad5 88 SetPixelColor( color == -1 ? _background :
ttodorov 0:881ff0b71102 89 color == -2 ? _foreground : color );
ttodorov 4:3ac4239f6c9c 90 Deactivate();
ttodorov 0:881ff0b71102 91 }
ttodorov 0:881ff0b71102 92
ttodorov 0:881ff0b71102 93 void LCD::DrawLine( unsigned short x1, unsigned short y1, unsigned short x2, unsigned short y2, int color )
ttodorov 0:881ff0b71102 94 {
ttodorov 0:881ff0b71102 95
ttodorov 0:881ff0b71102 96 double delta, tx, ty;
ttodorov 0:881ff0b71102 97
ttodorov 0:881ff0b71102 98 if ( ( ( x2 - x1 ) < 0 ) )
ttodorov 0:881ff0b71102 99 {
ttodorov 0:881ff0b71102 100 swap( ushort, x1, x2 )
ttodorov 0:881ff0b71102 101 swap( ushort, y1, y2 )
ttodorov 0:881ff0b71102 102 }
ttodorov 0:881ff0b71102 103 if ( ( ( y2 - y1 ) < 0 ) )
ttodorov 0:881ff0b71102 104 {
ttodorov 0:881ff0b71102 105 swap( ushort, x1, x2 )
ttodorov 0:881ff0b71102 106 swap( ushort, y1, y2 )
ttodorov 0:881ff0b71102 107 }
ttodorov 0:881ff0b71102 108
ttodorov 0:881ff0b71102 109 if ( y1 == y2 )
ttodorov 0:881ff0b71102 110 {
ttodorov 0:881ff0b71102 111 if ( x1 > x2 )
ttodorov 0:881ff0b71102 112 swap( ushort, x1, x2 )
ttodorov 2:81ed304b7e9b 113 DrawHLine( x1, y1, x2 - x1, color );
ttodorov 0:881ff0b71102 114 }
ttodorov 0:881ff0b71102 115 else if ( x1 == x2 )
ttodorov 0:881ff0b71102 116 {
ttodorov 0:881ff0b71102 117 if ( y1 > y2 )
ttodorov 0:881ff0b71102 118 swap( ushort, y1, y2 )
ttodorov 2:81ed304b7e9b 119 DrawVLine( x1, y1, y2 - y1, color );
ttodorov 0:881ff0b71102 120 }
ttodorov 4:3ac4239f6c9c 121 else
ttodorov 0:881ff0b71102 122 {
ttodorov 9:58b328831d0a 123 unsigned short usedColor = color == -1 ? _background : color == -2 ? _foreground : ( unsigned short ) color;
ttodorov 4:3ac4239f6c9c 124 Activate();
ttodorov 4:3ac4239f6c9c 125 if ( abs( x2 - x1 ) > abs( y2 - y1 ) )
ttodorov 0:881ff0b71102 126 {
ttodorov 4:3ac4239f6c9c 127 delta = ( double( y2 - y1 ) / double( x2 - x1 ) );
ttodorov 4:3ac4239f6c9c 128 ty = double( y1 );
ttodorov 4:3ac4239f6c9c 129 if ( x1 > x2 )
ttodorov 0:881ff0b71102 130 {
ttodorov 4:3ac4239f6c9c 131 for ( int i = x1; i >= x2; i-- )
ttodorov 4:3ac4239f6c9c 132 {
ttodorov 4:3ac4239f6c9c 133 SetXY( i, int( ty + 0.5 ), i, int( ty + 0.5 ) );
ttodorov 10:69571adcfad5 134 SetPixelColor( usedColor );
ttodorov 4:3ac4239f6c9c 135 ty = ty - delta;
ttodorov 4:3ac4239f6c9c 136 }
ttodorov 4:3ac4239f6c9c 137 }
ttodorov 4:3ac4239f6c9c 138 else
ttodorov 4:3ac4239f6c9c 139 {
ttodorov 4:3ac4239f6c9c 140 for ( int i = x1; i <= x2; i++ )
ttodorov 4:3ac4239f6c9c 141 {
ttodorov 4:3ac4239f6c9c 142 SetXY( i, int( ty + 0.5 ), i, int( ty + 0.5 ) );
ttodorov 10:69571adcfad5 143 SetPixelColor( usedColor );
ttodorov 4:3ac4239f6c9c 144 ty = ty + delta;
ttodorov 4:3ac4239f6c9c 145 }
ttodorov 0:881ff0b71102 146 }
ttodorov 0:881ff0b71102 147 }
ttodorov 0:881ff0b71102 148 else
ttodorov 0:881ff0b71102 149 {
ttodorov 4:3ac4239f6c9c 150 delta = ( float( x2 - x1 ) / float( y2 - y1 ) );
ttodorov 4:3ac4239f6c9c 151 tx = float( x1 );
ttodorov 4:3ac4239f6c9c 152 if ( y1 > y2 )
ttodorov 0:881ff0b71102 153 {
ttodorov 4:3ac4239f6c9c 154 for ( int i = y2 + 1; i > y1; i-- )
ttodorov 4:3ac4239f6c9c 155 {
ttodorov 4:3ac4239f6c9c 156 SetXY( int( tx + 0.5 ), i, int( tx + 0.5 ), i );
ttodorov 10:69571adcfad5 157 SetPixelColor( usedColor );
ttodorov 4:3ac4239f6c9c 158 tx = tx + delta;
ttodorov 4:3ac4239f6c9c 159 }
ttodorov 4:3ac4239f6c9c 160 }
ttodorov 4:3ac4239f6c9c 161 else
ttodorov 4:3ac4239f6c9c 162 {
ttodorov 4:3ac4239f6c9c 163 for ( int i = y1; i < y2 + 1; i++ )
ttodorov 4:3ac4239f6c9c 164 {
ttodorov 4:3ac4239f6c9c 165 SetXY( int( tx + 0.5 ), i, int( tx + 0.5 ), i );
ttodorov 10:69571adcfad5 166 SetPixelColor( usedColor );
ttodorov 4:3ac4239f6c9c 167 tx = tx + delta;
ttodorov 4:3ac4239f6c9c 168 }
ttodorov 0:881ff0b71102 169 }
ttodorov 0:881ff0b71102 170 }
ttodorov 4:3ac4239f6c9c 171 Deactivate();
ttodorov 0:881ff0b71102 172 }
ttodorov 0:881ff0b71102 173 }
ttodorov 0:881ff0b71102 174
ttodorov 0:881ff0b71102 175 void LCD::DrawRect( unsigned short x1, unsigned short y1, unsigned short x2, unsigned short y2, int color )
ttodorov 0:881ff0b71102 176 {
ttodorov 0:881ff0b71102 177 if ( x1 > x2 ) swap( ushort, x1, x2 )
ttodorov 0:881ff0b71102 178 if ( y1 > y2 ) swap( ushort, y1, y2 )
ttodorov 0:881ff0b71102 179
ttodorov 2:81ed304b7e9b 180 DrawHLine( x1, y1, x2 - x1, color );
ttodorov 2:81ed304b7e9b 181 DrawHLine( x1, y2, x2 - x1, color );
ttodorov 2:81ed304b7e9b 182 DrawVLine( x1, y1, y2 - y1, color );
ttodorov 2:81ed304b7e9b 183 DrawVLine( x2, y1, y2 - y1, color );
ttodorov 0:881ff0b71102 184 }
ttodorov 0:881ff0b71102 185
ttodorov 0:881ff0b71102 186 void LCD::DrawRoundRect( unsigned short x1, unsigned short y1, unsigned short x2, unsigned short y2, int color )
ttodorov 0:881ff0b71102 187 {
ttodorov 0:881ff0b71102 188 if ( x1 > x2 ) swap( ushort, x1, x2 )
ttodorov 0:881ff0b71102 189 if ( y1 > y2 ) swap( ushort, y1, y2 )
ttodorov 0:881ff0b71102 190
ttodorov 0:881ff0b71102 191 if ( ( x2 - x1 ) > 4 && ( y2 - y1 ) > 4 )
ttodorov 0:881ff0b71102 192 {
ttodorov 0:881ff0b71102 193 DrawPixel( x1 + 1, y1 + 1, color );
ttodorov 0:881ff0b71102 194 DrawPixel( x2 - 1, y1 + 1, color );
ttodorov 0:881ff0b71102 195 DrawPixel( x1 + 1, y2 - 1, color );
ttodorov 0:881ff0b71102 196 DrawPixel( x2 - 1, y2 - 1, color );
ttodorov 2:81ed304b7e9b 197 DrawHLine( x1 + 2, y1, x2 - x1 - 4, color );
ttodorov 2:81ed304b7e9b 198 DrawHLine( x1 + 2, y2, x2 - x1 - 4, color );
ttodorov 2:81ed304b7e9b 199 DrawVLine( x1, y1 + 2, y2 - y1 - 4, color );
ttodorov 2:81ed304b7e9b 200 DrawVLine( x2, y1 + 2, y2 - y1 - 4, color );
ttodorov 0:881ff0b71102 201 }
ttodorov 0:881ff0b71102 202 }
ttodorov 0:881ff0b71102 203
ttodorov 0:881ff0b71102 204 void LCD::FillRect( unsigned short x1, unsigned short y1, unsigned short x2, unsigned short y2, int color )
ttodorov 0:881ff0b71102 205 {
ttodorov 0:881ff0b71102 206 if ( x1 > x2 ) swap( ushort, x1, x2 );
ttodorov 0:881ff0b71102 207 if ( y1 > y2 ) swap( ushort, y1, y2 );
ttodorov 0:881ff0b71102 208
ttodorov 0:881ff0b71102 209 if ( _orientation == PORTRAIT )
ttodorov 0:881ff0b71102 210 {
ttodorov 0:881ff0b71102 211 for ( int i = 0; i < ( ( y2 - y1 ) / 2 ) + 1; i++ )
ttodorov 0:881ff0b71102 212 {
ttodorov 2:81ed304b7e9b 213 DrawHLine( x1, y1 + i, x2 - x1, color );
ttodorov 2:81ed304b7e9b 214 DrawHLine( x1, y2 - i, x2 - x1, color );
ttodorov 0:881ff0b71102 215 }
ttodorov 0:881ff0b71102 216 }
ttodorov 0:881ff0b71102 217 else
ttodorov 0:881ff0b71102 218 {
ttodorov 0:881ff0b71102 219 for ( int i = 0; i < ( ( x2 - x1 ) / 2 ) + 1; i++ )
ttodorov 0:881ff0b71102 220 {
ttodorov 2:81ed304b7e9b 221 DrawVLine( x1 + i, y1, y2 - y1, color );
ttodorov 2:81ed304b7e9b 222 DrawVLine( x2 - i, y1, y2 - y1, color );
ttodorov 0:881ff0b71102 223 }
ttodorov 0:881ff0b71102 224 }
ttodorov 0:881ff0b71102 225 }
ttodorov 0:881ff0b71102 226
ttodorov 0:881ff0b71102 227 void LCD::FillRoundRect( unsigned short x1, unsigned short y1, unsigned short x2, unsigned short y2, int color )
ttodorov 0:881ff0b71102 228 {
ttodorov 0:881ff0b71102 229 if ( x1 > x2 ) swap( ushort, x1, x2 )
ttodorov 0:881ff0b71102 230 if ( y1 > y2 ) swap( ushort, y1, y2 )
ttodorov 0:881ff0b71102 231
ttodorov 0:881ff0b71102 232 if ( ( x2 - x1 ) > 4 && ( y2 - y1 ) > 4 )
ttodorov 0:881ff0b71102 233 {
ttodorov 0:881ff0b71102 234 for ( int i = 0; i < ( ( y2 - y1 ) / 2 ) + 1; i++ )
ttodorov 0:881ff0b71102 235 {
ttodorov 0:881ff0b71102 236 switch ( i )
ttodorov 0:881ff0b71102 237 {
ttodorov 0:881ff0b71102 238 case 0:
ttodorov 2:81ed304b7e9b 239 DrawHLine( x1 + 2, y1 + i, x2 - x1 - 4, color );
ttodorov 2:81ed304b7e9b 240 DrawHLine( x1 + 2, y2 - i, x2 - x1 - 4, color );
ttodorov 0:881ff0b71102 241 break;
ttodorov 0:881ff0b71102 242
ttodorov 0:881ff0b71102 243 case 1:
ttodorov 2:81ed304b7e9b 244 DrawHLine( x1 + 1, y1 + i, x2 - x1 - 2, color );
ttodorov 2:81ed304b7e9b 245 DrawHLine( x1 + 1, y2 - i, x2 - x1 - 2, color );
ttodorov 0:881ff0b71102 246 break;
ttodorov 0:881ff0b71102 247
ttodorov 0:881ff0b71102 248 default:
ttodorov 2:81ed304b7e9b 249 DrawHLine( x1, y1 + i, x2 - x1, color );
ttodorov 2:81ed304b7e9b 250 DrawHLine( x1, y2 - i, x2 - x1, color );
ttodorov 0:881ff0b71102 251 break;
ttodorov 0:881ff0b71102 252 }
ttodorov 0:881ff0b71102 253 }
ttodorov 0:881ff0b71102 254 }
ttodorov 0:881ff0b71102 255 }
ttodorov 0:881ff0b71102 256
ttodorov 0:881ff0b71102 257 void LCD::DrawCircle( unsigned short x, unsigned short y, unsigned short radius, int color )
ttodorov 0:881ff0b71102 258 {
ttodorov 0:881ff0b71102 259 int f = 1 - radius;
ttodorov 0:881ff0b71102 260 int ddF_x = 1;
ttodorov 0:881ff0b71102 261 int ddF_y = -2 * radius;
ttodorov 0:881ff0b71102 262 int x1 = 0;
ttodorov 0:881ff0b71102 263 int y1 = radius;
ttodorov 9:58b328831d0a 264 unsigned short usedColor = color == -1 ? _background : color == -2 ? _foreground : ( unsigned short ) color;
ttodorov 0:881ff0b71102 265
ttodorov 4:3ac4239f6c9c 266 Activate();
ttodorov 2:81ed304b7e9b 267 SetXY( x, y + radius, x, y + radius );
ttodorov 10:69571adcfad5 268 SetPixelColor( usedColor );
ttodorov 2:81ed304b7e9b 269 SetXY( x, y - radius, x, y - radius );
ttodorov 10:69571adcfad5 270 SetPixelColor( usedColor );
ttodorov 2:81ed304b7e9b 271 SetXY( x + radius, y, x + radius, y );
ttodorov 10:69571adcfad5 272 SetPixelColor( usedColor );
ttodorov 2:81ed304b7e9b 273 SetXY( x - radius, y, x - radius, y );
ttodorov 10:69571adcfad5 274 SetPixelColor( usedColor );
ttodorov 0:881ff0b71102 275
ttodorov 0:881ff0b71102 276 while ( x1 < y1 )
ttodorov 0:881ff0b71102 277 {
ttodorov 0:881ff0b71102 278 if ( f >= 0 )
ttodorov 0:881ff0b71102 279 {
ttodorov 0:881ff0b71102 280 y1--;
ttodorov 0:881ff0b71102 281 ddF_y += 2;
ttodorov 0:881ff0b71102 282 f += ddF_y;
ttodorov 0:881ff0b71102 283 }
ttodorov 0:881ff0b71102 284 x1++;
ttodorov 0:881ff0b71102 285 ddF_x += 2;
ttodorov 0:881ff0b71102 286 f += ddF_x;
ttodorov 2:81ed304b7e9b 287 SetXY( x + x1, y + y1, x + x1, y + y1 );
ttodorov 10:69571adcfad5 288 SetPixelColor( usedColor );
ttodorov 2:81ed304b7e9b 289 SetXY( x - x1, y + y1, x - x1, y + y1 );
ttodorov 10:69571adcfad5 290 SetPixelColor( usedColor );
ttodorov 2:81ed304b7e9b 291 SetXY( x + x1, y - y1, x + x1, y - y1 );
ttodorov 10:69571adcfad5 292 SetPixelColor( usedColor );
ttodorov 2:81ed304b7e9b 293 SetXY( x - x1, y - y1, x - x1, y - y1 );
ttodorov 10:69571adcfad5 294 SetPixelColor( usedColor );
ttodorov 2:81ed304b7e9b 295 SetXY( x + y1, y + x1, x + y1, y + x1 );
ttodorov 10:69571adcfad5 296 SetPixelColor( usedColor );
ttodorov 2:81ed304b7e9b 297 SetXY( x - y1, y + x1, x - y1, y + x1 );
ttodorov 10:69571adcfad5 298 SetPixelColor( usedColor );
ttodorov 2:81ed304b7e9b 299 SetXY( x + y1, y - x1, x + y1, y - x1 );
ttodorov 10:69571adcfad5 300 SetPixelColor( usedColor );
ttodorov 2:81ed304b7e9b 301 SetXY( x - y1, y - x1, x - y1, y - x1 );
ttodorov 10:69571adcfad5 302 SetPixelColor( usedColor );
ttodorov 0:881ff0b71102 303 }
ttodorov 4:3ac4239f6c9c 304 Deactivate();
ttodorov 0:881ff0b71102 305 }
ttodorov 0:881ff0b71102 306
ttodorov 0:881ff0b71102 307 void LCD::FillCircle( unsigned short x, unsigned short y, unsigned short radius, int color )
ttodorov 0:881ff0b71102 308 {
ttodorov 9:58b328831d0a 309 unsigned short usedColor = color == -1 ? _background : color == -2 ? _foreground : ( unsigned short ) color;
ttodorov 4:3ac4239f6c9c 310 Activate();
ttodorov 0:881ff0b71102 311 for ( int y1 = -radius; y1 <= radius; y1++ )
ttodorov 0:881ff0b71102 312 for ( int x1 = -radius; x1 <= radius; x1++ )
ttodorov 0:881ff0b71102 313 if ( x1 * x1 + y1 * y1 <= radius * radius )
ttodorov 0:881ff0b71102 314 {
ttodorov 2:81ed304b7e9b 315 SetXY( x + x1, y + y1, x + x1, y + y1 );
ttodorov 10:69571adcfad5 316 SetPixelColor( usedColor );
ttodorov 0:881ff0b71102 317 }
ttodorov 4:3ac4239f6c9c 318 Deactivate();
ttodorov 0:881ff0b71102 319 }
ttodorov 0:881ff0b71102 320
ttodorov 0:881ff0b71102 321 void LCD::Print( const char *str, unsigned short x, unsigned short y, int fgColor, int bgColor, unsigned short deg )
ttodorov 0:881ff0b71102 322 {
ttodorov 0:881ff0b71102 323 int stl, i;
ttodorov 0:881ff0b71102 324
ttodorov 0:881ff0b71102 325 stl = strlen( str );
ttodorov 0:881ff0b71102 326
ttodorov 0:881ff0b71102 327 if ( _orientation == PORTRAIT )
ttodorov 0:881ff0b71102 328 {
ttodorov 0:881ff0b71102 329 if ( x == RIGHT )
ttodorov 1:14bef43daf6f 330 x = _disp_width - ( stl * _font.width );
ttodorov 0:881ff0b71102 331 if ( x == CENTER )
ttodorov 1:14bef43daf6f 332 x = ( _disp_width - ( stl * _font.width ) ) / 2;
ttodorov 0:881ff0b71102 333 }
ttodorov 0:881ff0b71102 334 else
ttodorov 0:881ff0b71102 335 {
ttodorov 0:881ff0b71102 336 if ( x == RIGHT )
ttodorov 1:14bef43daf6f 337 x = _disp_height - ( stl * _font.width );
ttodorov 0:881ff0b71102 338 if ( x == CENTER )
ttodorov 1:14bef43daf6f 339 x = ( _disp_height - ( stl * _font.width ) ) / 2;
ttodorov 0:881ff0b71102 340 }
ttodorov 0:881ff0b71102 341
ttodorov 0:881ff0b71102 342 for ( i = 0; i < stl; i++ )
ttodorov 0:881ff0b71102 343 if ( deg == 0 )
ttodorov 2:81ed304b7e9b 344 PrintChar( *str++, x + ( i * ( _font.width ) ), y, fgColor, bgColor );
ttodorov 0:881ff0b71102 345 else
ttodorov 2:81ed304b7e9b 346 RotateChar( *str++, x, y, i, fgColor, bgColor, deg );
ttodorov 0:881ff0b71102 347 }
ttodorov 0:881ff0b71102 348
ttodorov 7:5c418fc1879f 349 void LCD::DrawBitmap( unsigned short x, unsigned short y, unsigned short sx, unsigned short sy, const unsigned short* imgPixelData, unsigned char scale )
ttodorov 0:881ff0b71102 350 {
ttodorov 0:881ff0b71102 351 int tx, ty, tc, tsx, tsy;
ttodorov 0:881ff0b71102 352
ttodorov 4:3ac4239f6c9c 353 Activate();
ttodorov 0:881ff0b71102 354 if ( scale == 1 )
ttodorov 0:881ff0b71102 355 {
ttodorov 0:881ff0b71102 356 if ( _orientation == PORTRAIT )
ttodorov 0:881ff0b71102 357 {
ttodorov 2:81ed304b7e9b 358 SetXY( x, y, x + sx - 1, y + sy - 1 );
ttodorov 0:881ff0b71102 359 for ( tc = 0; tc < ( sx * sy ); tc++ )
ttodorov 10:69571adcfad5 360 SetPixelColor( imgPixelData[ tc ] );
ttodorov 0:881ff0b71102 361 }
ttodorov 0:881ff0b71102 362 else
ttodorov 0:881ff0b71102 363 {
ttodorov 0:881ff0b71102 364 for ( ty = 0; ty < sy; ty++ )
ttodorov 0:881ff0b71102 365 {
ttodorov 2:81ed304b7e9b 366 SetXY( x, y + ty, x + sx - 1, y + ty );
ttodorov 0:881ff0b71102 367 for ( tx = sx; tx >= 0; tx-- )
ttodorov 10:69571adcfad5 368 SetPixelColor( imgPixelData[ ( ty * sx ) + tx ] );
ttodorov 0:881ff0b71102 369 }
ttodorov 0:881ff0b71102 370 }
ttodorov 0:881ff0b71102 371 }
ttodorov 0:881ff0b71102 372 else
ttodorov 0:881ff0b71102 373 {
ttodorov 0:881ff0b71102 374 if ( _orientation == PORTRAIT )
ttodorov 0:881ff0b71102 375 {
ttodorov 0:881ff0b71102 376 for ( ty = 0; ty < sy; ty++ )
ttodorov 0:881ff0b71102 377 {
ttodorov 2:81ed304b7e9b 378 SetXY( x, y + ( ty * scale ), x + ( ( sx * scale ) - 1 ), y + ( ty * scale ) + scale );
ttodorov 0:881ff0b71102 379 for ( tsy = 0; tsy < scale; tsy++ )
ttodorov 0:881ff0b71102 380 for ( tx = 0; tx < sx; tx++ )
ttodorov 0:881ff0b71102 381 for ( tsx = 0; tsx < scale; tsx++ )
ttodorov 10:69571adcfad5 382 SetPixelColor( imgPixelData[ ( ty * sx ) + tx ] );
ttodorov 0:881ff0b71102 383 }
ttodorov 0:881ff0b71102 384 }
ttodorov 0:881ff0b71102 385 else
ttodorov 0:881ff0b71102 386 {
ttodorov 0:881ff0b71102 387 for ( ty = 0; ty < sy; ty++ )
ttodorov 0:881ff0b71102 388 {
ttodorov 0:881ff0b71102 389 for ( tsy = 0; tsy < scale; tsy++ )
ttodorov 0:881ff0b71102 390 {
ttodorov 2:81ed304b7e9b 391 SetXY( x, y + ( ty * scale ) + tsy, x + ( ( sx * scale ) - 1 ), y + ( ty * scale ) + tsy );
ttodorov 0:881ff0b71102 392 for ( tx = sx; tx >= 0; tx-- )
ttodorov 0:881ff0b71102 393 for ( tsx = 0; tsx < scale; tsx++ )
ttodorov 10:69571adcfad5 394 SetPixelColor( imgPixelData[ ( ty * sx ) + tx ] );
ttodorov 0:881ff0b71102 395 }
ttodorov 0:881ff0b71102 396 }
ttodorov 0:881ff0b71102 397 }
ttodorov 0:881ff0b71102 398 }
ttodorov 4:3ac4239f6c9c 399 Deactivate();
ttodorov 0:881ff0b71102 400 }
ttodorov 0:881ff0b71102 401
ttodorov 7:5c418fc1879f 402 void LCD::DrawBitmap( unsigned short x, unsigned short y, unsigned short sx, unsigned short sy, const unsigned short* imgPixelData, unsigned short deg, unsigned short rox, unsigned short roy )
ttodorov 0:881ff0b71102 403 {
ttodorov 0:881ff0b71102 404 int tx, ty, newx, newy;
ttodorov 0:881ff0b71102 405 double radian;
ttodorov 0:881ff0b71102 406 radian = deg * 0.0175;
ttodorov 0:881ff0b71102 407
ttodorov 0:881ff0b71102 408 if ( deg == 0 )
ttodorov 7:5c418fc1879f 409 DrawBitmap( x, y, sx, sy, imgPixelData );
ttodorov 0:881ff0b71102 410 else
ttodorov 0:881ff0b71102 411 {
ttodorov 4:3ac4239f6c9c 412 Activate();
ttodorov 0:881ff0b71102 413 for ( ty = 0; ty < sy; ty++ )
ttodorov 0:881ff0b71102 414 for ( tx = 0; tx < sx; tx++ )
ttodorov 0:881ff0b71102 415 {
ttodorov 0:881ff0b71102 416 newx = x + rox + ( ( ( tx - rox ) * cos( radian ) ) - ( ( ty - roy ) * sin( radian ) ) );
ttodorov 0:881ff0b71102 417 newy = y + roy + ( ( ( ty - roy ) * cos( radian ) ) + ( ( tx - rox ) * sin( radian ) ) );
ttodorov 0:881ff0b71102 418
ttodorov 2:81ed304b7e9b 419 SetXY( newx, newy, newx, newy );
ttodorov 10:69571adcfad5 420 SetPixelColor( imgPixelData[ ( ty * sx ) + tx ] );
ttodorov 0:881ff0b71102 421 }
ttodorov 4:3ac4239f6c9c 422 Deactivate();
ttodorov 0:881ff0b71102 423 }
ttodorov 4:3ac4239f6c9c 424 }
ttodorov 4:3ac4239f6c9c 425
ttodorov 4:3ac4239f6c9c 426 inline
ttodorov 4:3ac4239f6c9c 427 void LCD::Activate( void )
ttodorov 4:3ac4239f6c9c 428 {
ttodorov 4:3ac4239f6c9c 429 _lcd_pin_cs = LOW;
ttodorov 4:3ac4239f6c9c 430 }
ttodorov 4:3ac4239f6c9c 431
ttodorov 4:3ac4239f6c9c 432 inline
ttodorov 4:3ac4239f6c9c 433 void LCD::Deactivate( void )
ttodorov 4:3ac4239f6c9c 434 {
ttodorov 4:3ac4239f6c9c 435 _lcd_pin_cs = HIGH;
ttodorov 0:881ff0b71102 436 }
ttodorov 0:881ff0b71102 437
ttodorov 0:881ff0b71102 438 /*
ttodorov 4:3ac4239f6c9c 439 void LCD::WriteCmd( unsigned short cmd )
ttodorov 0:881ff0b71102 440 {
ttodorov 0:881ff0b71102 441 _lcd_pin_rs = LOW;
ttodorov 0:881ff0b71102 442 _lcd_port->write( cmd );
ttodorov 0:881ff0b71102 443 pulseLow( _lcd_pin_wr );
ttodorov 0:881ff0b71102 444 }
ttodorov 0:881ff0b71102 445 */
ttodorov 0:881ff0b71102 446
ttodorov 0:881ff0b71102 447 /*
ttodorov 4:3ac4239f6c9c 448 void LCD::WriteData( unsigned short data )
ttodorov 0:881ff0b71102 449 {
ttodorov 0:881ff0b71102 450 _lcd_pin_rs = HIGH;
ttodorov 0:881ff0b71102 451 _lcd_port->write( data );
ttodorov 0:881ff0b71102 452 pulseLow( _lcd_pin_wr );
ttodorov 0:881ff0b71102 453 }
ttodorov 0:881ff0b71102 454 */
ttodorov 0:881ff0b71102 455
ttodorov 0:881ff0b71102 456 inline
ttodorov 2:81ed304b7e9b 457 void LCD::WriteCmdData( unsigned short cmd, unsigned short data )
ttodorov 0:881ff0b71102 458 {
ttodorov 2:81ed304b7e9b 459 WriteCmd( cmd );
ttodorov 2:81ed304b7e9b 460 WriteData( data );
ttodorov 0:881ff0b71102 461 }
ttodorov 0:881ff0b71102 462
ttodorov 0:881ff0b71102 463 /*
ttodorov 4:3ac4239f6c9c 464 void LCD::SetXY( uint16_t x1, uint16_t y1, uint16_t x2, uint16_t y2 )
ttodorov 0:881ff0b71102 465 {
ttodorov 0:881ff0b71102 466 if ( _orientation == LANDSCAPE )
ttodorov 0:881ff0b71102 467 {
ttodorov 0:881ff0b71102 468 swap( uint16_t, x1, y1 )
ttodorov 0:881ff0b71102 469 swap( uint16_t, x2, y2 )
ttodorov 0:881ff0b71102 470 y1 = _disp_height - y1;
ttodorov 0:881ff0b71102 471 y2 = _disp_height - y2;
ttodorov 0:881ff0b71102 472 swap( uint16_t, y1, y2 )
ttodorov 0:881ff0b71102 473 }
ttodorov 0:881ff0b71102 474
ttodorov 4:3ac4239f6c9c 475 WriteCmdData( 0x44, ( x2 << 8 ) + x1 );
ttodorov 4:3ac4239f6c9c 476 WriteCmdData( 0x45, y1 );
ttodorov 4:3ac4239f6c9c 477 WriteCmdData( 0x46, y2 );
ttodorov 4:3ac4239f6c9c 478 WriteCmdData( 0x4e, x1 );
ttodorov 4:3ac4239f6c9c 479 WriteCmdData( 0x4f, y1 );
ttodorov 4:3ac4239f6c9c 480 WriteCmd( 0x22 );
ttodorov 0:881ff0b71102 481 }
ttodorov 0:881ff0b71102 482 */
ttodorov 0:881ff0b71102 483
ttodorov 2:81ed304b7e9b 484 void LCD::ClearXY()
ttodorov 0:881ff0b71102 485 {
ttodorov 0:881ff0b71102 486 if ( _orientation == PORTRAIT )
ttodorov 2:81ed304b7e9b 487 SetXY( 0, 0, _disp_width - 1, _disp_height - 1 );
ttodorov 0:881ff0b71102 488 else
ttodorov 2:81ed304b7e9b 489 SetXY( 0, 0, _disp_height - 1, _disp_width - 1 );
ttodorov 0:881ff0b71102 490 }
ttodorov 0:881ff0b71102 491
ttodorov 2:81ed304b7e9b 492 void LCD::DrawHLine( unsigned short x, unsigned short y, unsigned short len, int color )
ttodorov 0:881ff0b71102 493 {
ttodorov 9:58b328831d0a 494 unsigned short usedColor = color == -1 ? _background : color == -2 ? _foreground : ( unsigned short ) color;
ttodorov 0:881ff0b71102 495
ttodorov 4:3ac4239f6c9c 496 Activate();
ttodorov 2:81ed304b7e9b 497 SetXY( x, y, x + len, y );
ttodorov 0:881ff0b71102 498 for ( int i = 0; i < len + 1; i++ )
ttodorov 10:69571adcfad5 499 SetPixelColor( usedColor );
ttodorov 4:3ac4239f6c9c 500 Deactivate();
ttodorov 0:881ff0b71102 501 }
ttodorov 0:881ff0b71102 502
ttodorov 2:81ed304b7e9b 503 void LCD::DrawVLine( unsigned short x, unsigned short y, unsigned short len, int color )
ttodorov 0:881ff0b71102 504 {
ttodorov 9:58b328831d0a 505 unsigned short usedColor = color == -1 ? _background : color == -2 ? _foreground : ( unsigned short ) color;
ttodorov 0:881ff0b71102 506
ttodorov 4:3ac4239f6c9c 507 Activate();
ttodorov 2:81ed304b7e9b 508 SetXY( x, y, x, y + len );
ttodorov 0:881ff0b71102 509 for ( int i = 0; i < len; i++ )
ttodorov 10:69571adcfad5 510 SetPixelColor( usedColor );
ttodorov 4:3ac4239f6c9c 511 Deactivate();
ttodorov 0:881ff0b71102 512 }
ttodorov 0:881ff0b71102 513
ttodorov 2:81ed304b7e9b 514 void LCD::PrintChar( char c, unsigned short x, unsigned short y, int fgColor, int bgColor )
ttodorov 0:881ff0b71102 515 {
ttodorov 0:881ff0b71102 516 uint8_t i, ch;
ttodorov 0:881ff0b71102 517 uint16_t j;
ttodorov 0:881ff0b71102 518 uint16_t temp;
ttodorov 9:58b328831d0a 519 unsigned short usedColorFG = fgColor == -1 ? _background : fgColor == -2 ? _foreground : ( unsigned short ) fgColor;
ttodorov 9:58b328831d0a 520 unsigned short usedColorBG = bgColor == -1 ? _background : bgColor == -2 ? _foreground : ( unsigned short ) bgColor;
ttodorov 0:881ff0b71102 521
ttodorov 4:3ac4239f6c9c 522 Activate();
ttodorov 0:881ff0b71102 523
ttodorov 0:881ff0b71102 524 if ( _orientation == PORTRAIT )
ttodorov 0:881ff0b71102 525 {
ttodorov 2:81ed304b7e9b 526 SetXY( x, y, x + _font.width - 1, y + _font.height - 1 );
ttodorov 0:881ff0b71102 527
ttodorov 0:881ff0b71102 528 temp = ( ( c - _font.offset ) * ( ( _font.width / 8 ) * _font.height ) ) + 4;
ttodorov 0:881ff0b71102 529 for ( j = 0; j < ( ( _font.width / 8 ) * _font.height ); j++ )
ttodorov 0:881ff0b71102 530 {
ttodorov 0:881ff0b71102 531 ch = _font.font[ temp ];
ttodorov 0:881ff0b71102 532 for ( i = 0; i < 8; i++ )
ttodorov 0:881ff0b71102 533 {
ttodorov 0:881ff0b71102 534 if ( ( ch & ( 1 << ( 7 - i ) ) ) != 0 )
ttodorov 10:69571adcfad5 535 SetPixelColor( usedColorFG );
ttodorov 0:881ff0b71102 536 else
ttodorov 10:69571adcfad5 537 SetPixelColor( usedColorBG );
ttodorov 0:881ff0b71102 538 }
ttodorov 0:881ff0b71102 539 temp++;
ttodorov 0:881ff0b71102 540 }
ttodorov 0:881ff0b71102 541 }
ttodorov 0:881ff0b71102 542 else
ttodorov 0:881ff0b71102 543 {
ttodorov 0:881ff0b71102 544 temp = ( ( c - _font.offset ) * ( ( _font.width / 8 ) * _font.height ) ) + 4;
ttodorov 0:881ff0b71102 545
ttodorov 0:881ff0b71102 546 for ( j = 0; j < ( ( _font.width / 8 ) * _font.height ); j += ( _font.width / 8 ) )
ttodorov 0:881ff0b71102 547 {
ttodorov 2:81ed304b7e9b 548 SetXY( x, y + ( j / ( _font.width / 8 ) ), x + _font.width - 1, y + ( j / ( _font.width / 8 ) ) );
ttodorov 0:881ff0b71102 549 for ( int zz = ( _font.width / 8 ) - 1; zz >= 0; zz-- )
ttodorov 0:881ff0b71102 550 {
ttodorov 0:881ff0b71102 551 ch = _font.font[ temp + zz ];
ttodorov 0:881ff0b71102 552 for ( i = 0; i < 8; i++ )
ttodorov 0:881ff0b71102 553 {
ttodorov 0:881ff0b71102 554 if ( ( ch & ( 1 << i ) ) != 0 )
ttodorov 10:69571adcfad5 555 SetPixelColor( usedColorFG );
ttodorov 0:881ff0b71102 556 else
ttodorov 10:69571adcfad5 557 SetPixelColor( usedColorBG );
ttodorov 0:881ff0b71102 558 }
ttodorov 0:881ff0b71102 559 }
ttodorov 0:881ff0b71102 560 temp += ( _font.width / 8 );
ttodorov 0:881ff0b71102 561 }
ttodorov 0:881ff0b71102 562 }
ttodorov 4:3ac4239f6c9c 563 Deactivate();
ttodorov 0:881ff0b71102 564 }
ttodorov 0:881ff0b71102 565
ttodorov 2:81ed304b7e9b 566 void LCD::RotateChar( char c, unsigned short x, unsigned short y, int pos, int fgColor, int bgColor, unsigned short deg )
ttodorov 0:881ff0b71102 567 {
ttodorov 0:881ff0b71102 568 uint8_t i, j, ch;
ttodorov 0:881ff0b71102 569 uint16_t temp;
ttodorov 0:881ff0b71102 570 int newx, newy;
ttodorov 0:881ff0b71102 571 double radian;
ttodorov 0:881ff0b71102 572 radian = deg * 0.0175;
ttodorov 0:881ff0b71102 573
ttodorov 9:58b328831d0a 574 unsigned short usedColorFG = fgColor == -1 ? _background : fgColor == -2 ? _foreground : ( unsigned short ) fgColor;
ttodorov 9:58b328831d0a 575 unsigned short usedColorBG = bgColor == -1 ? _background : bgColor == -2 ? _foreground : ( unsigned short ) bgColor;
ttodorov 0:881ff0b71102 576
ttodorov 4:3ac4239f6c9c 577 Activate();
ttodorov 0:881ff0b71102 578
ttodorov 0:881ff0b71102 579 temp = ( ( c - _font.offset ) * ( ( _font.width / 8 ) * _font.height ) ) + 4;
ttodorov 0:881ff0b71102 580 for ( j = 0; j < _font.height; j++ )
ttodorov 0:881ff0b71102 581 {
ttodorov 0:881ff0b71102 582 for ( int zz = 0; zz < ( _font.width / 8 ); zz++ )
ttodorov 0:881ff0b71102 583 {
ttodorov 0:881ff0b71102 584 ch = _font.font[ temp + zz ];
ttodorov 0:881ff0b71102 585 for ( i = 0; i < 8; i++ )
ttodorov 0:881ff0b71102 586 {
ttodorov 0:881ff0b71102 587 newx = x + ( ( ( i + ( zz * 8 ) + ( pos * _font.width ) ) * cos( radian ) ) - ( ( j ) * sin( radian ) ) );
ttodorov 0:881ff0b71102 588 newy = y + ( ( ( j ) * cos( radian ) ) + ( ( i + ( zz * 8 ) + ( pos * _font.width ) ) * sin( radian ) ) );
ttodorov 0:881ff0b71102 589
ttodorov 2:81ed304b7e9b 590 SetXY( newx, newy, newx + 1, newy + 1 );
ttodorov 0:881ff0b71102 591
ttodorov 0:881ff0b71102 592 if ( ( ch & ( 1 << ( 7 - i ) ) ) != 0 )
ttodorov 10:69571adcfad5 593 SetPixelColor( usedColorFG );
ttodorov 0:881ff0b71102 594 else
ttodorov 10:69571adcfad5 595 SetPixelColor( usedColorBG );
ttodorov 0:881ff0b71102 596 }
ttodorov 0:881ff0b71102 597 }
ttodorov 0:881ff0b71102 598 temp += ( _font.width / 8 );
ttodorov 0:881ff0b71102 599 }
ttodorov 4:3ac4239f6c9c 600 Deactivate();
ttodorov 0:881ff0b71102 601 }