#include "lcd.h"
#define MCKLCD 48054857
//-----------------------------------
unsigned char LCDRS,LCDE,LCDDB0,LCDDB1,LCDDB2,LCDDB3,LCDDB4,LCDDB5,LCDDB6,LCDDB7;
//-----------------------------------
void lcd_pininit (unsigned char RS,unsigned char E,unsigned char DB0,unsigned char DB1,unsigned char DB2,
                  unsigned char DB3,unsigned char DB4,unsigned char DB5,unsigned char DB6,unsigned char DB7)
{
LCDRS = RS;
LCDE = E;
LCDDB0 = DB0;
LCDDB1 = DB1;
LCDDB2 = DB2;
LCDDB3 = DB3;
LCDDB4 = DB4;
LCDDB5 = DB5;
LCDDB6 = DB6;
LCDDB7 = DB7;
}
//-----------------------------------
void lcd_delay_us (unsigned int time)
{
  unsigned long i,j,k;  
  for (k=0;k<time;k++)
  {  
  for (j=0;j<3;j++)
      for (i=0;i<MCKLCD;i++);
  for (j=0;j<3;j++)
      for (i=0;i<(MCKLCD/100);i++);
  }
}
//-----------------------------------
void lcd_writecommand (unsigned char data)
{
AT91C_BASE_PIOA->PIO_CODR=(1<<LCDRS);
AT91C_BASE_PIOA->PIO_CODR=(1<<LCDDB0|1<<LCDDB1|1<<LCDDB2|1<<LCDDB3|1<<LCDDB4|1<<LCDDB5|1<<LCDDB6|1<<LCDDB7);
if (0x01&data)
{
AT91C_BASE_PIOA->PIO_SODR=(1<<LCDDB0);  
}
if (0x02&data)
{
AT91C_BASE_PIOA->PIO_SODR=(1<<LCDDB1);  
}
if (0x04&data)
{
AT91C_BASE_PIOA->PIO_SODR=(1<<LCDDB2);  
}
if (0x08&data)
{
AT91C_BASE_PIOA->PIO_SODR=(1<<LCDDB3);  
}
if (0x10&data)
{
AT91C_BASE_PIOA->PIO_SODR=(1<<LCDDB4);  
}
if (0x20&data)
{
AT91C_BASE_PIOA->PIO_SODR=(1<<LCDDB5);  
}
if (0x40&data)
{
AT91C_BASE_PIOA->PIO_SODR=(1<<LCDDB6);  
}
if (0x80&data)
{
AT91C_BASE_PIOA->PIO_SODR=(1<<LCDDB7);  
}
AT91C_BASE_PIOA->PIO_SODR=(1<<LCDE);
lcd_delay_us (10000);
AT91C_BASE_PIOA->PIO_CODR=(1<<LCDE);
}
//-----------------------------------
void lcd_putchar (unsigned char data)
{ 
AT91C_BASE_PIOA->PIO_SODR=(1<<LCDRS);
AT91C_BASE_PIOA->PIO_CODR=(1<<LCDDB0|1<<LCDDB1|1<<LCDDB2|1<<LCDDB3|1<<LCDDB4|1<<LCDDB5|1<<LCDDB6|1<<LCDDB7);
if (0x01&data)
{
AT91C_BASE_PIOA->PIO_SODR=(1<<LCDDB0);  
}
if (0x02&data)
{
AT91C_BASE_PIOA->PIO_SODR=(1<<LCDDB1);  
}
if (0x04&data)
{
AT91C_BASE_PIOA->PIO_SODR=(1<<LCDDB2);  
}
if (0x08&data)
{
AT91C_BASE_PIOA->PIO_SODR=(1<<LCDDB3);  
}
if (0x10&data)
{
AT91C_BASE_PIOA->PIO_SODR=(1<<LCDDB4);  
}
if (0x20&data)
{
AT91C_BASE_PIOA->PIO_SODR=(1<<LCDDB5);  
}
if (0x40&data)
{
AT91C_BASE_PIOA->PIO_SODR=(1<<LCDDB6);  
}
if (0x80&data)
{
AT91C_BASE_PIOA->PIO_SODR=(1<<LCDDB7);  
}
AT91C_BASE_PIOA->PIO_SODR=(1<<LCDE);
lcd_delay_us (10000);
AT91C_BASE_PIOA->PIO_CODR=(1<<LCDE);  
}
//-----------------------------------
void lcd_init (void)
{
AT91C_BASE_PMC->PMC_PCER = ( 1<<AT91C_ID_PIOA );
AT91C_BASE_PIOA->PIO_PER=(1<<LCDRS|1<<LCDE|1<<LCDDB0|1<<LCDDB1|1<<LCDDB2|1<<LCDDB3|1<<LCDDB4|1<<LCDDB5|1<<LCDDB6|1<<LCDDB7);
AT91C_BASE_PIOA->PIO_OER=(1<<LCDRS|1<<LCDE|1<<LCDDB0|1<<LCDDB1|1<<LCDDB2|1<<LCDDB3|1<<LCDDB4|1<<LCDDB5|1<<LCDDB6|1<<LCDDB7);
lcd_writecommand (0x38); 
lcd_writecommand (0x0C);  
lcd_writecommand (0x01); 
lcd_writecommand (0x02);
}
//-----------------------------------
void lcd_clear (void)
{
lcd_writecommand (0x02);  
lcd_writecommand (0x01);   
}
//-----------------------------------
void lcd_gotoxy (unsigned char x,unsigned char y)
{
if ((y<40)&(x<2))
{
 if (x==0)
   lcd_writecommand (0x80 + y);
  else
   lcd_writecommand (0xC0 + y);
}
}
//-----------------------------------
void lcd_putsf (char *str)
{
while (*str !='\0')
  lcd_putchar(*(str++));
}
//-----------------------------------
void lcd_puts(long Num)
{
  char temp[16],i,j,k;
  if (Num<0)
  {
  Num=-Num;  
  lcd_putsf("-");  
  }
  for(i=0;i<16;i++)
    temp[i]=0;
  j=0;
  do
    {
    temp[j++] = '0' + Num % 10;
    Num=Num/10;
    } while (Num > 0);
  for(i=0;i<=((j-1)/2);i++)
  {
    k=temp[i];
    temp[i]=temp[j-i-1];
    temp[j-i-1]=k;
  }
  temp[j]='\0';
  lcd_putsf(temp); 
}
//-----------------------------------