#include "glcd.h"
#define MCKGLCD 48054857
//-----------------------------------
unsigned char GLCDCS2,GLCDCS1,GLCDRST,GLCDRS,GLCDE,GLCDDB0,GLCDDB1,GLCDDB2,GLCDDB3,GLCDDB4,GLCDDB5,GLCDDB6,GLCDDB7;
//-----------------------------------
void glcd_pininit (unsigned char CS2,unsigned char CS1,unsigned char RST,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)
{
GLCDCS2 = CS2;
GLCDCS1 = CS1;
GLCDRST = RST;
GLCDRS = RS;
GLCDE = E;
GLCDDB0 = DB0;
GLCDDB1 = DB1;
GLCDDB2 = DB2;
GLCDDB3 = DB3;
GLCDDB4 = DB4;
GLCDDB5 = DB5;
GLCDDB6 = DB6;
GLCDDB7 = DB7;
}
//---------------------------------------------------------------
void glcd_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<MCKGLCD;i++);
  for (j=0;j<3;j++)
      for (i=0;i<(MCKGLCD/100);i++);
  }
}
//---------------------------------------------------------------
void glcd_latch (void)
{
glcd_delay_us (10);
AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDE);
glcd_delay_us (10);
AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDE);  
}
//---------------------------------------------------------------
void glcd_writedata (unsigned char data)
{
AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDDB0|1<<GLCDDB1|1<<GLCDDB2|1<<GLCDDB3|1<<GLCDDB4|1<<GLCDDB5|1<<GLCDDB6|1<<GLCDDB7);
if (0x01&data)
{
AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDDB0);  
}
if (0x02&data)
{
AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDDB1);  
}
if (0x04&data)
{
AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDDB2);  
}
if (0x08&data)
{
AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDDB3);  
}
if (0x10&data)
{
AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDDB4);  
}
if (0x20&data)
{
AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDDB5);  
}
if (0x40&data)
{
AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDDB6);  
}
if (0x80&data)
{
AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDDB7);  
}
}
//---------------------------------------------------------------
void glcd_write(unsigned char columns,unsigned char page,unsigned char data)
{
if(columns >= 64)
  {
  AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDCS1);
  AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDCS2); 
  }
  else
  {   
  AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDCS1);
  AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDCS2); 
  }         
AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDRS);
glcd_writedata (0xB8 | page);
glcd_latch ();
AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDRS);
glcd_writedata (0x40 | columns);
glcd_latch ();	
AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDRS); 
glcd_writedata (data);
glcd_latch ();		
}
//---------------------------------------------------------------
void glcd_init(void)
{
AT91C_BASE_PMC->PMC_PCER = ( 1<<AT91C_ID_PIOA );
AT91C_BASE_PIOA->PIO_PER=(1<<GLCDCS2|1<<GLCDCS1|1<<GLCDRST|1<<GLCDRS|1<<GLCDE|1<<GLCDDB0|1<<GLCDDB1|1<<GLCDDB2|1<<GLCDDB3|1<<GLCDDB4|1<<GLCDDB5|1<<GLCDDB6|1<<GLCDDB7);
AT91C_BASE_PIOA->PIO_OER=(1<<GLCDCS2|1<<GLCDCS1|1<<GLCDRST|1<<GLCDRS|1<<GLCDE|1<<GLCDDB0|1<<GLCDDB1|1<<GLCDDB2|1<<GLCDDB3|1<<GLCDDB4|1<<GLCDDB5|1<<GLCDDB6|1<<GLCDDB7);
AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDRST);
glcd_delay_us (10000);
AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDRST);
glcd_delay_us (100000);
AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDCS1|1<<GLCDRS);
AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDCS2);
glcd_writedata (0x3E);
glcd_latch ();
glcd_writedata (0x40);
glcd_latch ();
glcd_writedata (0xB8);        
glcd_latch ();
glcd_writedata (0xC0);
glcd_latch ();
glcd_writedata (0x3F);
glcd_latch ();
AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDCS1);
AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDCS2);
glcd_writedata (0x3E);
glcd_latch ();
glcd_writedata (0x40);
glcd_latch ();
glcd_writedata (0xB8);
glcd_latch ();
glcd_writedata (0xC0);
glcd_latch ();
glcd_writedata (0x3F);
glcd_latch ();
AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDCS1);
AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDCS2);    
}
//---------------------------------------------------------------
void glcd_shiftdown (unsigned char selectchip,unsigned char speed)
{
unsigned char i,j,k,l;  
switch (selectchip)
  {
  case 1:
  for (i=64;i>0;i--)
    {
    AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDCS1);
    AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDCS2);      
    AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDRS);    
    glcd_writedata (0xC0|i);
    glcd_latch ();
    for (l=0;l<speed;l++)
      glcd_delay_us (10000);
    }      
  break;
  case 2:
  for (i=64;i>0;i--)
    {
    AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDCS1);
    AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDCS2);      
    AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDRS);    
    glcd_writedata (0xC0|i);
    glcd_latch ();
    for (l=0;l<speed;l++)
      glcd_delay_us (10000);
    }  
  break;
  case 3:
  k=0;
  for (i=64;i>0;i--)
    {
    for (j=0;j<2;j++)
      {
      if (k==0)
        {
        AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDCS1);
        AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDCS2);      
        k=1;
        }
      else
        {
        AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDCS1);
        AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDCS2);         
        k=0;
        }
      AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDRS);    
      glcd_writedata (0xC0|i);
      glcd_latch ();
      }
    for (l=0;l<speed;l++)
      glcd_delay_us (10000);
    }    
  break;
  }
}
//---------------------------------------------------------------
void glcd_shiftup (unsigned char selectchip,unsigned char speed)
{
unsigned char i,j,k,l;  
switch (selectchip)
  {
  case 1:
  for (i=0;i<64;i++)
    {
    AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDCS1);
    AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDCS2);      
    AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDRS);    
    glcd_writedata (0xC0|i);
    glcd_latch ();
    for (l=0;l<speed;l++)
      glcd_delay_us (10000);
    }      
  break;
  case 2:
  for (i=0;i<64;i++)
    {
    AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDCS1);
    AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDCS2);      
    AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDRS);    
    glcd_writedata (0xC0|i);
    glcd_latch ();
    for (l=0;l<speed;l++)
      glcd_delay_us (10000);
    }  
  break;
  case 3:
  k=0;
  for (i=0;i<64;i++)
    {
    for (j=0;j<2;j++)
      {
      if (k==0)
        {
        AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDCS1);
        AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDCS2);      
        k=1;
        }
      else
        {
        AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDCS1);
        AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDCS2);         
        k=0;
        }
      AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDRS);    
      glcd_writedata (0xC0|i);
      glcd_latch ();
      }
    for (l=0;l<speed;l++)
      glcd_delay_us (10000);
    }    
  break;
  }
}
//---------------------------------------------------------------
void glcd_clear (unsigned char selectchip)
{
unsigned int i,x,y;  
switch (selectchip)
  {
  case 1:
  x=0;
  y=0;
  for(i=0;i<512;i++)
    {
    if(x>=64)
      {
      x=0;
      y++;
      } 	 
    glcd_write(x,y,0);
    x++;
    }     
  break;
  case 2:
  x=64;
  y=0;
  for(i=0;i<512;i++)
    {
    if(x>=128)
      {
      x=64;
      y++;
      } 	 
    glcd_write(x,y,0);
    x++;
    }  
  break;
  case 3:
  x=0;
  y=0;
  for(i=0;i<1024;i++)
    {
    if(x>=128)
      {
      x=0;
      y++;
      } 	 
    glcd_write(x,y,0);
    x++;
    }  
  break;
  }  
}
//---------------------------------------------------------------
void glcd_display (unsigned char *data,unsigned char selectchip)
{
unsigned int i,x,y;  
switch (selectchip)
  {
  case 1:
  x=0;
  y=0;
  for(i=0;i<512;i++)
    {
    if(x>=64)
      {
      x=0;
      y++;
      } 	 
    glcd_write(x,y,data[i]);
    x++;
    }     
  break;
  case 2:
  x=64;
  y=0;
  for(i=0;i<512;i++)
    {
    if(x>=128)
      {
      x=64;
      y++;
      } 	 
    glcd_write(x,y,data[i]);
    x++;
    }  
  break;
  case 3:
  x=0;
  y=0;
  for(i=0;i<1024;i++)
    {
    if(x>=128)
      {
      x=0;
      y++;
      } 	 
    glcd_write(x,y,data[i]);
    x++;
    }  
  break;
  }
}
//---------------------------------------------------------------
void glcd_setpix (unsigned char x,unsigned char y,unsigned char *data)
{
if (x<128|y<64)
  {
  data[(y/8)*128+x]=(1<<(y%8))|data[(y/8)*128+x];
  glcd_write(x,(y/8),data[(y/8)*128+x]);
  }
}
//---------------------------------------------------------------
void glcd_clrpix (unsigned char x,unsigned char y,unsigned char *data)
{
if (x<128|y<64)
  {
  data[(y/8)*128+x]=(~(1<<(y%8)))&data[(y/8)*128+x];
  glcd_write(x,(y/8),data[(y/8)*128+x]);
  }   
}
//---------------------------------------------------------------
void glcd_displayon (unsigned char selectchip)
{ 
switch (selectchip)
  {
  case 1:
    AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDCS1);
    AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDCS2);      
    AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDRS);    
    glcd_writedata (0x3F);
    glcd_latch ();
  break;
  case 2:
    AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDCS2);
    AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDCS1);      
    AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDRS);    
    glcd_writedata (0x3F);
    glcd_latch ();
  break;
  case 3:
    AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDCS1|1<<GLCDRS);
    AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDCS2);
    glcd_writedata (0x3F);
    glcd_latch (); 
    AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDCS1);
    AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDCS2);
    glcd_writedata (0x3F);
    glcd_latch ();   
  break;
  }
}
//---------------------------------------------------------------
void glcd_displayoff (unsigned char selectchip)
{
switch (selectchip)
  {
  case 1:
    AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDCS1);
    AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDCS2);      
    AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDRS);    
    glcd_writedata (0x3E);
    glcd_latch ();
  break;
  case 2:
    AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDCS2);
    AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDCS1);      
    AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDRS);    
    glcd_writedata (0x3E);
    glcd_latch ();
  break;
  case 3:
    AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDCS1|1<<GLCDRS);
    AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDCS2);
    glcd_writedata (0x3E);
    glcd_latch (); 
    AT91C_BASE_PIOA->PIO_SODR=(1<<GLCDCS1);
    AT91C_BASE_PIOA->PIO_CODR=(1<<GLCDCS2);
    glcd_writedata (0x3E);
    glcd_latch ();   
  break;
  } 
}
//---------------------------------------------------------------