/** C O N F I G U R A T I O N   B I T S ******************************/
#pragma config FOSC = INTIO67

/** I N C L U D E S **************************************************/
#include "p18f45k20.h"

#pragma code
char *iter, *addr, *ems, *donoff, *cdshift, *fset;
char L1, L2, L3, L4, I1S1,I1S0, I0S1, I0S0;
char DL1N1F0, DL1N1F1, DL1N0F0, DL1N0F1, DL0N0F0, DL0N1F0, DL0N1F1, DL0N0F1;
char D1C1B1, D1C1B0, D1C0B1, D1C0B0, D0C0B1,   D0C0B0,   D0C1B1,   D0C1B0;
char SC1RL1, SC1RL0, SC0RL1, SC0RL0;
void KS0066U_PortSetup();
void KS0066U_Enable();
void KS0066U_Disable();
void KS0066U_Write();
void KS0066U_Read();
void KS0066U_Clear();
void KS0066U_Return();
void KS0066U_EntryModeSet();
void KS0066U_FunctionSet();
void KS0066U_DispOnOffCtrl();
void KS0066U_CursDispShift();
void KS0066U_SetAddr();
void KS0066U_ReadBusyFlag();
void KS0066U_Default();
void KS0066U_PrintString();
void KS0066U_Init();

void main()
{
   KS0066U_Init(&DL1N1F0, &D1C1B1);
   KS0066U_PrintString("Test String",&L2,&I0S0);
}
/*Subroutines*********************************************************/
//Connections between PIC18F45K20 and the KS0066U controller onto the AMPIRE LCD
//KS0066U    |Rs R/W E DB7 DB6 DB5 DB4 DB3 DB2 DB1 DB0
//PIC        |C4 C5 C6 D7  D6  D5  D4  D3  D2  D1  D0

void KS0066U_Enable()                           
{
   LATCbits.LATC6 = 1;
   LATCbits.LATC6 = 0;
}
void KS0066U_Write()                                 
{
   LATCbits.LATC5 = 0;
   LATCbits.LATC4 = 1;
}
void KS0066U_Read()                           
{   
   LATCbits.LATC4 = 0;
      LATCbits.LATC5 = 1;
}
void KS0066U_ReadBusyFlag()
{
   KS0066U_Read();
   TRISD = 0xff;         // Set PortD to input
   while(LATDbits.LATD7); //wait for bit D7 to become 0
   LATCbits.LATC5 = 0;
   TRISD = 0x00;         // Set PortD to output
}
void KS0066U_PortSetup()
{
         TRISD = 0x00; //Set PortD to OUTPUT
       TRISCbits.TRISC6 = 0; //Set PortC bit6 to OUTPUT
      TRISCbits.TRISC5 = 0; //Set PortC bit5 to OUTPUT
      TRISCbits.TRISC4 = 0; //Set PortC bit4 to OUTPUT
      LATD = 0x00;        //Set PortD to LOW
      LATC = 0x00;        //Set PortC to LOW
}

void KS0066U_Clear()                                 
{   
   LATC = 0x00;
   LATD = 0x01;
      KS0066U_Enable();
   KS0066U_ReadBusyFlag();
}

void KS0066U_EntryModeSet(char *ems)                                 
{
   I1S1 = 0x07;
   I1S0 = 0x06;
   I0S1 = 0x05;
   I0S0 = 0x04;

   LATD = *ems;
    KS0066U_Enable();
   KS0066U_ReadBusyFlag();
}

void KS0066U_FunctionSet(char *fset)                             
{
   DL1N1F0 = 0x38;
   DL1N1F1 = 0x3c;
   DL1N0F0 = 0x30;
   DL1N0F1 = 0x34;
   DL0N0F0 = 0x20;
   DL0N1F0 = 0x28;
   DL0N1F1 = 0x2C;
   DL0N0F1 = 0x24;

   LATD =  *fset;
     KS0066U_Enable();
   KS0066U_ReadBusyFlag();
}

void KS0066U_DispOnOffCtrl(char *donoff)                          // DispOnOffCtrl
{
   D1C1B1 = 0x0f;
   D1C1B0 = 0x0e;
   D1C0B1 = 0x0d;
   D1C0B0 = 0x0c;
   D0C0B1 = 0x09;
   D0C0B0 = 0x08;
   D0C1B1 = 0x0b;
   D0C1B0 = 0x0a;

   LATD = *donoff;
   KS0066U_Enable();
   KS0066U_ReadBusyFlag();
}

void KS0066U_CursDispShift(char *cdshift)
{
SC1RL1 = 0x1c;
SC1RL0 = 0x18;
SC0RL1 = 0x14;
SC0RL0 = 0x10;

   LATD = *cdshift;
   KS0066U_Enable();
   KS0066U_ReadBusyFlag();
}

void KS0066U_SetAddr(char *addr)                              // SetDispDataRamAddr
{
   L1 = 0x00;
   L2 = 0x40;
   L3 = 0x10;
   L4 = 0x50;
   LATCbits.LATC4 = 0;
   LATCbits.LATC5 = 0;
   LATD = *addr;
   KS0066U_Enable();
   KS0066U_ReadBusyFlag();
}

void KS0066U_Init(char *fset, char *donoff)
{
   KS0066U_PortSetup();
   KS0066U_FunctionSet(fset);
   KS0066U_DispOnOffCtrl(donoff);
   KS0066U_Clear();
   KS0066U_Clear();//For some reason it is necessary to repeat the clear command
}

void KS0066U_PrintString(char *iterator,char *addr,char *ems)
{
    KS0066U_EntryModeSet(&ems);
   KS0066U_SetAddr(&addr);
    while (*iterator){
       KS0066U_Write();
      LATD = *iterator;
      KS0066U_Enable();
      KS0066U_ReadBusyFlag();
       iterator++;
   }
}