#include "avr/io.h"
#include "util/delay.h"
#include "avr/interrupt.h"
#include "stdio.h"
#include "lcd.h"
#include "rot.h"

#define nop() asm volatile("nop")

unsigned char rot_pos=0;


int main()
{
	lcd_init();
	rot_init();

	TCCR0 = (1<<WGM01)|(2<<CS00);
	OCR0 = 64;				//16000/8/64 = 31,25 kHz
	TIMSK = (1<<OCIE0);

	sei();
	

	while(1)				//Endlos
	{
		signed char tmp = rot_getdelta();	//Deltawert holen
		rot_pos += tmp>>1;			//Neue Position berechnen
		char str[5];

		if(tmp != 0)				//Wenn sich was verändert hatte
		{
			

			snprintf(str,5,"%u",rot_pos);	//Neue Position ausgeben

			lcd_loc(0);
			lcd_puts("    ");
			lcd_loc(0);
			lcd_puts(str);
		}	
		
	}	
}




SIGNAL(TIMER0_COMP_vect)			//31,25 kHz @ FCLK = 16MHz
{

	lcd_IRQ();
	rot_IRQ();
}