#include <avr/io.h>
#include <avr/interrupt.h>
#define F_CPU 16000000
#include <util/delay.h>
#include "lcd.h"

volatile uint16_t firstStamp;
volatile uint16_t period;

ISR(TIMER1_CAPT_vect){
	if(firstStamp){
		period = ICR1 - firstStamp;
	}else{
		firstStamp = ICR1;
	}
}

int main(void){
	
	DDRB |= (1<<PB2);
	
	TCCR1B |= (1<<ICNC1)|(1<<ICES1)|(1<<CS11);
	TIMSK |= (1<<TICIE1);
	
	lcd_init();
	
	sei();
	
	PORTB |= (1<<PB2);
	_delay_us(50);
	PORTB &= ~(1<<PB2);
	_delay_us(50);
	PORTB |= (1<<PB2);
	
	lcd_printString(lcd_convertIntToDecString(period,1));
	lcd_printChar(";");
	lcd_printString(lcd_convertIntToDecString(firstStamp,1));
	lcd_printChar(";");
	lcd_printString(lcd_convertIntToDecString(ICR1,1));
	lcd_setCursor(0,1);
	lcd_printString(lcd_convertIntToDecString(ICR1-firstStamp,1));
	
    while(1){
    }
	
}