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

#define output(directions,pin) (directions |= pin) // set port direction for output
#define set(port,pin) (port |= pin) // set port pin
#define clear(port,pin) (port &= (~pin)) // clear port pin
#define pin_test(pins,pin) (pins & pin) // test for port pin
#define bit_test(byte,bit) (byte & (1 << bit)) // test for bit set

//led config
#define led_portB PORTB
#define led_portA PORTA
#define led_directionB DDRB
#define led_directionA DDRA
#define red (1 << PB2)
#define green (1 << PA6)
#define blue (1 << PA7)

//servo config

#define PWM_port PORTA
#define PWM_direction DDRA
#define PWM_pin_0 (1 << PA5)
#define loop_count 60

int main(void) {
  uint8_t i;
  unsigned char count, pwm;
  // set clock divider to /1
  CLKPR = (1 << CLKPCE);
  CLKPR = (0 << CLKPS3) | (0 << CLKPS2) | (0 << CLKPS1) | (0 << CLKPS0);

  // set PWM pins to output
  //
  clear(PWM_port, PWM_pin_0);
  output(PWM_direction, PWM_pin_0);

  // initialize LED pins
  set(led_portB, red);
  output(led_directionB, red);
  set(led_portA, green);
  output(led_directionA, green);
  set(led_portA, blue);
  output(led_directionA, blue);

  //LED RED ON/OFF
   clear(led_portB,red);
   _delay_ms(5000);
   set(led_portB,red);
   _delay_ms(500);
  
  while (1) {
  

//   _delay_ms(500);

//
   //LED GREEN ON/OFF 
   clear(led_portA,green);
   _delay_ms(1000);
   set(led_portA,green);
   

   
   //LED BLUE ON/OFF
   clear(led_portA,blue);

   for (i = 0; i < loop_count; ++i) {
         set(PWM_port,PWM_pin_0);
         _delay_us(2000);
         clear(PWM_port,PWM_pin_0);
         _delay_us(19000);
         }
      
      for (i = 0; i < loop_count; ++i) {
         set(PWM_port,PWM_pin_0);
         _delay_us(20);
         clear(PWM_port,PWM_pin_0);
         _delay_us(18500);
         }
   set(led_portA,blue);
   //_delay_ms(500);      
   }

  
}