//digimot22
//glcd.c
#include "main.h"
//**********************************************************************
void init_glcd(void)
{
	GLCD_DATAPORTDDR = 0xff;
	GLCD_RESETPORTDDR |= (1<<GLCD_RESETPIN);
	GLCD_REGSELPORTDDR |= (1<<GLCD_REGSELPIN);
	GLCD_ENABLEPORTDDR1 |= (1<<GLCD_ENABLEPIN1);
	GLCD_ENABLEPORTDDR2 |= (1<<GLCD_ENABLEPIN2);
	GLCD_DATAPORT = 0x00;
	
	GLCD_RESETPORT |= (1<<GLCD_RESETPIN);//RST High
	GLCD_RESETPORT &= ~(1<<GLCD_RESETPIN);//RST Low
	_delay_ms(1);
	GLCD_RESETPORT |= (1<<GLCD_RESETPIN);//RST High
	
	write_glcd(1,0b10101111,0);//display 1 ON
	write_glcd(1,0b10111011,0);//set page adress
	_delay_ms(1);
	write_glcd(1,0b10111010,0);//set page adress
	
	
	//write_glcd(2,0b10101111,0);//display 2 ON
	//write_glcd(1,0b10101001,0);//duty
	//write_glcd(1,0b10100001,0);//ADC Status
	//write_glcd(1,0b11000000 | 7,0);//set start line
	//write_glcd(1,0b00000000,0);//set column
	//write_glcd(1,0b11100010,0);//reset
	
}
//**********************************************************************
void enable_glcd(uint8_t sel)//EnablePin sel Up/Down
{
	if(sel==1)
	{
		GLCD_ENABLEPORT1 |= (1<<GLCD_ENABLEPIN1);
		asm volatile ("nop");
		asm volatile ("nop");
		GLCD_ENABLEPORT1 &= ~(1<<GLCD_ENABLEPIN1);
	}
	else if(sel==2)
	{
		GLCD_ENABLEPORT2 |= (1<<GLCD_ENABLEPIN2);
		asm volatile ("nop");
		asm volatile ("nop");
		GLCD_ENABLEPORT2 &= ~(1<<GLCD_ENABLEPIN2);
	}
}
//**********************************************************************
void write_glcd(uint8_t lcd, uint8_t data,uint8_t RS)
{
//command or data?
	if(RS == 0)//Controlregister
	{
		GLCD_REGSELPORT &= ~(1<<GLCD_REGSELPIN); 			
	}
	else//Dataregister
	{
		GLCD_REGSELPORT |= (1<<GLCD_REGSELPIN); 			
	}
	
GLCD_DATAPORT = data;
enable_glcd(lcd);
//_delay_ms(1);
}