//Includes
#include <avr/io.h>
#include <stdio.h>

//Funktionsprototypen
void init();
void lcdDelay(char dauer);
void lcdSelectSide(char side);
void lcdInstructionWrite(char instruction);
void lcdClearScreen();
void lcdDataWrite(unsigned char data);
void lcdWaitBusy();
void lcdSetDot(unsigned char coordX, unsigned char coordY);
unsigned char dataRead();
void GLCD_Rectangle (char x1,char y1,char x2,char y2);

//Variablen
unsigned char dauer;
char side;
unsigned char instruction;

unsigned char data;
unsigned char coordX;
unsigned char coordY;
int anz = 0;
char x1, x2, y1, y2;
unsigned char lcdStatus;

//Defines
#define instDataH 		PORTC |= (1<<PORTC1)
#define instDataL		PORTC ^= (1<<PORTC1)

#define readWriteH		PORTC |= (1<<PORTC2)
#define readWriteL		PORTC ^= (1<<PORTC2)

#define chip1H			PORTB |= (1<<PORTB0)
#define chip1L			PORTB ^= (1<<PORTB0)

#define chip2H			PORTB |= (1<<PORTB1)
#define chip2L			PORTB ^= (1<<PORTB1)

#define resetH			PORTB |= (1<<PORTB2)
#define resetL			PORTB ^= (1<<PORTB2)

#define triggerH		PORTB |= (1<<PORTB5)
#define triggerL		PORTB ^= (1<<PORTB5)

#define X	0xB8
#define Y	0x40
#define Z	0xC0

#define display_ON		0x3F
#define display_OFF		0x3E	

//Main
void main()
{	
	DDRB = 0xff;
	DDRC = 0xff;
	DDRD = 0xff;
	
	init();

	while(1)
	{	
		lcdSetDot(0,0);
		lcdSetDot(0,1);
	
		while(1);
	}
}

//Funktionen
void init()
{
	PORTD = 0x00;
	PORTC = 0x00;
	PORTB = 0x00;

	resetH;
	lcdDelay(10);
	resetL;
	lcdDelay(10);
	resetH;
	

	lcdSelectSide(0);
	lcdInstructionWrite(display_OFF);
	lcdInstructionWrite(Z);
	lcdInstructionWrite(X);
	lcdInstructionWrite(Y);
	lcdInstructionWrite(display_ON);

	lcdSelectSide(1);
	lcdInstructionWrite(display_OFF);
	lcdInstructionWrite(Z);
	lcdInstructionWrite(X);
	lcdInstructionWrite(Y);
	lcdInstructionWrite(display_ON);

	lcdClearScreen();

}

void lcdDelay(char dauer)
{
	for(int i = 0; i<dauer; i++);
}

void lcdSelectSide(char side)
{
	if(side==1)
	{
		
		PORTB = 0b00000110;
		PORTC = 0b00000100;
	
		

		lcdInstructionWrite(Y);
	}
	if(side==0)
	{
		
		PORTC = 0b00000100;
		PORTB = 0b00000101;
		

		lcdInstructionWrite(Y);
	}
	
}

void lcdInstructionWrite(char instruction)
{
	PORTC = 0x00;

	PORTD = instruction;
	triggerH;
	lcdDelay(1);
	triggerL;
	
}

void lcdClearScreen()
{
	char page = 0;
	char column = 0;

	for(page = 0; page<8; page++)
	{
		lcdSelectSide(0);
		lcdInstructionWrite(X | page);
		lcdInstructionWrite(Y);

		for(column = 0; column<128; column++)
		{
			if(column == 64)
			{
				lcdSelectSide(1);
				lcdInstructionWrite(X | page);
				lcdInstructionWrite(Y);
			}
			lcdDataWrite(0x00);
		}

	}
}

void lcdWaitBusy()
{
	PORTD = 0xff;

	unsigned char read;

	read = PORTD;


	PORTC = 0b00000000;
	

	triggerH;
	lcdDelay(1);
	triggerL;

	while(read & 0x7f == 0x80);
}

void lcdDataWrite(unsigned char data)
{
	lcdWaitBusy();

	PORTC = 0b00000010;
	PORTD = data;

	triggerH;
	lcdDelay(1);
	triggerL;
}

void lcdSetDot(unsigned char coordX, unsigned char coordY)
{
	
	unsigned char data = 0;

	
	lcdInstructionWrite(Z);
	
	if(coordX<64)
	{
		lcdSelectSide(0);
		
		lcdInstructionWrite(X + (coordY / 8));
		lcdInstructionWrite(Y + coordX);
		
		data = dataRead();
		data = dataRead();

		lcdInstructionWrite(X + (coordY / 8));
		lcdInstructionWrite(Y + coordX);
		lcdDataWrite(data | (1<<(coordY%8)));
	

	}
	else
	{
		lcdSelectSide(1);
		lcdInstructionWrite(X + (coordY / 8));
		lcdInstructionWrite(Y + coordX - 64);

		data = dataRead();
		data = dataRead();

		lcdInstructionWrite(X + (coordY / 8));
		lcdInstructionWrite(Y + coordX - 64);

		lcdDataWrite(data | (1<<(coordY %8)));
	}

	lcdInstructionWrite(Z);
	

}

unsigned char dataRead()
{

	PORTC = 0b00000110;

	triggerH;
	lcdDelay(1);
	lcdStatus = PORTD;
	triggerL;
	lcdDelay(1);
	
	return lcdStatus;
}