#define F_CPU 8000000UL
#include<avr/io.h>
#include <util/delay.h>
#include "servo.h"
 
 int main()
{
	servo::init();
	//Configure TIMER1
	// TCCR1A|=(1<<COM1A1)|(1<<COM1B1)|(1<<WGM11); //NON Inverted PWM
	// TCCR1B|=(1<<WGM13)|(1<<WGM12)|(1<<CS11)|(0<<CS10); //PRESCALER=1 MODE 14(FAST PWM)
		
	// ICR1=19999; //fPWM=50Hz (Period = 20ms Standard).
	
	// DDRD|=(1<<PD4)|(1<<PD5); //PWM Pins as Out
    
	while(1)
	{
		// for(int i = 1000; i < 2000; i++) {
		// 	OCR1A = i;
		// 	_delay_ms(1);
		// }

		// for(int i = 2000; i > 999; i--) {
		// 	OCR1A = i;
		// 	_delay_ms(1);
		// }

		servo::pos(1000);
		_delay_ms(1000);
		servo::pos(2000);
		_delay_ms(1000);
		// 	OCR1A=0; //0 degree
		// 	_delay_ms(1000);
	
		// OCR1A=600; //45 degree 
		// _delay_ms(1000);
		
		// OCR1A=950; //90 degree 
		// _delay_ms(1000);
		
		// OCR1A=1425; //135 degree 
		// _delay_ms(1000);
		
		// OCR1A=1900; //180 degree 
		// _delay_ms(1000);
			
		// 	OCR1A=1425; //135 degree
		// 		_delay_ms(1000);
		
		// OCR1A=950; //90 degree
		// _delay_ms(1000);
		
		// OCR1A=650; //45 degree
		// _delay_ms(1000);
	
	}
	return 0;
}