This is a port of Henning Kralsen's UTFT library for Arduino/chipKIT to mbed, refactored to make full use of C++ inheritance and access control, in order to reduce work when implementing new drivers and at the same time make the code more readable and easier to maintain. As of now supported are SSD1289 (16-bit interface), HX8340-B (serial interface) and ST7735 (serial interface). Drivers for other controllers will be added as time and resources to acquire the displays to test the code permit.

Dependents:   test SDCard capstone_display capstone_display_2 ... more

TFTLCD Library

NOTE (2013-03-25) Tested with both mbed LPC1768 and Freedom KL25Z. -todor

A TFT LCD driver library, which at the moment provides support for the following display controllers: HX8340-B (serial interface), SSD1289 (16-bit interface), ST7735-R (serial interface), ILI9325/ILI9328 (16-bit interface).

As I am acquiring and testing out new displays, I decided to combine all ported drivers into one library as with the original work done by Henning. However I also had as a goal to make the code maintenance and readability easier/better, so the code has been heavily refactored to make full use of C++ facilities as inheritance and access control. I extracted the common pieces of code into a base class, which every driver inherits and only the controller-specific side is provided in the actual driver - things like initialization, addressing, data transfer, etc.

Another nice extension is that the display's backlight can now be controlled through the driver. Either a simple on/off method of control could be selected, or the brightness can be set through use of PWM (the latter placing some restrictions on which pins can be used for this, as mbed offers hardware PWM on only 6 pins).

I also plan to add support for touch screens as part of the library. The goal is to grow this piece of software into a lightweight graphics widgets library, which can be used to construct control screens with buttons or menus in a speedy and intuitive way.

Changes

2013-07-21

  • Fixed the sleep/wake-up functions of the ILI9328 driver.

2013-06-15

  • Added driver for ILI9328 (works with ILI9325) controller, 16-bit data bus. Screen rotation works as usual with the TFTLCD library, but for now only RGB565 color depth is working and you can use both 65K and 262K color space with this driver. But for some reason the sleep function is not behaving as expected; I am working on this.
  • This is only on my to-do list for now - haven't really had the time yet - but I am going to refactor the library a bit to allow use of GPIO ports for data transfers instead of DigitalOut: faster and cleaner that way. For those who are using it already in a working design and cannot repurpose the pins anymore, the current way it's working will still be available; I am hoping not to tear up the public interfaces of the library (... too much). Anyway, since I am at it, I will also try to add support for multiple bus interfaces to drivers that support it (i.e. both 8bit and 16bit use of ILI932x or SSD1289). Thought this might be a good place to give you guys the heads-up.

2013-01-25

  • Replaced all existing fonts from the UTFT library with the free Terminus font. Two different sizes are provided: 8x12 pixels and 16x28 pixels. I found the old fonts not so good looking and then they supported only the ASCII codes in the range 30 (space) to 126 (the tilde ). The 7segment font didn't even implement anything else than the numbers from 0 to 9 - so it was unusable for anything (one couldn't even display the time or date as it lacked the colon [:] or the period [.] or the slash [/] or the space [ ] characters). So I completely revamped the fonts and added Terminus as the new default with its 2 sizes. Further more I added in both sizes most of the characters up to ASCII code 255. For any code not in there, the space character is substituted. In the case, when you already have provided your own fonts, please have a look at the API changes in the files <terminus.h> and <terminus.cpp>: I promise you whatever time you spent designing your own font, it is not wasted; you merely need to add a second array, which describes which ASCII codes are available in your font, and their byte offset in the original character bitmap array; and a struct to tie all parts together and describe the character size. I am sorry for breaking the old API, but you will like the change and new options it brings you. Now you can insert any char above 127 up to code 255 (if available, of course) with its hex representation, e.g displaying the current temperature would look something like 85\xB0 F or 26\xB0 C (the space in between degree and F or C is needed because both F and C are used in hex numbers, so \xB0F is interpreted as ASCII code 2831 instead of ASCII code 176, followed by the temperature scale denomination; if you insist on avoiding the space, you could write 85\xB0\x46 which will be displayed correctly as 85°F). You can either look up the ASCII code you need on Google or Bing, or just look at what's available - how it looks and its hex value - in the comments in <terminus.cpp>.
  • Added PWM backlight control. If you intend to use this, please make sure that control pin is either one of p21, p22, p23, p24, p25, or p26, as only they support hardware PWM. Please be aware that the mbed pins do not have much juice behind them, so if your display's backlight requires a lot of current, you are better off interfacing through as small signal transistor or a MOSFET. For the rest please consult the updated Doxygen documentation. NOTE The addition of PWM-controlled backlight will not break your existing code, the new options have default values, which initialize the used driver to behave as prior to PWM. Only if you want to use the new feature, some changes need to be made. The PWM is configured to be 120Hz (period of 8.33 milliseconds), in order to avoid noticeable flicker in the backlight. If in your opinion this value is too fine, then you can reduce the frequency in the LCD constructor in <lcd_base.cpp> by increasing the period value. My recommendation is to avoid frequencies lower than 60Hz.

2012-12-21

  • Internal-only changes in the way drivers transmit colors - done to simplify the bitmap drawing routines; client API remains unchanged.

2012-12-12

  • Added the driver for the ST7735 display controller.
  • Added the RGB18 color mode: choose between 16-bit (65K distinct colors) and 18-bit (262K distinct colors) color space [supported by all drivers]. NOTE This feature requires the image drawing functions to be changed, in order to account for differences between configured display color depth and the color depth of the image. Please review the API docs, in particular the new type bitmap_t and the DrawBitmap functions.
  • Changed display rotation to be achieved through the correspondent settings in the respective controller registers: no more software translation between width and height in different display orientations.
  • Extended the orientation options: PORTRAIT (top line to 12 o'clock/upright) and LANDSCAPE (top line to 9 o'clock) positions are the old options, PORTRAIT_REV (top line to 6 o'clock/upside-down) and LANDSCAPE_REV (top line to 3 o'clock) are the new orientations.
  • Added more pre-defined colors: available now are COLOR_BLACK, COLOR_WHITE, COLOR_RED, COLOR_GREEN, COLOR_BLUE, COLOR_CYAN, COLOR_MAGENTA and COLOR_YELLOW.

TODO

  • Finish implementing PWM-controlled backlight (current-sink configuration).
  • Add a driver for the HX8352-A controller (ITDB02-3.2WD 16:9 240x400 pixel resolution display).

How to Use

The code is documented, so please review the API docs. There is a simple example to get you started...

Committer:
ttodorov
Date:
Sun Dec 02 05:44:52 2012 +0000
Revision:
4:3ac4239f6c9c
Parent:
3:64a5b67d5b51
Child:
7:5c418fc1879f
- renamed SSD1289 implementation; - refactored base class functions and removed redundant addressing; - added sleep and wake functions; - added HX8340B serial implementation; - fixed test case

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 0:881ff0b71102 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 0:881ff0b71102 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 0:881ff0b71102 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 2:81ed304b7e9b 74 WriteData( 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 2:81ed304b7e9b 88 WriteData( 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 0:881ff0b71102 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 4:3ac4239f6c9c 134 WriteData( 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 4:3ac4239f6c9c 143 WriteData( 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 4:3ac4239f6c9c 157 WriteData( 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 4:3ac4239f6c9c 166 WriteData( 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 0:881ff0b71102 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 2:81ed304b7e9b 268 WriteData( usedColor );
ttodorov 2:81ed304b7e9b 269 SetXY( x, y - radius, x, y - radius );
ttodorov 2:81ed304b7e9b 270 WriteData( usedColor );
ttodorov 2:81ed304b7e9b 271 SetXY( x + radius, y, x + radius, y );
ttodorov 2:81ed304b7e9b 272 WriteData( usedColor );
ttodorov 2:81ed304b7e9b 273 SetXY( x - radius, y, x - radius, y );
ttodorov 2:81ed304b7e9b 274 WriteData( 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 2:81ed304b7e9b 288 WriteData( usedColor );
ttodorov 2:81ed304b7e9b 289 SetXY( x - x1, y + y1, x - x1, y + y1 );
ttodorov 2:81ed304b7e9b 290 WriteData( usedColor );
ttodorov 2:81ed304b7e9b 291 SetXY( x + x1, y - y1, x + x1, y - y1 );
ttodorov 2:81ed304b7e9b 292 WriteData( usedColor );
ttodorov 2:81ed304b7e9b 293 SetXY( x - x1, y - y1, x - x1, y - y1 );
ttodorov 2:81ed304b7e9b 294 WriteData( usedColor );
ttodorov 2:81ed304b7e9b 295 SetXY( x + y1, y + x1, x + y1, y + x1 );
ttodorov 2:81ed304b7e9b 296 WriteData( usedColor );
ttodorov 2:81ed304b7e9b 297 SetXY( x - y1, y + x1, x - y1, y + x1 );
ttodorov 2:81ed304b7e9b 298 WriteData( usedColor );
ttodorov 2:81ed304b7e9b 299 SetXY( x + y1, y - x1, x + y1, y - x1 );
ttodorov 2:81ed304b7e9b 300 WriteData( usedColor );
ttodorov 2:81ed304b7e9b 301 SetXY( x - y1, y - x1, x - y1, y - x1 );
ttodorov 2:81ed304b7e9b 302 WriteData( 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 0:881ff0b71102 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 2:81ed304b7e9b 316 WriteData( 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 0:881ff0b71102 349 void LCD::DrawBitmap( unsigned short x, unsigned short y, unsigned short sx, unsigned short sy, bitmap_t data, 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 2:81ed304b7e9b 360 WriteData( data[ 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 2:81ed304b7e9b 368 WriteData( data[ ( 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 2:81ed304b7e9b 382 WriteData( data[ ( 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 2:81ed304b7e9b 394 WriteData( data[ ( 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 0:881ff0b71102 402 void LCD::DrawBitmap( unsigned short x, unsigned short y, unsigned short sx, unsigned short sy, bitmap_t data, 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 0:881ff0b71102 409 DrawBitmap( x, y, sx, sy, data );
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 2:81ed304b7e9b 420 WriteData( data[ ( 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 0:881ff0b71102 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 2:81ed304b7e9b 499 WriteData( 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 0:881ff0b71102 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 2:81ed304b7e9b 510 WriteData( 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 0:881ff0b71102 519 unsigned short usedColorFG = fgColor == -1 ? _background : fgColor == -2 ? _foreground : ( unsigned short ) fgColor;
ttodorov 0:881ff0b71102 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 2:81ed304b7e9b 535 WriteData( usedColorFG );
ttodorov 0:881ff0b71102 536 else
ttodorov 2:81ed304b7e9b 537 WriteData( 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 2:81ed304b7e9b 555 WriteData( usedColorFG );
ttodorov 0:881ff0b71102 556 else
ttodorov 2:81ed304b7e9b 557 WriteData( 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 0:881ff0b71102 574 unsigned short usedColorFG = fgColor == -1 ? _background : fgColor == -2 ? _foreground : ( unsigned short ) fgColor;
ttodorov 0:881ff0b71102 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 2:81ed304b7e9b 593 WriteData( usedColorFG );
ttodorov 0:881ff0b71102 594 else
ttodorov 2:81ed304b7e9b 595 WriteData( 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 }