Ale C.-
LCD TFT
Dependents: Example_Menu_LCD_TFT
Diff: LCDTFT.cpp
- Revision:
- 1:1085b6177f6e
- Parent:
- 0:359653f39307
--- a/LCDTFT.cpp Sun Jan 30 20:25:48 2011 +0000
+++ b/LCDTFT.cpp Tue Mar 15 01:47:35 2011 +0000
@@ -1,393 +1,401 @@
-/*
- @file LCDTFT.cpp
- @version: 1.0
-
- @web www.micros-designs.com.ar
- @date 30/01/11
-
-*- Version Log --------------------------------------------------------------*
-* Fecha Autor Comentarios *
-*----------------------------------------------------------------------------*
-* 30/01/11 Suky Original *
-*----------------------------------------------------------------------------*/
-///////////////////////////////////////////////////////////////////////////
-//// ////
-//// ////
-//// (C) Copyright 2011 www.micros-designs.com.ar ////
-//// Este código puede ser usado, modificado y distribuido libremente ////
-//// sin eliminar esta cabecera y sin garantÃa de ningún tipo. ////
-//// ////
-//// ////
-///////////////////////////////////////////////////////////////////////////
-#include "LCDTFT.h"
-
-LCDTFT::LCDTFT(PinName PIN_RD,PinName PIN_WR,PinName PIN_RS,PinName PIN_CS,PinName PIN_RESET, BusOut *BUSLCD)
- : LCD_PIN_RD(PIN_RD),LCD_PIN_WR(PIN_WR),LCD_PIN_RS(PIN_RS),LCD_PIN_CS(PIN_CS),LCD_PIN_RESET(PIN_RESET){
- LCD_PORT=BUSLCD;
- X=0;
- Y=0;
- X_min=0;
- X_max=LCD_X_MAX;
- _Alto=1;
- _Color=0x0000;
-}
-
-void LCDTFT::vLCDTFTSetParametersPrintf(unsigned short Xo,unsigned short Yo,unsigned short Xmin,unsigned short Xmax,unsigned char Alto, unsigned short Color){
-
- X=Xo;
- Y=Yo;
- X_min=Xmin;
- X_max=Xmax;
- _Alto=Alto;
- _Color=Color;
-}
-
-int LCDTFT::_putc(int value){
- char Fmt[2]={value,0};
-
- if(value=='\n'){
- X=X_min;
- Y+=7*_Alto + 1;
- }else{
- vLCDTFTText(X,Y,(const char *)&Fmt[0],&ARIAL[0],_Alto,_Color);
- X+=5*_Alto+1;
- if(X >= X_max){
- X = X_min;
- Y += 7*_Alto + 1;
- }
- }
- return(value);
-}
-
-int LCDTFT::_getc(){
- return(-1);
-}
-
-void LCDTFT::vLCDTFTWriteCommand(unsigned short Data){
-
- LCD_PIN_RS=0;
- LCD_PIN_CS=0;
- LCD_PORT->write(Data);
- LCD_PIN_WR=0;
- LCD_PIN_WR=1;
- LCD_PIN_CS=1;
-}
-
-void LCDTFT::vLCDTFTWriteData(unsigned short Data){
- LCD_PIN_RS=1;
- LCD_PIN_CS=0;
- LCD_PORT->write(Data);
- LCD_PIN_WR=0;
- LCD_PIN_WR=1;
- LCD_PIN_CS =1;
-}
-
-
-void LCDTFT::vLCDTFTWriteCommandData(unsigned short CMD,unsigned short Data){
- vLCDTFTWriteCommand(CMD);
- vLCDTFTWriteData(Data);
-}
-
-void LCDTFT::vLCDTFTAddressSet(unsigned short x1,unsigned short y1,unsigned short x2,unsigned short y2){
-
- vLCDTFTWriteCommandData(0x0044,(x2<<8)+x1);
- vLCDTFTWriteCommandData(0x0045,y1);
- vLCDTFTWriteCommandData(0x0046,y2);
- vLCDTFTWriteCommandData(0x004e,x1);
- vLCDTFTWriteCommandData(0x004f,y1);
- vLCDTFTWriteCommand(0x0022);
-}
-
-void LCDTFT::vLCDTFTAddressSetPoint(unsigned short x,unsigned short y){
-
- vLCDTFTWriteCommandData(0x004e,x);
- vLCDTFTWriteCommandData(0x004f,y);
- vLCDTFTWriteCommand(0x0022);
-}
-
-void LCDTFT::vLCDTFTInit(void){
-
- LCD_PIN_RESET=1;
- wait_ms(5);
- LCD_PIN_RESET=0;
- wait_ms(10);
- LCD_PIN_RESET=1;
- LCD_PIN_CS=1;
- LCD_PIN_RD=1;
- LCD_PIN_WR=1;
- wait_ms(20);
-
- vLCDTFTWriteCommandData(0x0000,0x0001); wait_ms(1);
- vLCDTFTWriteCommandData(0x0003,0xA8A4); wait_ms(1);
- vLCDTFTWriteCommandData(0x000C,0x0000); wait_ms(1);
- vLCDTFTWriteCommandData(0x000D,0x080C); wait_ms(1);
- vLCDTFTWriteCommandData(0x000E,0x2B00); wait_ms(1);
- vLCDTFTWriteCommandData(0x001E,0x00B0); wait_ms(1);
- vLCDTFTWriteCommandData(0x0001,0x2B3F); wait_ms(1);
- vLCDTFTWriteCommandData(0x0002,0x0600); wait_ms(1);
- vLCDTFTWriteCommandData(0x0010,0x0000); wait_ms(1);
- vLCDTFTWriteCommandData(0x0011,0x6070); wait_ms(1);
- vLCDTFTWriteCommandData(0x0005,0x0000); wait_ms(1);
- vLCDTFTWriteCommandData(0x0006,0x0000); wait_ms(1);
- vLCDTFTWriteCommandData(0x0016,0xEF1C); wait_ms(1);
- vLCDTFTWriteCommandData(0x0017,0x0003); wait_ms(1);
- vLCDTFTWriteCommandData(0x0007,0x0233); wait_ms(1);
- vLCDTFTWriteCommandData(0x000B,0x0000); wait_ms(1);
- vLCDTFTWriteCommandData(0x000F,0x0000); wait_ms(1);
- vLCDTFTWriteCommandData(0x0041,0x0000); wait_ms(1);
- vLCDTFTWriteCommandData(0x0042,0x0000); wait_ms(1);
- vLCDTFTWriteCommandData(0x0048,0x0000); wait_ms(1);
- vLCDTFTWriteCommandData(0x0049,0x013F); wait_ms(1);
- vLCDTFTWriteCommandData(0x004A,0x0000); wait_ms(1);
- vLCDTFTWriteCommandData(0x004B,0x0000); wait_ms(1);
- vLCDTFTWriteCommandData(0x0044,0xEF00); wait_ms(1);
- vLCDTFTWriteCommandData(0x0045,0x0000); wait_ms(1);
- vLCDTFTWriteCommandData(0x0046,0x013F); wait_ms(1);
- vLCDTFTWriteCommandData(0x0030,0x0707); wait_ms(1);
- vLCDTFTWriteCommandData(0x0031,0x0204); wait_ms(1);
- vLCDTFTWriteCommandData(0x0032,0x0204); wait_ms(1);
- vLCDTFTWriteCommandData(0x0033,0x0502); wait_ms(1);
- vLCDTFTWriteCommandData(0x0034,0x0507); wait_ms(1);
- vLCDTFTWriteCommandData(0x0035,0x0204); wait_ms(1);
- vLCDTFTWriteCommandData(0x0036,0x0204); wait_ms(1);
- vLCDTFTWriteCommandData(0x0037,0x0502); wait_ms(1);
- vLCDTFTWriteCommandData(0x003A,0x0302); wait_ms(1);
- vLCDTFTWriteCommandData(0x003B,0x0302); wait_ms(1);
- vLCDTFTWriteCommandData(0x0023,0x0000); wait_ms(1);
- vLCDTFTWriteCommandData(0x0024,0x0000); wait_ms(1);
- vLCDTFTWriteCommandData(0x0025,0x8000); wait_ms(1);
- vLCDTFTWriteCommandData(0x004f,0);
- vLCDTFTWriteCommandData(0x004e,0);
- vLCDTFTWriteCommand(0x0022);
-}
-
-void LCDTFT::vLCDTFTFillScreen(unsigned short Color){
- unsigned short i,j;
- vLCDTFTAddressSet(0,0,239,319);
-
- for(i=0;i<320;i++){
- for (j=0;j<240;j++){
- vLCDTFTWriteData(Color);
- }
- }
-}
-
-void LCDTFT::vLCDTFTPoint(unsigned short x,unsigned short y,unsigned short Color){
-
- vLCDTFTAddressSetPoint(x,y);
- vLCDTFTWriteData(Color);
-}
-
-void LCDTFT::vLCDTFTText(unsigned short x,unsigned short y,const char *PtrText,const char (*Fuente)[5],unsigned char Alto,unsigned short Color){
- unsigned short i, j, k, l, m, temp;
- char DataPunto[5];
- const char *Ptr;
-
- while(*PtrText!='\0'){
- Ptr=(Fuente+*PtrText-' ')[0];
- for(i=0;i<5;i++){DataPunto[i]=*Ptr++;}
- switch(*PtrText){
- case '\n':
- y += 7*Alto + 1;
- break;
- case '\r':
- x = 0;
- break;
- default:
- if(x+5*Alto >= LCD_X_MAX){
- x = 0;
- y += 7*Alto + 1;
- }
- for(j=0; j<5; ++j, x+=Alto){
- for(k=0; k < 7; k++){
- temp=(0x01<<k);
- if((DataPunto[j]&temp)==temp){
- for(l=0; l < Alto; ++l){
- for(m=0; m < Alto; ++m){
- vLCDTFTPoint(x+m,y+k*Alto+l,Color);
- }
- }
- }
- }
- }
- x++;
- break;
- }
- *PtrText++;
- }
-}
-
-void LCDTFT::vLCDTFTLine(unsigned short x1,unsigned short y1,unsigned short x2,unsigned short y2,unsigned short Color){
-
- unsigned short dy, dx;
- short addx=1, addy=1;
- short P, diff;
- unsigned short i=0;
-
- diff=((short)x2-x1);
- if(diff<0) diff*=-1;
- dx=diff;
- diff=((short)y2-y1);
- if(diff<0) diff*=-1;
- dy=diff;
-
-
- if(x1 > x2)addx = -1;
- if(y1 > y2)addy = -1;
- if(dx >= dy){
- dy *= 2;
- P = dy - dx;
- diff = P - dx;
- for(;i<=dx;++i){
- vLCDTFTPoint(x1, y1, Color);
- if(P < 0){
- P += dy;
- x1 += addx;
- }else{
- P += diff;
- x1 += addx;
- y1 += addy;
- }
- }
- }else{
- dx *= 2;
- P = dx - dy;
- diff = P - dy;
- for(; i<=dy; ++i){
- vLCDTFTPoint(x1, y1, Color);
- if(P < 0){
- P += dx;
- y1 += addy;
- }else{
- P += diff;
- x1 += addx;
- y1 += addy;
- }
- }
- }
-}
-
-
-void LCDTFT::vLCDTFTRectangle(unsigned short x1,unsigned short y1,unsigned short x2,unsigned short y2,bool Filled,unsigned short Color){
-
- if(Filled){
- int Lenght=((int)(x2-x1+1)*(y2-y1+1));
-
- vLCDTFTAddressSet(x1,y1,x2,y2);
- for(int i=0;i<Lenght;i++){
- vLCDTFTWriteData(Color);
- }
- }else{
- vLCDTFTLine(x1, y1, x2, y1, Color);
- vLCDTFTLine(x1, y2, x2, y2, Color);
- vLCDTFTLine(x1, y1, x1, y2, Color);
- vLCDTFTLine(x2, y1, x2, y2, Color);
- }
-}
-
-
-void LCDTFT::vLCDTFTCircle(unsigned short x,unsigned short y,unsigned short Radius,bool Filled,unsigned short Color){
- short a, b, P;
-
- a = 0;
- b = Radius;
- P = 1 - Radius;
-
- do{
- if(Filled){
- vLCDTFTLine(x-a, y+b, x+a, y+b, Color);
- vLCDTFTLine(x-a, y-b, x+a, y-b, Color);
- vLCDTFTLine(x-b, y+a, x+b, y+a, Color);
- vLCDTFTLine(x-b, y-a, x+b, y-a, Color);
- }else{
- vLCDTFTPoint(a+x, b+y, Color);
- vLCDTFTPoint(b+x, a+y, Color);
- vLCDTFTPoint(x-a, b+y, Color);
- vLCDTFTPoint(x-b, a+y, Color);
- vLCDTFTPoint(b+x, y-a, Color);
- vLCDTFTPoint(a+x, y-b, Color);
- vLCDTFTPoint(x-a, y-b, Color);
- vLCDTFTPoint(x-b, y-a, Color);
- }
- if(P < 0) P += 3 + 2 * a++;
- else P += 5 + 2 * (a++ - b--);
- }while(a <= b);
-}
-
-void LCDTFT::vDrawImageBMP24Bits(const char *NameImagen){
-
- #define OffsetWidthPixel 18
- #define OffsetHeighPixel 22
- #define OffsetSizeFile 34
- #define OffsetInitData 10
- #define OffserTipeFile 28
- char Nombre[80],k;
- unsigned short PosXImagen,PosYImagen;
- unsigned char Temp,BufferHeader[54],BufferTemp[3],Adicional;
- unsigned int WidthPixel,HeighPixel;
- unsigned short TipeFile,InitData,Temp16bits;
- union{
- unsigned short Val;
- struct{
- unsigned Blue:5;
- unsigned Green:6;
- unsigned Red:5;
- };
- }Color;
-
- LocalFileSystem local("mbedMemory");
- sprintf(&Nombre[0],"/mbedMemory/");
- k=12;
- while(*NameImagen!='\0'){
- Nombre[k++]=*NameImagen++;
- }
-
- FILE *Imagen = fopen((const char *)&Nombre[0], "r"); // Abrimos archivo para lectura.
- // Si no se pudo encontrar archivo:
- if(!Imagen) {
- vLCDTFTFillScreen(ColorBlack);
- return;
- }
- // Leemos cabecera de archivo
- fread(&BufferHeader[0],1,54,Imagen);
-
- WidthPixel = ((unsigned int)BufferHeader[OffsetWidthPixel + 3]*16777216+BufferHeader[OffsetWidthPixel + 2]*65536+BufferHeader[OffsetWidthPixel + 1]*256+BufferHeader[OffsetWidthPixel]);
- HeighPixel = ((unsigned int)BufferHeader[OffsetHeighPixel + 3]*16777216+BufferHeader[OffsetHeighPixel + 2]*65536+BufferHeader[OffsetHeighPixel + 1]*256+BufferHeader[OffsetHeighPixel]);
- InitData = ((unsigned short)BufferHeader[OffsetInitData]);
- TipeFile = ((unsigned short)BufferHeader[OffserTipeFile + 1]*256 + BufferHeader[OffserTipeFile]);
-
- if((WidthPixel>LCD_X_MAX) || (HeighPixel>LCD_Y_MAX) || (TipeFile!=24)){
- fclose(Imagen);
- return;
- }
-
- if(InitData!=54){
- for(int k=54;k<InitData;k++){
- fread(&Temp,1,1,Imagen);
- }
- }
-
- PosXImagen=(LCD_X_MAX/2)-(WidthPixel/2);
- PosYImagen=(LCD_Y_MAX/2)+(HeighPixel/2);
-
- Temp16bits=WidthPixel*3;
- Adicional=0;
- while(((Temp16bits)%4)!=0){
- Adicional++;
- Temp16bits++;
- }
-
- for(int k=0,y=PosYImagen;k<HeighPixel;k++,y--){
- vLCDTFTAddressSet(PosXImagen,y,PosXImagen+WidthPixel-1,y);
- for(int i=0;i<WidthPixel;i++){
- fread(&BufferTemp[0],1,3,Imagen); // Leemos 3 bytes (R,G,B)
- Color.Blue=BufferTemp[0]>>3;Color.Green=BufferTemp[1]>>2;Color.Red=BufferTemp[2]>>3; // Conversion de 24-bits a 16-bits.-
- vLCDTFTWriteData(Color.Val);
- }
- // Bytes adicionales para que linea sea multiplo de 4.-
- for(int p=0;p<Adicional;p++){
- fread(&Temp,1,1,Imagen);
- }
- }
- fclose(Imagen);
+/*
+ @file LCDTFT.cpp
+ @version: 1.0
+
+ @web www.micros-designs.com.ar
+ @date 30/01/11
+
+*- Version Log --------------------------------------------------------------*
+* Fecha Autor Comentarios *
+*----------------------------------------------------------------------------*
+* 30/01/11 Suky Original *
+*----------------------------------------------------------------------------*/
+///////////////////////////////////////////////////////////////////////////
+//// ////
+//// ////
+//// (C) Copyright 2011 www.micros-designs.com.ar ////
+//// Este código puede ser usado, modificado y distribuido libremente ////
+//// sin eliminar esta cabecera y sin garantía de ningún tipo. ////
+//// ////
+//// ////
+///////////////////////////////////////////////////////////////////////////
+#include "LCDTFT.h"
+
+LCDTFT::LCDTFT(PinName PIN_RD,PinName PIN_WR,PinName PIN_RS,PinName PIN_CS,PinName PIN_RESET, BusOut *BUSLCD)
+ : LCD_PIN_RD(PIN_RD),LCD_PIN_WR(PIN_WR),LCD_PIN_RS(PIN_RS),LCD_PIN_CS(PIN_CS),LCD_PIN_RESET(PIN_RESET){
+ LCD_PORT=BUSLCD;
+ X=0;
+ Y=0;
+ X_min=0;
+ X_max=LCD_X_MAX;
+ _Alto=1;
+ _Color=0x0000;
+}
+
+void LCDTFT::vLCDTFTSetParametersPrintf(unsigned short Xo,unsigned short Yo,unsigned short Xmin,unsigned short Xmax,unsigned char Alto, unsigned short Color){
+
+ X=Xo;
+ Y=Yo;
+ X_min=Xmin;
+ X_max=Xmax;
+ _Alto=Alto;
+ _Color=Color;
+}
+
+int LCDTFT::_putc(int value){
+ char Fmt[2]={value,0};
+
+ if(value=='\n'){
+ X=X_min;
+ Y+=7*_Alto + 1;
+ }else{
+ vLCDTFTText(X,Y,(const char *)&Fmt[0],&ARIAL[0],_Alto,_Color);
+ X+=5*_Alto+1;
+ if(X >= X_max){
+ X = X_min;
+ Y += 7*_Alto + 1;
+ }
+ }
+ return(value);
+}
+
+int LCDTFT::_getc(){
+ return(-1);
+}
+
+void LCDTFT::vLCDTFTWriteCommand(unsigned short Data){
+
+ LCD_PIN_RS=0;
+ LCD_PIN_CS=0;
+ LCD_PORT->write(Data);
+ LCD_PIN_WR=0;
+ LCD_PIN_WR=1;
+ LCD_PIN_CS=1;
+}
+
+void LCDTFT::vLCDTFTWriteData(unsigned short Data){
+ LCD_PIN_RS=1;
+ LCD_PIN_CS=0;
+ LCD_PORT->write(Data);
+ LCD_PIN_WR=0;
+ LCD_PIN_WR=1;
+ LCD_PIN_CS =1;
+}
+
+
+void LCDTFT::vLCDTFTWriteCommandData(unsigned short CMD,unsigned short Data){
+ vLCDTFTWriteCommand(CMD);
+ vLCDTFTWriteData(Data);
+}
+
+void LCDTFT::vLCDTFTAddressSet(unsigned short x1,unsigned short y1,unsigned short x2,unsigned short y2){
+
+ vLCDTFTWriteCommandData(0x0044,(x2<<8)+x1);
+ vLCDTFTWriteCommandData(0x0045,y1);
+ vLCDTFTWriteCommandData(0x0046,y2);
+ vLCDTFTWriteCommandData(0x004e,x1);
+ vLCDTFTWriteCommandData(0x004f,y1);
+ vLCDTFTWriteCommand(0x0022);
+}
+
+void LCDTFT::vLCDTFTAddressSetPoint(unsigned short x,unsigned short y){
+
+ vLCDTFTWriteCommandData(0x004e,x);
+ vLCDTFTWriteCommandData(0x004f,y);
+ vLCDTFTWriteCommand(0x0022);
+}
+
+void LCDTFT::vLCDTFTInit(void){
+
+ LCD_PIN_RESET=1;
+ wait_ms(5);
+ LCD_PIN_RESET=0;
+ wait_ms(10);
+ LCD_PIN_RESET=1;
+ LCD_PIN_CS=1;
+ LCD_PIN_RD=1;
+ LCD_PIN_WR=1;
+ wait_ms(20);
+
+ vLCDTFTWriteCommandData(0x0000,0x0001); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0003,0xA8A4); wait_ms(1);
+ vLCDTFTWriteCommandData(0x000C,0x0000); wait_ms(1);
+ vLCDTFTWriteCommandData(0x000D,0x080C); wait_ms(1);
+ vLCDTFTWriteCommandData(0x000E,0x2B00); wait_ms(1);
+ vLCDTFTWriteCommandData(0x001E,0x00B0); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0001,0x2B3F); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0002,0x0600); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0010,0x0000); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0011,0x6070); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0005,0x0000); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0006,0x0000); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0016,0xEF1C); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0017,0x0003); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0007,0x0233); wait_ms(1);
+ vLCDTFTWriteCommandData(0x000B,0x0000); wait_ms(1);
+ vLCDTFTWriteCommandData(0x000F,0x0000); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0041,0x0000); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0042,0x0000); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0048,0x0000); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0049,0x013F); wait_ms(1);
+ vLCDTFTWriteCommandData(0x004A,0x0000); wait_ms(1);
+ vLCDTFTWriteCommandData(0x004B,0x0000); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0044,0xEF00); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0045,0x0000); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0046,0x013F); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0030,0x0707); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0031,0x0204); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0032,0x0204); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0033,0x0502); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0034,0x0507); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0035,0x0204); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0036,0x0204); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0037,0x0502); wait_ms(1);
+ vLCDTFTWriteCommandData(0x003A,0x0302); wait_ms(1);
+ vLCDTFTWriteCommandData(0x003B,0x0302); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0023,0x0000); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0024,0x0000); wait_ms(1);
+ vLCDTFTWriteCommandData(0x0025,0x8000); wait_ms(1);
+ vLCDTFTWriteCommandData(0x004f,0);
+ vLCDTFTWriteCommandData(0x004e,0);
+ vLCDTFTWriteCommand(0x0022);
+}
+
+void LCDTFT::vLCDTFTFillScreen(unsigned short Color){
+ unsigned short i,j;
+ vLCDTFTAddressSet(0,0,239,319);
+
+ for(i=0;i<320;i++){
+ for (j=0;j<240;j++){
+ vLCDTFTWriteData(Color);
+ }
+ }
+}
+
+void LCDTFT::vLCDTFTPoint(unsigned short x,unsigned short y,unsigned short Color){
+
+ vLCDTFTAddressSetPoint(x,y);
+ vLCDTFTWriteData(Color);
+}
+
+void LCDTFT::vLCDTFTText(unsigned short x,unsigned short y,const char *PtrText,const char (*Fuente)[5],unsigned char Alto,unsigned short Color){
+ unsigned short i, j, k, l, m, temp;
+ char DataPunto[5];
+ const char *Ptr;
+
+ while(*PtrText!='\0'){
+ Ptr=(Fuente+*PtrText-' ')[0];
+ for(i=0;i<5;i++){DataPunto[i]=*Ptr++;}
+ switch(*PtrText){
+ case '\n':
+ y += 7*Alto + 1;
+ break;
+ case '\r':
+ x = 0;
+ break;
+ default:
+ if(x+5*Alto >= LCD_X_MAX){
+ x = 0;
+ y += 7*Alto + 1;
+ }
+ for(j=0; j<5; ++j, x+=Alto){
+ for(k=0; k < 7; k++){
+ temp=(0x01<<k);
+ if((DataPunto[j]&temp)==temp){
+ for(l=0; l < Alto; ++l){
+ for(m=0; m < Alto; ++m){
+ vLCDTFTPoint(x+m,y+k*Alto+l,Color);
+ }
+ }
+ }
+ }
+ }
+ x++;
+ break;
+ }
+ *PtrText++;
+ }
+}
+
+void LCDTFT::vLCDTFTLine(unsigned short x1,unsigned short y1,unsigned short x2,unsigned short y2,unsigned short Color){
+
+ unsigned short dy, dx;
+ short addx=1, addy=1;
+ short P, diff;
+ unsigned short i=0;
+
+ diff=((short)x2-x1);
+ if(diff<0) diff*=-1;
+ dx=diff;
+ diff=((short)y2-y1);
+ if(diff<0) diff*=-1;
+ dy=diff;
+
+
+ if(x1 > x2)addx = -1;
+ if(y1 > y2)addy = -1;
+ if(dx >= dy){
+ dy *= 2;
+ P = dy - dx;
+ diff = P - dx;
+ for(;i<=dx;++i){
+ vLCDTFTPoint(x1, y1, Color);
+ if(P < 0){
+ P += dy;
+ x1 += addx;
+ }else{
+ P += diff;
+ x1 += addx;
+ y1 += addy;
+ }
+ }
+ }else{
+ dx *= 2;
+ P = dx - dy;
+ diff = P - dy;
+ for(; i<=dy; ++i){
+ vLCDTFTPoint(x1, y1, Color);
+ if(P < 0){
+ P += dx;
+ y1 += addy;
+ }else{
+ P += diff;
+ x1 += addx;
+ y1 += addy;
+ }
+ }
+ }
+}
+
+
+void LCDTFT::vLCDTFTRectangle(unsigned short x1,unsigned short y1,unsigned short x2,unsigned short y2,bool Filled,unsigned short Color){
+
+ if(Filled){
+ int Lenght=((int)(x2-x1+1)*(y2-y1+1));
+
+ vLCDTFTAddressSet(x1,y1,x2,y2);
+ for(int i=0;i<Lenght;i++){
+ vLCDTFTWriteData(Color);
+ }
+ }else{
+ vLCDTFTLine(x1, y1, x2, y1, Color);
+ vLCDTFTLine(x1, y2, x2, y2, Color);
+ vLCDTFTLine(x1, y1, x1, y2, Color);
+ vLCDTFTLine(x2, y1, x2, y2, Color);
+ }
+}
+
+
+void LCDTFT::vLCDTFTCircle(unsigned short x,unsigned short y,unsigned short Radius,bool Filled,unsigned short Color){
+ short a, b, P;
+
+ a = 0;
+ b = Radius;
+ P = 1 - Radius;
+
+ do{
+ if(Filled){
+ vLCDTFTLine(x-a, y+b, x+a, y+b, Color);
+ vLCDTFTLine(x-a, y-b, x+a, y-b, Color);
+ vLCDTFTLine(x-b, y+a, x+b, y+a, Color);
+ vLCDTFTLine(x-b, y-a, x+b, y-a, Color);
+ }else{
+ vLCDTFTPoint(a+x, b+y, Color);
+ vLCDTFTPoint(b+x, a+y, Color);
+ vLCDTFTPoint(x-a, b+y, Color);
+ vLCDTFTPoint(x-b, a+y, Color);
+ vLCDTFTPoint(b+x, y-a, Color);
+ vLCDTFTPoint(a+x, y-b, Color);
+ vLCDTFTPoint(x-a, y-b, Color);
+ vLCDTFTPoint(x-b, y-a, Color);
+ }
+ if(P < 0) P += 3 + 2 * a++;
+ else P += 5 + 2 * (a++ - b--);
+ }while(a <= b);
+}
+
+void LCDTFT::vDrawImageBMP24Bits(const char *NameImagen){
+
+ #define OffsetWidthPixel 18
+ #define OffsetHeighPixel 22
+ #define OffsetSizeFile 34
+ #define OffsetInitData 10
+ #define OffserTipeFile 28
+ char Nombre[80],k;
+ unsigned short PosXImagen,PosYImagen;
+ unsigned char Temp,BufferHeader[54],BufferTemp[3],Adicional;
+ unsigned int WidthPixel,HeighPixel;
+ unsigned short TipeFile,InitData,Temp16bits;
+ union{
+ unsigned short Val;
+ struct{
+ unsigned Blue:5;
+ unsigned Green:6;
+ unsigned Red:5;
+ };
+ }Color;
+
+ LocalFileSystem local("mbedMemory");
+ sprintf(&Nombre[0],"/mbedMemory/");
+ k=12;
+ while(*NameImagen!='\0'){
+ Nombre[k++]=*NameImagen++;
+ }
+
+ FILE *Imagen = fopen((const char *)&Nombre[0], "r"); // Abrimos archivo para lectura.
+ // Si no se pudo encontrar archivo:
+ if(!Imagen) {
+ vLCDTFTFillScreen(ColorBlack);
+ return;
+ }
+ // Leemos cabecera de archivo
+ fread(&BufferHeader[0],1,54,Imagen);
+
+ WidthPixel = ((unsigned int)BufferHeader[OffsetWidthPixel + 3]*16777216+BufferHeader[OffsetWidthPixel + 2]*65536+BufferHeader[OffsetWidthPixel + 1]*256+BufferHeader[OffsetWidthPixel]);
+ HeighPixel = ((unsigned int)BufferHeader[OffsetHeighPixel + 3]*16777216+BufferHeader[OffsetHeighPixel + 2]*65536+BufferHeader[OffsetHeighPixel + 1]*256+BufferHeader[OffsetHeighPixel]);
+ InitData = ((unsigned short)BufferHeader[OffsetInitData]);
+ TipeFile = ((unsigned short)BufferHeader[OffserTipeFile + 1]*256 + BufferHeader[OffserTipeFile]);
+
+ if((WidthPixel>LCD_X_MAX) || (HeighPixel>LCD_Y_MAX) || (TipeFile!=24)){
+ fclose(Imagen);
+ return;
+ }
+
+ if(InitData!=54){
+ for(int k=54;k<InitData;k++){
+ fread(&Temp,1,1,Imagen);
+ }
+ }
+
+ PosXImagen=(LCD_X_MAX/2)-(WidthPixel/2);
+ PosYImagen=(LCD_Y_MAX/2)+(HeighPixel/2);
+
+ Temp16bits=WidthPixel*3;
+ Adicional=0;
+ while(((Temp16bits)%4)!=0){
+ Adicional++;
+ Temp16bits++;
+ }
+
+ for(int k=0,y=PosYImagen;k<HeighPixel;k++,y--){
+ vLCDTFTAddressSet(PosXImagen,y,PosXImagen+WidthPixel-1,y);
+ for(int i=0;i<WidthPixel;i++){
+ fread(&BufferTemp[0],1,3,Imagen); // Leemos 3 bytes (R,G,B)
+ Color.Blue=BufferTemp[0]>>3;Color.Green=BufferTemp[1]>>2;Color.Red=BufferTemp[2]>>3; // Conversion de 24-bits a 16-bits.-
+ vLCDTFTWriteData(Color.Val);
+ }
+ // Bytes adicionales para que linea sea multiplo de 4.-
+ for(int p=0;p<Adicional;p++){
+ fread(&Temp,1,1,Imagen);
+ }
+ }
+ fclose(Imagen);
+}
+
+void LCDTFT::vLCDTFTDrawImage(unsigned short x,unsigned short y, unsigned short Width, unsigned short Heigh, unsigned int Lenght, const unsigned short *Imagen){
+
+ vLCDTFTAddressSet(x,y,x+Width-1,y+Heigh-1);
+ for(int i=0;i<Lenght;i++){
+ vLCDTFTWriteData(*Imagen++);
+ }
}
\ No newline at end of file