en 129 / TFTLCDwithFastIO

TFTLCD with FastIO

Fork of TFTLCD by en 129

lcd_base.cpp@30:1e9905bdfd15, 2015-07-30 (annotated)

Committer:
nameless129
Date:
Thu Jul 30 02:35:08 2015 +0000
Revision:
30:1e9905bdfd15
Parent:
22:4c169297f374 
change:use FastIO

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 22:4c169297f374 25 LCD::LCD( unsigned short width, unsigned short height ,PinName CS, PinName RS, PinName RESET, PinName BL, backlight_t blType, float defaultBacklight )
ttodorov 22:4c169297f374 26 : _disp_width( width ), _disp_height( height ), _lcd_pin_cs( CS ), _lcd_pin_rs( RS ), _lcd_pin_reset( RESET ), _bl_type( blType )
ttodorov 4:3ac4239f6c9c 27 {
ttodorov 4:3ac4239f6c9c 28 SetForeground();
ttodorov 4:3ac4239f6c9c 29 SetBackground();
ttodorov 21:e5c1e8ffada1 30 _font = &TerminusFont;
ttodorov 22:4c169297f374 31 if ( defaultBacklight < 0 ) _bl_pwm_default = 0;
ttodorov 22:4c169297f374 32 else if ( defaultBacklight > 1.0 ) _bl_pwm_default = 1.0;
ttodorov 22:4c169297f374 33 else _bl_pwm_default = defaultBacklight;
ttodorov 22:4c169297f374 34 if ( BL != NC )
ttodorov 22:4c169297f374 35 {
ttodorov 22:4c169297f374 36 if ( blType == Constant )
ttodorov 22:4c169297f374 37 {
ttodorov 22:4c169297f374 38 _bl_pwm = 0;
ttodorov 22:4c169297f374 39 _lcd_pin_bl = new DigitalOut( BL );
ttodorov 22:4c169297f374 40 }
ttodorov 22:4c169297f374 41 else
ttodorov 22:4c169297f374 42 {
ttodorov 22:4c169297f374 43 _lcd_pin_bl = 0;
ttodorov 22:4c169297f374 44 _bl_pwm = new PwmOut( BL );
ttodorov 22:4c169297f374 45 _bl_pwm->period_ms( 8.33 ); // 120 Hz
ttodorov 22:4c169297f374 46 _bl_pwm_current = _bl_pwm_default;
ttodorov 22:4c169297f374 47 // initially off
ttodorov 22:4c169297f374 48 *_bl_pwm = 0;
ttodorov 22:4c169297f374 49 }
ttodorov 22:4c169297f374 50
ttodorov 22:4c169297f374 51 }
ttodorov 22:4c169297f374 52 else
ttodorov 22:4c169297f374 53 {
ttodorov 22:4c169297f374 54 _lcd_pin_bl = 0;
ttodorov 22:4c169297f374 55 _bl_pwm = 0;
ttodorov 22:4c169297f374 56 }
ttodorov 22:4c169297f374 57 }
ttodorov 22:4c169297f374 58
ttodorov 22:4c169297f374 59 void LCD::Sleep( void )
ttodorov 22:4c169297f374 60 {
ttodorov 22:4c169297f374 61 if ( _lcd_pin_bl != 0 )
ttodorov 22:4c169297f374 62 *_lcd_pin_bl = LOW;
ttodorov 22:4c169297f374 63 else if ( _bl_pwm != 0 )
ttodorov 22:4c169297f374 64 *_bl_pwm = 0;
ttodorov 22:4c169297f374 65 }
ttodorov 22:4c169297f374 66
ttodorov 22:4c169297f374 67 void LCD::WakeUp( void )
ttodorov 22:4c169297f374 68 {
ttodorov 22:4c169297f374 69 if ( _lcd_pin_bl != 0 )
ttodorov 22:4c169297f374 70 *_lcd_pin_bl = HIGH;
ttodorov 22:4c169297f374 71 else if ( _bl_pwm != 0 )
ttodorov 22:4c169297f374 72 *_bl_pwm = _bl_pwm_current;
ttodorov 4:3ac4239f6c9c 73 }
ttodorov 0:881ff0b71102 74
ttodorov 0:881ff0b71102 75 inline
ttodorov 12:d0978272a340 76 void LCD::SetForeground( unsigned int color )
ttodorov 0:881ff0b71102 77 {
ttodorov 0:881ff0b71102 78 _foreground = color;
ttodorov 0:881ff0b71102 79 }
ttodorov 0:881ff0b71102 80
ttodorov 0:881ff0b71102 81 inline
ttodorov 12:d0978272a340 82 void LCD::SetBackground( unsigned int color )
ttodorov 0:881ff0b71102 83 {
ttodorov 0:881ff0b71102 84 _background = color;
ttodorov 0:881ff0b71102 85 }
ttodorov 0:881ff0b71102 86
ttodorov 21:e5c1e8ffada1 87 void LCD::SetFont( const font_t *font )
ttodorov 0:881ff0b71102 88 {
ttodorov 21:e5c1e8ffada1 89 _font = font;
ttodorov 0:881ff0b71102 90 }
ttodorov 0:881ff0b71102 91
ttodorov 0:881ff0b71102 92 inline
ttodorov 0:881ff0b71102 93 unsigned short LCD::GetWidth( void )
ttodorov 0:881ff0b71102 94 {
ttodorov 12:d0978272a340 95 if ( _orientation == LANDSCAPE || _orientation == LANDSCAPE_REV ) return _disp_height;
ttodorov 0:881ff0b71102 96 return _disp_width;
ttodorov 0:881ff0b71102 97 }
ttodorov 0:881ff0b71102 98
ttodorov 0:881ff0b71102 99 inline
ttodorov 0:881ff0b71102 100 unsigned short LCD::GetHeight( void )
ttodorov 0:881ff0b71102 101 {
ttodorov 12:d0978272a340 102 if ( _orientation == LANDSCAPE || _orientation == LANDSCAPE_REV ) return _disp_width;
ttodorov 0:881ff0b71102 103 return _disp_height;
ttodorov 0:881ff0b71102 104 }
ttodorov 0:881ff0b71102 105
ttodorov 21:e5c1e8ffada1 106 inline
ttodorov 21:e5c1e8ffada1 107 uint8_t LCD::GetFontWidth( void )
ttodorov 21:e5c1e8ffada1 108 {
ttodorov 21:e5c1e8ffada1 109 if ( _font != 0 ) return _font->Width;
ttodorov 21:e5c1e8ffada1 110 return 0;
ttodorov 21:e5c1e8ffada1 111 }
ttodorov 21:e5c1e8ffada1 112
ttodorov 21:e5c1e8ffada1 113 inline
ttodorov 21:e5c1e8ffada1 114 uint8_t LCD::GetFontHeight( void )
ttodorov 21:e5c1e8ffada1 115 {
ttodorov 21:e5c1e8ffada1 116 if ( _font != 0 ) return _font->Height;
ttodorov 21:e5c1e8ffada1 117 return 0;
ttodorov 21:e5c1e8ffada1 118 }
ttodorov 21:e5c1e8ffada1 119
ttodorov 22:4c169297f374 120 void LCD::SetBacklightLevel( float level )
ttodorov 22:4c169297f374 121 {
ttodorov 22:4c169297f374 122 switch ( _bl_type )
ttodorov 22:4c169297f374 123 {
ttodorov 22:4c169297f374 124 case Direct:
ttodorov 22:4c169297f374 125 if ( _bl_pwm != 0 )
ttodorov 22:4c169297f374 126 {
ttodorov 22:4c169297f374 127 *_bl_pwm = level;
ttodorov 22:4c169297f374 128 _bl_pwm_current = level;
ttodorov 22:4c169297f374 129 }
ttodorov 22:4c169297f374 130 break;
ttodorov 22:4c169297f374 131
ttodorov 22:4c169297f374 132 case Indirect:
ttodorov 22:4c169297f374 133 break;
ttodorov 22:4c169297f374 134 case Constant:
ttodorov 22:4c169297f374 135 default:
ttodorov 22:4c169297f374 136 break;
ttodorov 22:4c169297f374 137 }
ttodorov 22:4c169297f374 138 }
ttodorov 22:4c169297f374 139
ttodorov 0:881ff0b71102 140 void LCD::FillScreen( int color )
ttodorov 0:881ff0b71102 141 {
ttodorov 12:d0978272a340 142 unsigned int rgb = color == -1 ? _background : color == -2 ? _foreground : ( unsigned int ) color;
ttodorov 4:3ac4239f6c9c 143 Activate();
ttodorov 2:81ed304b7e9b 144 ClearXY();
ttodorov 1:14bef43daf6f 145 for ( int i = 0; i < ( ( _disp_width ) * ( _disp_height ) ); i++ )
ttodorov 10:69571adcfad5 146 SetPixelColor( rgb );
ttodorov 4:3ac4239f6c9c 147 Deactivate();
ttodorov 0:881ff0b71102 148 }
ttodorov 0:881ff0b71102 149
ttodorov 0:881ff0b71102 150 inline
ttodorov 0:881ff0b71102 151 void LCD::ClearScreen( void )
ttodorov 0:881ff0b71102 152 {
ttodorov 0:881ff0b71102 153 FillScreen( -1 );
ttodorov 0:881ff0b71102 154 }
ttodorov 0:881ff0b71102 155
ttodorov 0:881ff0b71102 156 void LCD::DrawPixel( unsigned short x, unsigned short y, int color )
ttodorov 0:881ff0b71102 157 {
ttodorov 4:3ac4239f6c9c 158 Activate();
ttodorov 2:81ed304b7e9b 159 SetXY( x, y, x, y );
ttodorov 10:69571adcfad5 160 SetPixelColor( color == -1 ? _background :
ttodorov 0:881ff0b71102 161 color == -2 ? _foreground : color );
ttodorov 4:3ac4239f6c9c 162 Deactivate();
ttodorov 0:881ff0b71102 163 }
ttodorov 0:881ff0b71102 164
ttodorov 0:881ff0b71102 165 void LCD::DrawLine( unsigned short x1, unsigned short y1, unsigned short x2, unsigned short y2, int color )
ttodorov 0:881ff0b71102 166 {
ttodorov 0:881ff0b71102 167
ttodorov 0:881ff0b71102 168 double delta, tx, ty;
ttodorov 0:881ff0b71102 169
ttodorov 0:881ff0b71102 170 if ( ( ( x2 - x1 ) < 0 ) )
ttodorov 0:881ff0b71102 171 {
ttodorov 0:881ff0b71102 172 swap( ushort, x1, x2 )
ttodorov 0:881ff0b71102 173 swap( ushort, y1, y2 )
ttodorov 0:881ff0b71102 174 }
ttodorov 0:881ff0b71102 175 if ( ( ( y2 - y1 ) < 0 ) )
ttodorov 0:881ff0b71102 176 {
ttodorov 0:881ff0b71102 177 swap( ushort, x1, x2 )
ttodorov 0:881ff0b71102 178 swap( ushort, y1, y2 )
ttodorov 0:881ff0b71102 179 }
ttodorov 0:881ff0b71102 180
ttodorov 0:881ff0b71102 181 if ( y1 == y2 )
ttodorov 0:881ff0b71102 182 {
ttodorov 0:881ff0b71102 183 if ( x1 > x2 )
ttodorov 0:881ff0b71102 184 swap( ushort, x1, x2 )
ttodorov 2:81ed304b7e9b 185 DrawHLine( x1, y1, x2 - x1, color );
ttodorov 0:881ff0b71102 186 }
ttodorov 0:881ff0b71102 187 else if ( x1 == x2 )
ttodorov 0:881ff0b71102 188 {
ttodorov 0:881ff0b71102 189 if ( y1 > y2 )
ttodorov 0:881ff0b71102 190 swap( ushort, y1, y2 )
ttodorov 2:81ed304b7e9b 191 DrawVLine( x1, y1, y2 - y1, color );
ttodorov 0:881ff0b71102 192 }
ttodorov 4:3ac4239f6c9c 193 else
ttodorov 0:881ff0b71102 194 {
ttodorov 12:d0978272a340 195 unsigned int usedColor = color == -1 ? _background : color == -2 ? _foreground : ( unsigned int ) color;
ttodorov 4:3ac4239f6c9c 196 Activate();
ttodorov 4:3ac4239f6c9c 197 if ( abs( x2 - x1 ) > abs( y2 - y1 ) )
ttodorov 0:881ff0b71102 198 {
ttodorov 4:3ac4239f6c9c 199 delta = ( double( y2 - y1 ) / double( x2 - x1 ) );
ttodorov 4:3ac4239f6c9c 200 ty = double( y1 );
ttodorov 4:3ac4239f6c9c 201 if ( x1 > x2 )
ttodorov 0:881ff0b71102 202 {
ttodorov 4:3ac4239f6c9c 203 for ( int i = x1; i >= x2; i-- )
ttodorov 4:3ac4239f6c9c 204 {
ttodorov 4:3ac4239f6c9c 205 SetXY( i, int( ty + 0.5 ), i, int( ty + 0.5 ) );
ttodorov 10:69571adcfad5 206 SetPixelColor( usedColor );
ttodorov 4:3ac4239f6c9c 207 ty = ty - delta;
ttodorov 4:3ac4239f6c9c 208 }
ttodorov 4:3ac4239f6c9c 209 }
ttodorov 4:3ac4239f6c9c 210 else
ttodorov 4:3ac4239f6c9c 211 {
ttodorov 4:3ac4239f6c9c 212 for ( int i = x1; i <= x2; i++ )
ttodorov 4:3ac4239f6c9c 213 {
ttodorov 4:3ac4239f6c9c 214 SetXY( i, int( ty + 0.5 ), i, int( ty + 0.5 ) );
ttodorov 10:69571adcfad5 215 SetPixelColor( usedColor );
ttodorov 4:3ac4239f6c9c 216 ty = ty + delta;
ttodorov 4:3ac4239f6c9c 217 }
ttodorov 0:881ff0b71102 218 }
ttodorov 0:881ff0b71102 219 }
ttodorov 0:881ff0b71102 220 else
ttodorov 0:881ff0b71102 221 {
ttodorov 4:3ac4239f6c9c 222 delta = ( float( x2 - x1 ) / float( y2 - y1 ) );
ttodorov 4:3ac4239f6c9c 223 tx = float( x1 );
ttodorov 4:3ac4239f6c9c 224 if ( y1 > y2 )
ttodorov 0:881ff0b71102 225 {
ttodorov 4:3ac4239f6c9c 226 for ( int i = y2 + 1; i > y1; i-- )
ttodorov 4:3ac4239f6c9c 227 {
ttodorov 4:3ac4239f6c9c 228 SetXY( int( tx + 0.5 ), i, int( tx + 0.5 ), i );
ttodorov 10:69571adcfad5 229 SetPixelColor( usedColor );
ttodorov 4:3ac4239f6c9c 230 tx = tx + delta;
ttodorov 4:3ac4239f6c9c 231 }
ttodorov 4:3ac4239f6c9c 232 }
ttodorov 4:3ac4239f6c9c 233 else
ttodorov 4:3ac4239f6c9c 234 {
ttodorov 4:3ac4239f6c9c 235 for ( int i = y1; i < y2 + 1; i++ )
ttodorov 4:3ac4239f6c9c 236 {
ttodorov 4:3ac4239f6c9c 237 SetXY( int( tx + 0.5 ), i, int( tx + 0.5 ), i );
ttodorov 10:69571adcfad5 238 SetPixelColor( usedColor );
ttodorov 4:3ac4239f6c9c 239 tx = tx + delta;
ttodorov 4:3ac4239f6c9c 240 }
ttodorov 0:881ff0b71102 241 }
ttodorov 0:881ff0b71102 242 }
ttodorov 4:3ac4239f6c9c 243 Deactivate();
ttodorov 0:881ff0b71102 244 }
ttodorov 0:881ff0b71102 245 }
ttodorov 0:881ff0b71102 246
ttodorov 0:881ff0b71102 247 void LCD::DrawRect( unsigned short x1, unsigned short y1, unsigned short x2, unsigned short y2, int color )
ttodorov 0:881ff0b71102 248 {
ttodorov 0:881ff0b71102 249 if ( x1 > x2 ) swap( ushort, x1, x2 )
ttodorov 0:881ff0b71102 250 if ( y1 > y2 ) swap( ushort, y1, y2 )
ttodorov 0:881ff0b71102 251
ttodorov 2:81ed304b7e9b 252 DrawHLine( x1, y1, x2 - x1, color );
ttodorov 2:81ed304b7e9b 253 DrawHLine( x1, y2, x2 - x1, color );
ttodorov 2:81ed304b7e9b 254 DrawVLine( x1, y1, y2 - y1, color );
ttodorov 2:81ed304b7e9b 255 DrawVLine( x2, y1, y2 - y1, color );
ttodorov 0:881ff0b71102 256 }
ttodorov 0:881ff0b71102 257
ttodorov 0:881ff0b71102 258 void LCD::DrawRoundRect( unsigned short x1, unsigned short y1, unsigned short x2, unsigned short y2, int color )
ttodorov 0:881ff0b71102 259 {
ttodorov 0:881ff0b71102 260 if ( x1 > x2 ) swap( ushort, x1, x2 )
ttodorov 0:881ff0b71102 261 if ( y1 > y2 ) swap( ushort, y1, y2 )
ttodorov 0:881ff0b71102 262
ttodorov 0:881ff0b71102 263 if ( ( x2 - x1 ) > 4 && ( y2 - y1 ) > 4 )
ttodorov 0:881ff0b71102 264 {
ttodorov 0:881ff0b71102 265 DrawPixel( x1 + 1, y1 + 1, color );
ttodorov 0:881ff0b71102 266 DrawPixel( x2 - 1, y1 + 1, color );
ttodorov 0:881ff0b71102 267 DrawPixel( x1 + 1, y2 - 1, color );
ttodorov 0:881ff0b71102 268 DrawPixel( x2 - 1, y2 - 1, color );
ttodorov 2:81ed304b7e9b 269 DrawHLine( x1 + 2, y1, x2 - x1 - 4, color );
ttodorov 2:81ed304b7e9b 270 DrawHLine( x1 + 2, y2, x2 - x1 - 4, color );
ttodorov 2:81ed304b7e9b 271 DrawVLine( x1, y1 + 2, y2 - y1 - 4, color );
ttodorov 2:81ed304b7e9b 272 DrawVLine( x2, y1 + 2, y2 - y1 - 4, color );
ttodorov 0:881ff0b71102 273 }
ttodorov 0:881ff0b71102 274 }
ttodorov 0:881ff0b71102 275
ttodorov 0:881ff0b71102 276 void LCD::FillRect( unsigned short x1, unsigned short y1, unsigned short x2, unsigned short y2, int color )
ttodorov 0:881ff0b71102 277 {
ttodorov 0:881ff0b71102 278 if ( x1 > x2 ) swap( ushort, x1, x2 );
ttodorov 0:881ff0b71102 279 if ( y1 > y2 ) swap( ushort, y1, y2 );
ttodorov 0:881ff0b71102 280
ttodorov 12:d0978272a340 281 for ( int i = 0; i < ( ( y2 - y1 ) / 2 ) + 1; i++ )
ttodorov 0:881ff0b71102 282 {
ttodorov 12:d0978272a340 283 DrawHLine( x1, y1 + i, x2 - x1, color );
ttodorov 12:d0978272a340 284 DrawHLine( x1, y2 - i, x2 - x1, color );
ttodorov 0:881ff0b71102 285 }
ttodorov 0:881ff0b71102 286 }
ttodorov 0:881ff0b71102 287
ttodorov 0:881ff0b71102 288 void LCD::FillRoundRect( unsigned short x1, unsigned short y1, unsigned short x2, unsigned short y2, int color )
ttodorov 0:881ff0b71102 289 {
ttodorov 0:881ff0b71102 290 if ( x1 > x2 ) swap( ushort, x1, x2 )
ttodorov 0:881ff0b71102 291 if ( y1 > y2 ) swap( ushort, y1, y2 )
ttodorov 0:881ff0b71102 292
ttodorov 0:881ff0b71102 293 if ( ( x2 - x1 ) > 4 && ( y2 - y1 ) > 4 )
ttodorov 0:881ff0b71102 294 {
ttodorov 0:881ff0b71102 295 for ( int i = 0; i < ( ( y2 - y1 ) / 2 ) + 1; i++ )
ttodorov 0:881ff0b71102 296 {
ttodorov 0:881ff0b71102 297 switch ( i )
ttodorov 0:881ff0b71102 298 {
ttodorov 0:881ff0b71102 299 case 0:
ttodorov 2:81ed304b7e9b 300 DrawHLine( x1 + 2, y1 + i, x2 - x1 - 4, color );
ttodorov 2:81ed304b7e9b 301 DrawHLine( x1 + 2, y2 - i, x2 - x1 - 4, color );
ttodorov 0:881ff0b71102 302 break;
ttodorov 0:881ff0b71102 303
ttodorov 0:881ff0b71102 304 case 1:
ttodorov 2:81ed304b7e9b 305 DrawHLine( x1 + 1, y1 + i, x2 - x1 - 2, color );
ttodorov 2:81ed304b7e9b 306 DrawHLine( x1 + 1, y2 - i, x2 - x1 - 2, color );
ttodorov 0:881ff0b71102 307 break;
ttodorov 0:881ff0b71102 308
ttodorov 0:881ff0b71102 309 default:
ttodorov 2:81ed304b7e9b 310 DrawHLine( x1, y1 + i, x2 - x1, color );
ttodorov 2:81ed304b7e9b 311 DrawHLine( x1, y2 - i, x2 - x1, color );
ttodorov 0:881ff0b71102 312 break;
ttodorov 0:881ff0b71102 313 }
ttodorov 0:881ff0b71102 314 }
ttodorov 0:881ff0b71102 315 }
ttodorov 0:881ff0b71102 316 }
ttodorov 0:881ff0b71102 317
ttodorov 0:881ff0b71102 318 void LCD::DrawCircle( unsigned short x, unsigned short y, unsigned short radius, int color )
ttodorov 0:881ff0b71102 319 {
ttodorov 0:881ff0b71102 320 int f = 1 - radius;
ttodorov 0:881ff0b71102 321 int ddF_x = 1;
ttodorov 0:881ff0b71102 322 int ddF_y = -2 * radius;
ttodorov 0:881ff0b71102 323 int x1 = 0;
ttodorov 0:881ff0b71102 324 int y1 = radius;
ttodorov 12:d0978272a340 325 unsigned int usedColor = color == -1 ? _background : color == -2 ? _foreground : ( unsigned int ) color;
ttodorov 0:881ff0b71102 326
ttodorov 4:3ac4239f6c9c 327 Activate();
ttodorov 2:81ed304b7e9b 328 SetXY( x, y + radius, x, y + radius );
ttodorov 10:69571adcfad5 329 SetPixelColor( usedColor );
ttodorov 2:81ed304b7e9b 330 SetXY( x, y - radius, x, y - radius );
ttodorov 10:69571adcfad5 331 SetPixelColor( usedColor );
ttodorov 2:81ed304b7e9b 332 SetXY( x + radius, y, x + radius, y );
ttodorov 10:69571adcfad5 333 SetPixelColor( usedColor );
ttodorov 2:81ed304b7e9b 334 SetXY( x - radius, y, x - radius, y );
ttodorov 10:69571adcfad5 335 SetPixelColor( usedColor );
ttodorov 0:881ff0b71102 336
ttodorov 0:881ff0b71102 337 while ( x1 < y1 )
ttodorov 0:881ff0b71102 338 {
ttodorov 0:881ff0b71102 339 if ( f >= 0 )
ttodorov 0:881ff0b71102 340 {
ttodorov 0:881ff0b71102 341 y1--;
ttodorov 0:881ff0b71102 342 ddF_y += 2;
ttodorov 0:881ff0b71102 343 f += ddF_y;
ttodorov 0:881ff0b71102 344 }
ttodorov 0:881ff0b71102 345 x1++;
ttodorov 0:881ff0b71102 346 ddF_x += 2;
ttodorov 0:881ff0b71102 347 f += ddF_x;
ttodorov 2:81ed304b7e9b 348 SetXY( x + x1, y + y1, x + x1, y + y1 );
ttodorov 10:69571adcfad5 349 SetPixelColor( usedColor );
ttodorov 2:81ed304b7e9b 350 SetXY( x - x1, y + y1, x - x1, y + y1 );
ttodorov 10:69571adcfad5 351 SetPixelColor( usedColor );
ttodorov 2:81ed304b7e9b 352 SetXY( x + x1, y - y1, x + x1, y - y1 );
ttodorov 10:69571adcfad5 353 SetPixelColor( usedColor );
ttodorov 2:81ed304b7e9b 354 SetXY( x - x1, y - y1, x - x1, y - y1 );
ttodorov 10:69571adcfad5 355 SetPixelColor( usedColor );
ttodorov 2:81ed304b7e9b 356 SetXY( x + y1, y + x1, x + y1, y + x1 );
ttodorov 10:69571adcfad5 357 SetPixelColor( usedColor );
ttodorov 2:81ed304b7e9b 358 SetXY( x - y1, y + x1, x - y1, y + x1 );
ttodorov 10:69571adcfad5 359 SetPixelColor( usedColor );
ttodorov 2:81ed304b7e9b 360 SetXY( x + y1, y - x1, x + y1, y - x1 );
ttodorov 10:69571adcfad5 361 SetPixelColor( usedColor );
ttodorov 2:81ed304b7e9b 362 SetXY( x - y1, y - x1, x - y1, y - x1 );
ttodorov 10:69571adcfad5 363 SetPixelColor( usedColor );
ttodorov 0:881ff0b71102 364 }
ttodorov 4:3ac4239f6c9c 365 Deactivate();
ttodorov 0:881ff0b71102 366 }
ttodorov 0:881ff0b71102 367
ttodorov 0:881ff0b71102 368 void LCD::FillCircle( unsigned short x, unsigned short y, unsigned short radius, int color )
ttodorov 0:881ff0b71102 369 {
ttodorov 12:d0978272a340 370 unsigned int usedColor = color == -1 ? _background : color == -2 ? _foreground : ( unsigned int ) color;
ttodorov 4:3ac4239f6c9c 371 Activate();
ttodorov 0:881ff0b71102 372 for ( int y1 = -radius; y1 <= radius; y1++ )
ttodorov 0:881ff0b71102 373 for ( int x1 = -radius; x1 <= radius; x1++ )
ttodorov 0:881ff0b71102 374 if ( x1 * x1 + y1 * y1 <= radius * radius )
ttodorov 0:881ff0b71102 375 {
ttodorov 2:81ed304b7e9b 376 SetXY( x + x1, y + y1, x + x1, y + y1 );
ttodorov 10:69571adcfad5 377 SetPixelColor( usedColor );
ttodorov 0:881ff0b71102 378 }
ttodorov 4:3ac4239f6c9c 379 Deactivate();
ttodorov 0:881ff0b71102 380 }
ttodorov 0:881ff0b71102 381
ttodorov 0:881ff0b71102 382 void LCD::Print( const char *str, unsigned short x, unsigned short y, int fgColor, int bgColor, unsigned short deg )
ttodorov 0:881ff0b71102 383 {
ttodorov 0:881ff0b71102 384 int stl, i;
ttodorov 0:881ff0b71102 385
ttodorov 0:881ff0b71102 386 stl = strlen( str );
ttodorov 0:881ff0b71102 387
ttodorov 12:d0978272a340 388 if ( x == RIGHT )
ttodorov 21:e5c1e8ffada1 389 x = GetWidth() - ( stl * _font->Width );
ttodorov 12:d0978272a340 390 if ( x == CENTER )
ttodorov 21:e5c1e8ffada1 391 x = ( GetWidth() - ( stl * _font->Width ) ) / 2;
ttodorov 0:881ff0b71102 392
ttodorov 0:881ff0b71102 393 for ( i = 0; i < stl; i++ )
ttodorov 0:881ff0b71102 394 if ( deg == 0 )
ttodorov 21:e5c1e8ffada1 395 PrintChar( *str++, x + ( i * ( _font->Width ) ), y, fgColor, bgColor );
ttodorov 0:881ff0b71102 396 else
ttodorov 2:81ed304b7e9b 397 RotateChar( *str++, x, y, i, fgColor, bgColor, deg );
ttodorov 0:881ff0b71102 398 }
ttodorov 0:881ff0b71102 399
ttodorov 12:d0978272a340 400 void LCD::DrawBitmap( unsigned short x, unsigned short y, const bitmap_t* img, unsigned char scale )
ttodorov 0:881ff0b71102 401 {
ttodorov 0:881ff0b71102 402 int tx, ty, tc, tsx, tsy;
ttodorov 0:881ff0b71102 403
ttodorov 4:3ac4239f6c9c 404 Activate();
ttodorov 0:881ff0b71102 405 if ( scale == 1 )
ttodorov 0:881ff0b71102 406 {
ttodorov 12:d0978272a340 407 SetXY( x, y, x + img->Width - 1, y + img->Height - 1 );
ttodorov 20:4bdca8d8dadc 408
ttodorov 13:5ceeba86bbe4 409 if ( img->Format == RGB16 )
ttodorov 0:881ff0b71102 410 {
ttodorov 13:5ceeba86bbe4 411 const unsigned short *pixel = ( const unsigned short* ) img->PixelData;
ttodorov 20:4bdca8d8dadc 412 for ( tc = 0; tc < ( img->Width * img->Height ); tc++ )
ttodorov 20:4bdca8d8dadc 413 SetPixelColor( *pixel++, img->Format );
ttodorov 13:5ceeba86bbe4 414 }
ttodorov 13:5ceeba86bbe4 415 else if ( img->Format == RGB18 )
ttodorov 13:5ceeba86bbe4 416 {
ttodorov 13:5ceeba86bbe4 417 const unsigned int *pixel = ( const unsigned int* ) img->PixelData;
ttodorov 20:4bdca8d8dadc 418 for ( tc = 0; tc < ( img->Width * img->Height ); tc++ )
ttodorov 20:4bdca8d8dadc 419 SetPixelColor( *pixel++, img->Format );
ttodorov 0:881ff0b71102 420 }
ttodorov 0:881ff0b71102 421 }
ttodorov 0:881ff0b71102 422 else
ttodorov 0:881ff0b71102 423 {
ttodorov 13:5ceeba86bbe4 424 if ( img->Format == RGB16 )
ttodorov 0:881ff0b71102 425 {
ttodorov 13:5ceeba86bbe4 426 const unsigned short *pixel = ( const unsigned short* ) img->PixelData;
ttodorov 13:5ceeba86bbe4 427
ttodorov 13:5ceeba86bbe4 428 for ( ty = 0; ty < img->Height; ty++ )
ttodorov 13:5ceeba86bbe4 429 {
ttodorov 13:5ceeba86bbe4 430 SetXY( x, y + ( ty * scale ), x + ( ( img->Width * scale ) - 1 ), y + ( ty * scale ) + scale );
ttodorov 13:5ceeba86bbe4 431 for ( tsy = 0; tsy < scale; tsy++ )
ttodorov 13:5ceeba86bbe4 432 {
ttodorov 13:5ceeba86bbe4 433 for ( tx = 0; tx < img->Width; tx++ )
ttodorov 13:5ceeba86bbe4 434 {
ttodorov 13:5ceeba86bbe4 435 for ( tsx = 0; tsx < scale; tsx++ )
ttodorov 20:4bdca8d8dadc 436 SetPixelColor( pixel[ ( ty * img->Width ) + tx ], img->Format );
ttodorov 20:4bdca8d8dadc 437 }
ttodorov 20:4bdca8d8dadc 438 }
ttodorov 20:4bdca8d8dadc 439 }
ttodorov 20:4bdca8d8dadc 440 }
ttodorov 20:4bdca8d8dadc 441 else if ( img->Format == RGB18 )
ttodorov 20:4bdca8d8dadc 442 {
ttodorov 20:4bdca8d8dadc 443 const unsigned int *pixel = ( const unsigned int* ) img->PixelData;
ttodorov 20:4bdca8d8dadc 444
ttodorov 20:4bdca8d8dadc 445 for ( ty = 0; ty < img->Height; ty++ )
ttodorov 20:4bdca8d8dadc 446 {
ttodorov 20:4bdca8d8dadc 447 SetXY( x, y + ( ty * scale ), x + ( ( img->Width * scale ) - 1 ), y + ( ty * scale ) + scale );
ttodorov 20:4bdca8d8dadc 448 for ( tsy = 0; tsy < scale; tsy++ )
ttodorov 20:4bdca8d8dadc 449 {
ttodorov 20:4bdca8d8dadc 450 for ( tx = 0; tx < img->Width; tx++ )
ttodorov 20:4bdca8d8dadc 451 {
ttodorov 20:4bdca8d8dadc 452 for ( tsx = 0; tsx < scale; tsx++ )
ttodorov 20:4bdca8d8dadc 453 SetPixelColor( pixel[ ( ty * img->Width ) + tx ], img->Format );
ttodorov 13:5ceeba86bbe4 454 }
ttodorov 13:5ceeba86bbe4 455 }
ttodorov 13:5ceeba86bbe4 456 }
ttodorov 13:5ceeba86bbe4 457 }
ttodorov 0:881ff0b71102 458 }
ttodorov 4:3ac4239f6c9c 459 Deactivate();
ttodorov 0:881ff0b71102 460 }
ttodorov 0:881ff0b71102 461
ttodorov 12:d0978272a340 462 void LCD::DrawBitmap( unsigned short x, unsigned short y, const bitmap_t* img, unsigned short deg, unsigned short rox, unsigned short roy )
ttodorov 0:881ff0b71102 463 {
ttodorov 0:881ff0b71102 464 int tx, ty, newx, newy;
ttodorov 0:881ff0b71102 465 double radian;
ttodorov 0:881ff0b71102 466 radian = deg * 0.0175;
ttodorov 0:881ff0b71102 467
ttodorov 0:881ff0b71102 468 if ( deg == 0 )
ttodorov 12:d0978272a340 469 DrawBitmap( x, y, img );
ttodorov 0:881ff0b71102 470 else
ttodorov 0:881ff0b71102 471 {
ttodorov 4:3ac4239f6c9c 472 Activate();
ttodorov 13:5ceeba86bbe4 473
ttodorov 13:5ceeba86bbe4 474 if ( img->Format == RGB16 )
ttodorov 13:5ceeba86bbe4 475 {
ttodorov 13:5ceeba86bbe4 476 const unsigned short *pixel = ( const unsigned short* ) img->PixelData;
ttodorov 13:5ceeba86bbe4 477
ttodorov 13:5ceeba86bbe4 478 for ( ty = 0; ty < img->Height; ty++ )
ttodorov 13:5ceeba86bbe4 479 for ( tx = 0; tx < img->Width; tx++ )
ttodorov 13:5ceeba86bbe4 480 {
ttodorov 13:5ceeba86bbe4 481 newx = x + rox + ( ( ( tx - rox ) * cos( radian ) ) - ( ( ty - roy ) * sin( radian ) ) );
ttodorov 13:5ceeba86bbe4 482 newy = y + roy + ( ( ( ty - roy ) * cos( radian ) ) + ( ( tx - rox ) * sin( radian ) ) );
ttodorov 13:5ceeba86bbe4 483
ttodorov 13:5ceeba86bbe4 484 SetXY( newx, newy, newx, newy );
ttodorov 20:4bdca8d8dadc 485 SetPixelColor( pixel[ ( ty * img->Width ) + tx ], img->Format );
ttodorov 13:5ceeba86bbe4 486 }
ttodorov 13:5ceeba86bbe4 487 }
ttodorov 13:5ceeba86bbe4 488 else if ( img->Format == RGB18 )
ttodorov 13:5ceeba86bbe4 489 {
ttodorov 13:5ceeba86bbe4 490 const unsigned int *pixel = ( const unsigned int* ) img->PixelData;
ttodorov 13:5ceeba86bbe4 491
ttodorov 13:5ceeba86bbe4 492 for ( ty = 0; ty < img->Height; ty++ )
ttodorov 13:5ceeba86bbe4 493 for ( tx = 0; tx < img->Width; tx++ )
ttodorov 13:5ceeba86bbe4 494 {
ttodorov 13:5ceeba86bbe4 495 newx = x + rox + ( ( ( tx - rox ) * cos( radian ) ) - ( ( ty - roy ) * sin( radian ) ) );
ttodorov 13:5ceeba86bbe4 496 newy = y + roy + ( ( ( ty - roy ) * cos( radian ) ) + ( ( tx - rox ) * sin( radian ) ) );
ttodorov 13:5ceeba86bbe4 497
ttodorov 13:5ceeba86bbe4 498 SetXY( newx, newy, newx, newy );
ttodorov 20:4bdca8d8dadc 499 SetPixelColor( pixel[ ( ty * img->Width ) + tx ], img->Format );
ttodorov 13:5ceeba86bbe4 500 }
ttodorov 13:5ceeba86bbe4 501 }
ttodorov 4:3ac4239f6c9c 502 Deactivate();
ttodorov 0:881ff0b71102 503 }
ttodorov 4:3ac4239f6c9c 504 }
ttodorov 4:3ac4239f6c9c 505
ttodorov 4:3ac4239f6c9c 506 inline
ttodorov 4:3ac4239f6c9c 507 void LCD::Activate( void )
ttodorov 4:3ac4239f6c9c 508 {
ttodorov 4:3ac4239f6c9c 509 _lcd_pin_cs = LOW;
ttodorov 4:3ac4239f6c9c 510 }
ttodorov 4:3ac4239f6c9c 511
ttodorov 4:3ac4239f6c9c 512 inline
ttodorov 4:3ac4239f6c9c 513 void LCD::Deactivate( void )
ttodorov 4:3ac4239f6c9c 514 {
ttodorov 4:3ac4239f6c9c 515 _lcd_pin_cs = HIGH;
ttodorov 0:881ff0b71102 516 }
ttodorov 0:881ff0b71102 517
ttodorov 0:881ff0b71102 518 inline
ttodorov 2:81ed304b7e9b 519 void LCD::WriteCmdData( unsigned short cmd, unsigned short data )
ttodorov 0:881ff0b71102 520 {
ttodorov 2:81ed304b7e9b 521 WriteCmd( cmd );
ttodorov 2:81ed304b7e9b 522 WriteData( data );
ttodorov 0:881ff0b71102 523 }
ttodorov 0:881ff0b71102 524
ttodorov 12:d0978272a340 525 inline
ttodorov 12:d0978272a340 526 void LCD::ClearXY( void )
ttodorov 0:881ff0b71102 527 {
ttodorov 12:d0978272a340 528 SetXY( 0, 0, GetWidth() - 1, GetHeight() - 1 );
ttodorov 0:881ff0b71102 529 }
ttodorov 0:881ff0b71102 530
ttodorov 2:81ed304b7e9b 531 void LCD::DrawHLine( unsigned short x, unsigned short y, unsigned short len, int color )
ttodorov 0:881ff0b71102 532 {
ttodorov 12:d0978272a340 533 unsigned int usedColor = color == -1 ? _background : color == -2 ? _foreground : ( unsigned int ) color;
ttodorov 0:881ff0b71102 534
ttodorov 4:3ac4239f6c9c 535 Activate();
ttodorov 2:81ed304b7e9b 536 SetXY( x, y, x + len, y );
ttodorov 0:881ff0b71102 537 for ( int i = 0; i < len + 1; i++ )
ttodorov 10:69571adcfad5 538 SetPixelColor( usedColor );
ttodorov 4:3ac4239f6c9c 539 Deactivate();
ttodorov 0:881ff0b71102 540 }
ttodorov 0:881ff0b71102 541
ttodorov 2:81ed304b7e9b 542 void LCD::DrawVLine( unsigned short x, unsigned short y, unsigned short len, int color )
ttodorov 0:881ff0b71102 543 {
ttodorov 12:d0978272a340 544 unsigned int usedColor = color == -1 ? _background : color == -2 ? _foreground : ( unsigned int ) color;
ttodorov 0:881ff0b71102 545
ttodorov 4:3ac4239f6c9c 546 Activate();
ttodorov 2:81ed304b7e9b 547 SetXY( x, y, x, y + len );
ttodorov 0:881ff0b71102 548 for ( int i = 0; i < len; i++ )
ttodorov 10:69571adcfad5 549 SetPixelColor( usedColor );
ttodorov 4:3ac4239f6c9c 550 Deactivate();
ttodorov 0:881ff0b71102 551 }
ttodorov 0:881ff0b71102 552
ttodorov 2:81ed304b7e9b 553 void LCD::PrintChar( char c, unsigned short x, unsigned short y, int fgColor, int bgColor )
ttodorov 0:881ff0b71102 554 {
ttodorov 0:881ff0b71102 555 uint8_t i, ch;
ttodorov 0:881ff0b71102 556 uint16_t j;
ttodorov 12:d0978272a340 557 unsigned int usedColorFG = fgColor == -1 ? _background : fgColor == -2 ? _foreground : ( unsigned int ) fgColor;
ttodorov 12:d0978272a340 558 unsigned int usedColorBG = bgColor == -1 ? _background : bgColor == -2 ? _foreground : ( unsigned int ) bgColor;
ttodorov 21:e5c1e8ffada1 559
ttodorov 21:e5c1e8ffada1 560 uint16_t totalCharBytes = ( _font->Width * _font->Height ) / 8;
ttodorov 21:e5c1e8ffada1 561 int16_t position = _font->Position[ c - _font->Offset ];
ttodorov 21:e5c1e8ffada1 562 if ( position == -1 ) position = 0; // will print space character
ttodorov 21:e5c1e8ffada1 563
ttodorov 4:3ac4239f6c9c 564 Activate();
ttodorov 0:881ff0b71102 565
ttodorov 21:e5c1e8ffada1 566 SetXY( x, y, x + _font->Width - 1, y + _font->Height - 1 );
ttodorov 21:e5c1e8ffada1 567
ttodorov 21:e5c1e8ffada1 568 for ( j = 0; j < totalCharBytes; j++ )
ttodorov 0:881ff0b71102 569 {
ttodorov 21:e5c1e8ffada1 570 ch = _font->Data[ position ];
ttodorov 12:d0978272a340 571 for ( i = 0; i < 8; i++ )
ttodorov 0:881ff0b71102 572 {
ttodorov 21:e5c1e8ffada1 573 if ( ( ch & ( 1 << ( 7 - i ) ) ) != 0 ) SetPixelColor( usedColorFG );
ttodorov 21:e5c1e8ffada1 574 else SetPixelColor( usedColorBG );
ttodorov 0:881ff0b71102 575 }
ttodorov 21:e5c1e8ffada1 576 position++;
ttodorov 0:881ff0b71102 577 }
ttodorov 4:3ac4239f6c9c 578 Deactivate();
ttodorov 0:881ff0b71102 579 }
ttodorov 0:881ff0b71102 580
ttodorov 2:81ed304b7e9b 581 void LCD::RotateChar( char c, unsigned short x, unsigned short y, int pos, int fgColor, int bgColor, unsigned short deg )
ttodorov 0:881ff0b71102 582 {
ttodorov 0:881ff0b71102 583 uint8_t i, j, ch;
ttodorov 0:881ff0b71102 584 int newx, newy;
ttodorov 0:881ff0b71102 585 double radian;
ttodorov 0:881ff0b71102 586 radian = deg * 0.0175;
ttodorov 0:881ff0b71102 587
ttodorov 12:d0978272a340 588 unsigned int usedColorFG = fgColor == -1 ? _background : fgColor == -2 ? _foreground : ( unsigned int ) fgColor;
ttodorov 12:d0978272a340 589 unsigned int usedColorBG = bgColor == -1 ? _background : bgColor == -2 ? _foreground : ( unsigned int ) bgColor;
ttodorov 0:881ff0b71102 590
ttodorov 21:e5c1e8ffada1 591 int16_t position = _font->Position[ c - _font->Offset ];
ttodorov 21:e5c1e8ffada1 592 if ( position == -1 ) position = 0; // will print space character
ttodorov 21:e5c1e8ffada1 593
ttodorov 4:3ac4239f6c9c 594 Activate();
ttodorov 21:e5c1e8ffada1 595
ttodorov 21:e5c1e8ffada1 596 for ( j = 0; j < _font->Height; j++ )
ttodorov 0:881ff0b71102 597 {
ttodorov 21:e5c1e8ffada1 598 for ( uint16_t zz = 0; zz < ( ( double ) _font->Width / 8 ); zz++ )
ttodorov 0:881ff0b71102 599 {
ttodorov 21:e5c1e8ffada1 600 ch = _font->Data[ position + zz ];
ttodorov 0:881ff0b71102 601 for ( i = 0; i < 8; i++ )
ttodorov 0:881ff0b71102 602 {
ttodorov 21:e5c1e8ffada1 603 newx = x + ( ( ( i + ( zz * 8 ) + ( pos * _font->Width ) ) * cos( radian ) ) - ( ( j ) * sin( radian ) ) );
ttodorov 21:e5c1e8ffada1 604 newy = y + ( ( ( j ) * cos( radian ) ) + ( ( i + ( zz * 8 ) + ( pos * _font->Width ) ) * sin( radian ) ) );
ttodorov 0:881ff0b71102 605
ttodorov 2:81ed304b7e9b 606 SetXY( newx, newy, newx + 1, newy + 1 );
ttodorov 0:881ff0b71102 607
ttodorov 21:e5c1e8ffada1 608 if ( ( ch & ( 1 << ( 7 - i ) ) ) != 0 ) SetPixelColor( usedColorFG );
ttodorov 21:e5c1e8ffada1 609 else SetPixelColor( usedColorBG );
ttodorov 0:881ff0b71102 610 }
ttodorov 0:881ff0b71102 611 }
ttodorov 21:e5c1e8ffada1 612 position += ( _font->Width / 8 );
ttodorov 0:881ff0b71102 613 }
ttodorov 21:e5c1e8ffada1 614
ttodorov 4:3ac4239f6c9c 615 Deactivate();
ttodorov 0:881ff0b71102 616 }