#include "include.c"



double rtemp = 1337;

/* 
* LCD READ STATUS DISPLAY
* Kontrollerar så att skärmen är redo för nästa kommando
*/

unsigned char Read_Status_Display(void){
     unsigned char temp = 0; 
    *AT91C_PIOC_ODR = 0x3FC; //Databus som input
  
    *AT91C_PIOC_SODR = 1<<13; //dir som input (74chip, 1= input)
    *AT91C_PIOC_CODR = 1<<12; //Clear output (74chip, 0 = enable)
    *AT91C_PIOC_SODR = 1<<17; //Set C/D                 
    *AT91C_PIOC_CODR = 1<<16; //Clear chip select
    *AT91C_PIOC_CODR = 1<<15; //Clear read display

    delay(10);                //Delay 150ns
    
    temp = ((*AT91C_PIOC_PDSR)>>2)&0x3; //Shiftar så vi får STA0 och STA1 till LSB
  
    *AT91C_PIOC_SODR = 1<<16;   //set chip select
    *AT91C_PIOC_SODR = 1<<15;   //set read display
    *AT91C_PIOC_SODR = 1<<12;   //disable output (74chip)
    *AT91C_PIOC_CODR = 1<<13;   //dir som output (74chip)
  
    return temp;                //Retunerar värdet
}

/* 
* LCD WRITE COMMAND TO DISPLAY
* Ger vilket kommando som displayen skall utföra
* Exempel på kommandon som är användbara:
* 0x24 - Sätter pekaren
* 0xC0 - Skriver tecken
*/

void Write_Command_2_Display(unsigned char Command){
  while(Read_Status_Display() != 0x3){ }
  
  *AT91C_PIOC_CODR = 0x3FC;           //Clearar databussen
  *AT91C_PIOC_SODR = (Command<<2);    //Sätter command till databusen (shiftar till databussen)                    

  *AT91C_PIOC_CODR = 1<<13;           //dir som output (74chip)
  *AT91C_PIOC_CODR = 1<<12;           //enable output (74chip)           
  *AT91C_PIOC_OER  = 0x3FC;           //Output enable på databussen              

  *AT91C_PIOC_SODR = 1<<17;           //C/D signal high (1 = command)              
  *AT91C_PIOC_CODR = 1<<16;           //Clear chip select display
  *AT91C_PIOC_CODR = 1<<14;           //clear write display         
  
  delay(10);                          //Delay
  
  *AT91C_PIOC_SODR = 1<<16;           //Set chip enable display
  *AT91C_PIOC_SODR = 1<<14;           //Set write display           
  *AT91C_PIOC_SODR = 1<<12;           //disable output (74chip)
  *AT91C_PIOC_ODR = 0x3FC;            //Databus som input
}

/* 
* LCD DATA TO DISPLAY
* Ger data till displayen som senare används i kommando
*/

void Write_Data_2_Display(unsigned char Data){
  while(Read_Status_Display() != 0x3){    }
  
  *AT91C_PIOC_CODR = 0x3FC;           //Clerar databussen
  *AT91C_PIOC_SODR = (Data<<2);       //Sätter data till bussen och shiftar till rätt plats.

  *AT91C_PIOC_CODR = 1<<13;           //dir som output (74chip)              
  *AT91C_PIOC_CODR = 1<<12;           //enable output (74chip)            
  *AT91C_PIOC_OER   = 0x3FC;          //databus som output          

  *AT91C_PIOC_CODR = 1<<17;           //clear C/D (0 = data)              
  *AT91C_PIOC_CODR = 1<<16;           //clear chip select display                  
  *AT91C_PIOC_CODR = 1<<14;           //clear write display         
  
  delay(10);                          //delay
  
  *AT91C_PIOC_SODR = 1<<16;           //set chip enable display              
  *AT91C_PIOC_SODR = 1<<14;           //set write display                 
  *AT91C_PIOC_SODR = 1<<12;           //disable output (74chip)             

  *AT91C_PIOC_ODR = 0x3FC;            //databus som input            
}


/* 
* LCD DISPLAY INITERING
* Aktiverar servon på Channel ID 1
*/

void init_Display(void){  
  *AT91C_PIOC_OER = 0xFF3FC;                          //Sätter alla som output
  *AT91C_PIOD_OER = 0x1;                              //Sätter reset som output
  *AT91C_PIOD_CODR = 0x1;                             //Clerar reseten
  
  delay(100000);
  
  *AT91C_PIOD_SODR = 0x1;                             //Sätter reseten
  
  Write_Data_2_Display(0x00);
  Write_Data_2_Display(0x00);
  Write_Command_2_Display(0x40);                      //Set text home address
  Write_Data_2_Display(0x00);
  Write_Data_2_Display(0x40);
  Write_Command_2_Display(0x42);                      //Set graphic home address
  Write_Data_2_Display(0x1e);
  Write_Data_2_Display(0x00);
  Write_Command_2_Display(0x41);                      // Set text area
  Write_Data_2_Display(0x1e);
  Write_Data_2_Display(0x00);
  Write_Command_2_Display(0x43);                      // Set graphic area
  Write_Command_2_Display(0x80);                      // text mode
  Write_Command_2_Display(0x94);                      // Text on graphic off
}

/* 
* LCD CLEAR DISPLAY
* Sätter tomma rutor på varje pixel på LCDn.
* clear_display();
*/

void clear_display(void){             //sätter tomma ruttor på hela displayen.
    for(int i = 0; i<480; i++){
        Write_Data_2_Display(0x00);
        Write_Command_2_Display(0xC0);
    }
}

/* 
* LCD WRITE CHARACTER
* För att skriva ut tecken på senast plats där pekaren är.
* Exempel:
*       writeChar("Hejsan");
*       retunerar: Hejsan på LCDn
*/

void writeChar(char str[]){
  char tempChar;
  for(int i = 0; str[i];i++){
    tempChar = str[i]-0x20;
    Write_Data_2_Display(tempChar);
    Write_Command_2_Display(0xC0);
  }
}

/* 
* LCD WRITE CHARACTER WITH COORDINATES
* Skriver ut tecken på önskad plats.
* Exempel:
*       writeCord("Hejsan", x-koordinat, y-koordniat);
*       retunerar: Hejsan på LCDn på platsen (x,y)
*/

void writeCord(char *text, char x , char y){
  Write_Data_2_Display(x);
  Write_Data_2_Display(y);
  Write_Command_2_Display(0x24);//Set text coordinates

  writeChar(text);               //Prints text
}


/* 
* LCD MENY
* Skriver ut menyn för stationen.
*/

void print_meny(){
        writeCord("MENY",90,0);
        writeCord("-------", 120, 0);
        writeCord("1.Temp  |", 150,0);
        writeCord("2.Sun   ", 180,0);
        writeCord("3.Start |", 210,0);
        writeCord("4.Stop  ", 240, 0);
        writeCord("5.About |", 14, 1);
        writeCord("-------", 44, 1);
        writeCord("[0]",74,1);
}

/* 
* LCD TEMPERATURE
* Skriver ut temperaturen.
*/

void print_temp(void){
  while (temp_ready == 0) { }
	char array[10];
	sprintf(array, "%.2f", rtemp);
        print_clear();
        writeCord("The tempature is",190,0);
        writeCord(array,220,0);
        writeCord("celsius.",226,0);
        temp_ready = 0;
}

/* 
* LCD START
* Skriver ut start meddelandet.
*/

void print_start(void){
	char array[10];
        writeCord("Welcome to this",190,0);
        writeCord("cool weatherstation",220,0);
}

/* 
* LCD SERVO
* Skriver ut graderna på servon.
*/

void print_servo(void){
    char angle[10]; 
    sprintf(angle, "%d grader : %d  ", (servo_getPos()/44), (servo_getPos()));
    writeCord(angle, 190, 0);
    writeCord("                    ", 220,0);
}


/* 
* LCD CLEAR MAIN WINDOW
* Tar bort all text i huvud fönstret.
*/

void print_clear(void){
    writeCord("                    ", 190,0);
    writeCord("                    ", 220,0);
}