#include <inttypes.h>
#include <avr/io.h>
#include <avr/interrupt.h>
#include <util/delay.h>
#include <stdlib.h>

#include "main.h"


//25kHz
ISR (TIMER0_OVF_vect)
{

}

static void init_sampletimer(void)
{
	// Timer 0
	//
	//set timer0 to CTC & prescaler 64 == 125k
	TCCR0A = (1<<WGM01);
	TCCR0B = (1<<CS00)|(1<<CS01);
	//count up to 5 :
	OCR0A = 5;

	//enable interrupt
	TIMSK0 |= (1<<TOIE0);	
}


static inline void init_pwm(void)
{
	//PB1 set to output:
	DDRB |= (1<<PORTB2);
	OCR1B = 0xefff; //preselect some default
	ICR1  = 0xffff; // TOP-wert

	TCCR1A = (1<<COM1B1) | (1<<WGM11); // only b-chan , fastpwm (mode 14)
	TCCR1B = (1<<WGM13)|(1<<WGM12) | (1<<CS10); //Fastpwm, no prescale

	return ;
}

static void init_leds(void)
{
	//enable LED channels as output
	DDRC |= (1 << PORTC0) | (1 << PORTC2) | (1 << PORTC3) | (1 << PORTC1);
	PORTC = 1;		//one led is on...
	return;
}

inline void setleds(uint8_t state)
{
	//set leds according to
	PORTC |= (state | 0b00001111);
	PORTC &= ~(state | 0b11110000);
	return;
}

static void init_motor(void)
{
	//vibration motor on B1:
	DDRB |= (1 << PORTB1);

}

static void stupid_pwmtest(void)
{
	uint8_t i,t,r;
		ICR1 = 0xAA00;
		r=1;
	for (;;) {

		t = (r)?(t+1):(t-1);

		ICR1 = (t << 7);
		if(t=0) r ^= 1;
		for(i=1;i<100;i++) __asm("nop");


	
		
	}
	return; //never
}

int main(void)
{

	//hardware initialisation: 
	init_leds();
	init_motor();
	init_pwm();

	//just stupid test for now....
	stupid_pwmtest();

	//never get here
	return;
}