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