EasyRad
Programme de test pour lcd ITDB02
Fork of
TFTLCD
by 
Todor Todorov
Diff: lcd_base.cpp
- Revision:
- 0:881ff0b71102
- Child:
- 1:14bef43daf6f
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/lcd_base.cpp Sat Dec 01 19:38:53 2012 +0000
@@ -0,0 +1,610 @@
+/*
+ * Copyright (C)2010-2012 Henning Karlsen. All right reserved.
+ * Copyright (C)2012 Todor Todorov.
+ *
+ * This library is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU Lesser General Public
+ * License as published by the Free Software Foundation; either
+ * version 2.1 of the License, or (at your option) any later version.
+ *
+ * This library is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
+ * Lesser General Public License for more details.
+ *
+ * You should have received a copy of the GNU Lesser General Public
+ * License along with this library; if not, write to:
+ *
+ * Free Software Foundation, Inc.
+ * 51 Franklin St, 5th Floor, Boston, MA 02110-1301, USA
+ *
+ *********************************************************************/
+#include "lcd_base.h"
+
+#ifndef ushort
+typedef unsigned short ushort;
+#endif
+
+LCD::LCD( unsigned short width, unsigned short height ,PinName CS, PinName RS )
+ : _disp_width( width ), _disp_height( height ), _lcd_pin_cs( CS ), _lcd_pin_rs( RS )
+{}
+
+inline
+void LCD::SetForeground( unsigned short color )
+{
+ _foreground = color;
+}
+
+inline
+void LCD::SetBackground( unsigned short color )
+{
+ _background = color;
+}
+
+void LCD::SetFont( const char *font )
+{
+ _font.font = font;
+ _font.width = font[ 0 ];
+ _font.height = font[ 1 ];
+ _font.offset = font[ 2 ];
+ _font.numchars = font[ 3 ];
+}
+
+inline
+unsigned short LCD::GetWidth( void )
+{
+ if ( _orientation == LANDSCAPE ) return _disp_height;
+ return _disp_width;
+}
+
+inline
+unsigned short LCD::GetHeight( void )
+{
+ if ( _orientation == LANDSCAPE ) return _disp_width;
+ return _disp_height;
+}
+
+void LCD::FillScreen( int color )
+{
+ unsigned short rgb = color == -1 ? _background : color == -2 ? _foreground : ( unsigned short ) color;
+ _lcd_pin_cs = LOW;
+ clearXY();
+ _lcd_pin_rs = HIGH;
+ for ( int i = 0; i < ( ( _disp_width + 1 ) * ( _disp_height + 1 ) ); i++ )
+ writeData( rgb );
+ _lcd_pin_cs = HIGH;
+}
+
+inline
+void LCD::ClearScreen( void )
+{
+ FillScreen( -1 );
+}
+
+void LCD::DrawPixel( unsigned short x, unsigned short y, int color )
+{
+ _lcd_pin_cs = LOW;
+ setXY( x, y, x, y );
+ writeData( color == -1 ? _background :
+ color == -2 ? _foreground : color );
+ _lcd_pin_cs = HIGH;
+ clearXY();
+}
+
+void LCD::DrawLine( unsigned short x1, unsigned short y1, unsigned short x2, unsigned short y2, int color )
+{
+
+ double delta, tx, ty;
+
+ if ( ( ( x2 - x1 ) < 0 ) )
+ {
+ swap( ushort, x1, x2 )
+ swap( ushort, y1, y2 )
+ }
+ if ( ( ( y2 - y1 ) < 0 ) )
+ {
+ swap( ushort, x1, x2 )
+ swap( ushort, y1, y2 )
+ }
+
+ if ( y1 == y2 )
+ {
+ if ( x1 > x2 )
+ swap( ushort, x1, x2 )
+ drawHLine( x1, y1, x2 - x1, color );
+ }
+ else if ( x1 == x2 )
+ {
+ if ( y1 > y2 )
+ swap( ushort, y1, y2 )
+ drawVLine( x1, y1, y2 - y1, color );
+ }
+ else if ( abs( x2 - x1 ) > abs( y2 - y1 ) )
+ {
+ unsigned short usedColor = color == -1 ? _background : color == -2 ? _foreground : ( unsigned short ) color;
+ _lcd_pin_cs = LOW;
+ delta = ( double( y2 - y1 ) / double( x2 - x1 ) );
+ ty = double( y1 );
+ if ( x1 > x2 )
+ {
+ for ( int i = x1; i >= x2; i-- )
+ {
+ setXY( i, int( ty + 0.5 ), i, int( ty + 0.5 ) );
+ writeData( usedColor );
+ ty = ty - delta;
+ }
+ }
+ else
+ {
+ for ( int i = x1; i <= x2; i++ )
+ {
+ setXY( i, int( ty + 0.5 ), i, int( ty + 0.5 ) );
+ writeData( usedColor );
+ ty = ty + delta;
+ }
+ }
+ _lcd_pin_cs = HIGH;
+ }
+ else
+ {
+ unsigned short usedColor = color == -1 ? _background : color == -2 ? _foreground : ( unsigned short ) color;
+ _lcd_pin_cs = LOW;
+ delta = ( float( x2 - x1 ) / float( y2 - y1 ) );
+ tx = float( x1 );
+ if ( y1 > y2 )
+ {
+ for ( int i = y2 + 1; i > y1; i-- )
+ {
+ setXY( int( tx + 0.5 ), i, int( tx + 0.5 ), i );
+ writeData( usedColor );
+ tx = tx + delta;
+ }
+ }
+ else
+ {
+ for ( int i = y1; i < y2 + 1; i++ )
+ {
+ setXY( int( tx + 0.5 ), i, int( tx + 0.5 ), i );
+ writeData( usedColor );
+ tx = tx + delta;
+ }
+ }
+ _lcd_pin_cs = HIGH;
+ }
+
+ clearXY();
+}
+
+void LCD::DrawRect( unsigned short x1, unsigned short y1, unsigned short x2, unsigned short y2, int color )
+{
+ if ( x1 > x2 ) swap( ushort, x1, x2 )
+ if ( y1 > y2 ) swap( ushort, y1, y2 )
+
+ drawHLine( x1, y1, x2 - x1, color );
+ drawHLine( x1, y2, x2 - x1, color );
+ drawVLine( x1, y1, y2 - y1, color );
+ drawVLine( x2, y1, y2 - y1, color );
+}
+
+void LCD::DrawRoundRect( unsigned short x1, unsigned short y1, unsigned short x2, unsigned short y2, int color )
+{
+ if ( x1 > x2 ) swap( ushort, x1, x2 )
+ if ( y1 > y2 ) swap( ushort, y1, y2 )
+
+ if ( ( x2 - x1 ) > 4 && ( y2 - y1 ) > 4 )
+ {
+ DrawPixel( x1 + 1, y1 + 1, color );
+ DrawPixel( x2 - 1, y1 + 1, color );
+ DrawPixel( x1 + 1, y2 - 1, color );
+ DrawPixel( x2 - 1, y2 - 1, color );
+ drawHLine( x1 + 2, y1, x2 - x1 - 4, color );
+ drawHLine( x1 + 2, y2, x2 - x1 - 4, color );
+ drawVLine( x1, y1 + 2, y2 - y1 - 4, color );
+ drawVLine( x2, y1 + 2, y2 - y1 - 4, color );
+ }
+}
+
+void LCD::FillRect( unsigned short x1, unsigned short y1, unsigned short x2, unsigned short y2, int color )
+{
+ if ( x1 > x2 ) swap( ushort, x1, x2 );
+ if ( y1 > y2 ) swap( ushort, y1, y2 );
+
+ if ( _orientation == PORTRAIT )
+ {
+ for ( int i = 0; i < ( ( y2 - y1 ) / 2 ) + 1; i++ )
+ {
+ drawHLine( x1, y1 + i, x2 - x1, color );
+ drawHLine( x1, y2 - i, x2 - x1, color );
+ }
+ }
+ else
+ {
+ for ( int i = 0; i < ( ( x2 - x1 ) / 2 ) + 1; i++ )
+ {
+ drawVLine( x1 + i, y1, y2 - y1, color );
+ drawVLine( x2 - i, y1, y2 - y1, color );
+ }
+ }
+}
+
+void LCD::FillRoundRect( unsigned short x1, unsigned short y1, unsigned short x2, unsigned short y2, int color )
+{
+ if ( x1 > x2 ) swap( ushort, x1, x2 )
+ if ( y1 > y2 ) swap( ushort, y1, y2 )
+
+ if ( ( x2 - x1 ) > 4 && ( y2 - y1 ) > 4 )
+ {
+ for ( int i = 0; i < ( ( y2 - y1 ) / 2 ) + 1; i++ )
+ {
+ switch ( i )
+ {
+ case 0:
+ drawHLine( x1 + 2, y1 + i, x2 - x1 - 4, color );
+ drawHLine( x1 + 2, y2 - i, x2 - x1 - 4, color );
+ break;
+
+ case 1:
+ drawHLine( x1 + 1, y1 + i, x2 - x1 - 2, color );
+ drawHLine( x1 + 1, y2 - i, x2 - x1 - 2, color );
+ break;
+
+ default:
+ drawHLine( x1, y1 + i, x2 - x1, color );
+ drawHLine( x1, y2 - i, x2 - x1, color );
+ break;
+ }
+ }
+ }
+}
+
+void LCD::DrawCircle( unsigned short x, unsigned short y, unsigned short radius, int color )
+{
+ int f = 1 - radius;
+ int ddF_x = 1;
+ int ddF_y = -2 * radius;
+ int x1 = 0;
+ int y1 = radius;
+ unsigned short usedColor = color == -1 ? _background : color == -2 ? _foreground : ( unsigned short ) color;
+
+ _lcd_pin_cs = LOW;
+ setXY( x, y + radius, x, y + radius );
+ writeData( usedColor );
+ setXY( x, y - radius, x, y - radius );
+ writeData( usedColor );
+ setXY( x + radius, y, x + radius, y );
+ writeData( usedColor );
+ setXY( x - radius, y, x - radius, y );
+ writeData( usedColor );
+
+ while ( x1 < y1 )
+ {
+ if ( f >= 0 )
+ {
+ y1--;
+ ddF_y += 2;
+ f += ddF_y;
+ }
+ x1++;
+ ddF_x += 2;
+ f += ddF_x;
+ setXY( x + x1, y + y1, x + x1, y + y1 );
+ writeData( usedColor );
+ setXY( x - x1, y + y1, x - x1, y + y1 );
+ writeData( usedColor );
+ setXY( x + x1, y - y1, x + x1, y - y1 );
+ writeData( usedColor );
+ setXY( x - x1, y - y1, x - x1, y - y1 );
+ writeData( usedColor );
+ setXY( x + y1, y + x1, x + y1, y + x1 );
+ writeData( usedColor );
+ setXY( x - y1, y + x1, x - y1, y + x1 );
+ writeData( usedColor );
+ setXY( x + y1, y - x1, x + y1, y - x1 );
+ writeData( usedColor );
+ setXY( x - y1, y - x1, x - y1, y - x1 );
+ writeData( usedColor );
+ }
+ _lcd_pin_cs = HIGH;
+ clearXY();
+}
+
+void LCD::FillCircle( unsigned short x, unsigned short y, unsigned short radius, int color )
+{
+ unsigned short usedColor = color == -1 ? _background : color == -2 ? _foreground : ( unsigned short ) color;
+ _lcd_pin_cs = LOW;
+ for ( int y1 = -radius; y1 <= radius; y1++ )
+ for ( int x1 = -radius; x1 <= radius; x1++ )
+ if ( x1 * x1 + y1 * y1 <= radius * radius )
+ {
+ setXY( x + x1, y + y1, x + x1, y + y1 );
+ writeData( usedColor );
+ }
+ _lcd_pin_cs = HIGH;
+ clearXY();
+}
+
+void LCD::Print( const char *str, unsigned short x, unsigned short y, int fgColor, int bgColor, unsigned short deg )
+{
+ int stl, i;
+
+ stl = strlen( str );
+
+ if ( _orientation == PORTRAIT )
+ {
+ if ( x == RIGHT )
+ x = ( _disp_width + 1 ) - ( stl * _font.width );
+ if ( x == CENTER )
+ x = ( ( _disp_width + 1 ) - ( stl * _font.width ) ) / 2;
+ }
+ else
+ {
+ if ( x == RIGHT )
+ x = ( _disp_height + 1 ) - ( stl * _font.width );
+ if ( x == CENTER )
+ x = ( ( _disp_height + 1 ) - ( stl * _font.width ) ) / 2;
+ }
+
+ for ( i = 0; i < stl; i++ )
+ if ( deg == 0 )
+ printChar( *str++, x + ( i * ( _font.width ) ), y, fgColor, bgColor );
+ else
+ rotateChar( *str++, x, y, i, fgColor, bgColor, deg );
+}
+
+void LCD::DrawBitmap( unsigned short x, unsigned short y, unsigned short sx, unsigned short sy, bitmap_t data, unsigned char scale )
+{
+ int tx, ty, tc, tsx, tsy;
+
+ if ( scale == 1 )
+ {
+ if ( _orientation == PORTRAIT )
+ {
+ _lcd_pin_cs = LOW;
+ setXY( x, y, x + sx - 1, y + sy - 1 );
+ for ( tc = 0; tc < ( sx * sy ); tc++ )
+ writeData( data[ tc ] );
+ _lcd_pin_cs = HIGH;
+ }
+ else
+ {
+ _lcd_pin_cs = LOW;
+ for ( ty = 0; ty < sy; ty++ )
+ {
+ setXY( x, y + ty, x + sx - 1, y + ty );
+ for ( tx = sx; tx >= 0; tx-- )
+ writeData( data[ ( ty * sx ) + tx ] );
+ }
+ _lcd_pin_cs = HIGH;
+ }
+ }
+ else
+ {
+ if ( _orientation == PORTRAIT )
+ {
+ _lcd_pin_cs = LOW;
+ for ( ty = 0; ty < sy; ty++ )
+ {
+ setXY( x, y + ( ty * scale ), x + ( ( sx * scale ) - 1 ), y + ( ty * scale ) + scale );
+ for ( tsy = 0; tsy < scale; tsy++ )
+ for ( tx = 0; tx < sx; tx++ )
+ for ( tsx = 0; tsx < scale; tsx++ )
+ writeData( data[ ( ty * sx ) + tx ] );
+ }
+ _lcd_pin_cs = HIGH;
+ }
+ else
+ {
+ _lcd_pin_cs = LOW;
+ for ( ty = 0; ty < sy; ty++ )
+ {
+ for ( tsy = 0; tsy < scale; tsy++ )
+ {
+ setXY( x, y + ( ty * scale ) + tsy, x + ( ( sx * scale ) - 1 ), y + ( ty * scale ) + tsy );
+ for ( tx = sx; tx >= 0; tx-- )
+ for ( tsx = 0; tsx < scale; tsx++ )
+ writeData( data[ ( ty * sx ) + tx ] );
+ }
+ }
+ _lcd_pin_cs = HIGH;
+ }
+ }
+ clearXY();
+}
+
+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 )
+{
+ int tx, ty, newx, newy;
+ double radian;
+ radian = deg * 0.0175;
+
+ if ( deg == 0 )
+ DrawBitmap( x, y, sx, sy, data );
+ else
+ {
+ _lcd_pin_cs = LOW;
+ for ( ty = 0; ty < sy; ty++ )
+ for ( tx = 0; tx < sx; tx++ )
+ {
+ newx = x + rox + ( ( ( tx - rox ) * cos( radian ) ) - ( ( ty - roy ) * sin( radian ) ) );
+ newy = y + roy + ( ( ( ty - roy ) * cos( radian ) ) + ( ( tx - rox ) * sin( radian ) ) );
+
+ setXY( newx, newy, newx, newy );
+ writeData( data[ ( ty * sx ) + tx ] );
+ }
+ _lcd_pin_cs = HIGH;
+ }
+ clearXY();
+}
+
+/*
+void LCD::writeCmd( unsigned short cmd )
+{
+ _lcd_pin_rs = LOW;
+ _lcd_pin_cs = LOW;
+ _lcd_port->write( cmd );
+ pulseLow( _lcd_pin_wr );
+ _lcd_pin_cs = HIGH;
+}
+*/
+
+/*
+void LCD::writeData( unsigned short data )
+{
+ _lcd_pin_rs = HIGH;
+ _lcd_pin_cs = LOW;
+ _lcd_port->write( data );
+ pulseLow( _lcd_pin_wr );
+ _lcd_pin_cs = HIGH;
+}
+*/
+
+inline
+void LCD::writeCmdData( unsigned short cmd, unsigned short data )
+{
+ writeCmd( cmd );
+ writeData( data );
+}
+
+/*
+void LCD::setXY( uint16_t x1, uint16_t y1, uint16_t x2, uint16_t y2 )
+{
+ if ( _orientation == LANDSCAPE )
+ {
+ swap( uint16_t, x1, y1 )
+ swap( uint16_t, x2, y2 )
+ y1 = _disp_height - y1;
+ y2 = _disp_height - y2;
+ swap( uint16_t, y1, y2 )
+ }
+
+ writeCmdData( 0x44, ( x2 << 8 ) + x1 );
+ writeCmdData( 0x45, y1 );
+ writeCmdData( 0x46, y2 );
+ writeCmdData( 0x4e, x1 );
+ writeCmdData( 0x4f, y1 );
+ writeCmd( 0x22 );
+}
+*/
+
+void LCD::clearXY()
+{
+ if ( _orientation == PORTRAIT )
+ setXY( 0, 0, _disp_width, _disp_height );
+ else
+ setXY( 0, 0, _disp_height, _disp_width );
+}
+
+void LCD::drawHLine( unsigned short x, unsigned short y, unsigned short len, int color )
+{
+ unsigned short usedColor = color == -1 ? _background : color == -2 ? _foreground : ( unsigned short ) color;
+
+ _lcd_pin_cs = LOW;
+ setXY( x, y, x + len, y );
+ for ( int i = 0; i < len + 1; i++ )
+ writeData( usedColor );
+ _lcd_pin_cs = HIGH;
+ clearXY();
+}
+
+void LCD::drawVLine( unsigned short x, unsigned short y, unsigned short len, int color )
+{
+ unsigned short usedColor = color == -1 ? _background : color == -2 ? _foreground : ( unsigned short ) color;
+
+ _lcd_pin_cs = LOW;
+ setXY( x, y, x, y + len );
+ for ( int i = 0; i < len; i++ )
+ writeData( usedColor );
+ _lcd_pin_cs = HIGH;
+ clearXY();
+}
+
+void LCD::printChar( char c, unsigned short x, unsigned short y, int fgColor, int bgColor )
+{
+ uint8_t i, ch;
+ uint16_t j;
+ uint16_t temp;
+ unsigned short usedColorFG = fgColor == -1 ? _background : fgColor == -2 ? _foreground : ( unsigned short ) fgColor;
+ unsigned short usedColorBG = bgColor == -1 ? _background : bgColor == -2 ? _foreground : ( unsigned short ) bgColor;
+
+ _lcd_pin_cs = LOW;
+
+ if ( _orientation == PORTRAIT )
+ {
+ setXY( x, y, x + _font.width - 1, y + _font.height - 1 );
+
+ temp = ( ( c - _font.offset ) * ( ( _font.width / 8 ) * _font.height ) ) + 4;
+ for ( j = 0; j < ( ( _font.width / 8 ) * _font.height ); j++ )
+ {
+ ch = _font.font[ temp ];
+ for ( i = 0; i < 8; i++ )
+ {
+ if ( ( ch & ( 1 << ( 7 - i ) ) ) != 0 )
+ writeData( usedColorFG );
+ else
+ writeData( usedColorBG );
+ }
+ temp++;
+ }
+ }
+ else
+ {
+ temp = ( ( c - _font.offset ) * ( ( _font.width / 8 ) * _font.height ) ) + 4;
+
+ for ( j = 0; j < ( ( _font.width / 8 ) * _font.height ); j += ( _font.width / 8 ) )
+ {
+ setXY( x, y + ( j / ( _font.width / 8 ) ), x + _font.width - 1, y + ( j / ( _font.width / 8 ) ) );
+ for ( int zz = ( _font.width / 8 ) - 1; zz >= 0; zz-- )
+ {
+ ch = _font.font[ temp + zz ];
+ for ( i = 0; i < 8; i++ )
+ {
+ if ( ( ch & ( 1 << i ) ) != 0 )
+ writeData( usedColorFG );
+ else
+ writeData( usedColorBG );
+ }
+ }
+ temp += ( _font.width / 8 );
+ }
+ }
+ _lcd_pin_cs = HIGH;
+ clearXY();
+}
+
+void LCD::rotateChar( char c, unsigned short x, unsigned short y, int pos, int fgColor, int bgColor, unsigned short deg )
+{
+ uint8_t i, j, ch;
+ uint16_t temp;
+ int newx, newy;
+ double radian;
+ radian = deg * 0.0175;
+
+ unsigned short usedColorFG = fgColor == -1 ? _background : fgColor == -2 ? _foreground : ( unsigned short ) fgColor;
+ unsigned short usedColorBG = bgColor == -1 ? _background : bgColor == -2 ? _foreground : ( unsigned short ) bgColor;
+
+ _lcd_pin_cs = LOW;
+
+ temp = ( ( c - _font.offset ) * ( ( _font.width / 8 ) * _font.height ) ) + 4;
+ for ( j = 0; j < _font.height; j++ )
+ {
+ for ( int zz = 0; zz < ( _font.width / 8 ); zz++ )
+ {
+ ch = _font.font[ temp + zz ];
+ for ( i = 0; i < 8; i++ )
+ {
+ newx = x + ( ( ( i + ( zz * 8 ) + ( pos * _font.width ) ) * cos( radian ) ) - ( ( j ) * sin( radian ) ) );
+ newy = y + ( ( ( j ) * cos( radian ) ) + ( ( i + ( zz * 8 ) + ( pos * _font.width ) ) * sin( radian ) ) );
+
+ setXY( newx, newy, newx + 1, newy + 1 );
+
+ if ( ( ch & ( 1 << ( 7 - i ) ) ) != 0 )
+ writeData( usedColorFG );
+ else
+ writeData( usedColorBG );
+ }
+ }
+ temp += ( _font.width / 8 );
+ }
+ _lcd_pin_cs = HIGH;
+ clearXY();
+}