#include <avr/io.h>
#include <util/delay.h>

void timer_init(void)
{
  DDRB |= (1 << PB1);
  TCCR1A |= (1 << COM1A1) | (1 << WGM11);
  TCCR1B |= (1 << WGM13) | (1 << WGM12) | (1 << CS11);
  ICR1 = 39999;
}

void set_angle(uint16_t position)
{
  OCR1A = position;
}

int main(void)
{
  timer_init();
  while(1)
  {
    set_angle(1000);
    _delay_ms(1000);
    set_angle(1500);
    _delay_ms(1000);
    set_angle(2000);
    _delay_ms(1000);
  }
  return 0;
}