#include <Servo.h>
Servo servo;




void setup() {
  DDRC |= 1<<0;
  DDRC |= 1<<1;
  DDRC |= 1<<2;
  PORTC |= 1<<0;
  PORTC |= 1<<1;
  PORTC |= 1<<2;

  servo.attach(9);
  DDRB &= ~(1<<2); 
  DDRB &= ~(1<<3); 
  Serial.begin(9600);
  PORTB |= 1<<2; 
  PORTB |= 1<<3;
  



}

void loop() {
  
  if((PINB&(1<<2)) == 0){
    servo.write(0);
    PORTC &= ~(1<<0);
    PORTC &= ~(1<<1);
    PORTC &= ~(1<<2);
    delay(200);
    PORTC &= ~(1<<1);
    PORTC &= ~(1<<2);
    PORTC &= ~(1<<0);
     delay(200);

    
  }
  if((PINB&(1<<2)) != 0){
   servo.write(90);
   
    PORTC &= ~(1<<0);
    PORTC |= 1<<1;
    PORTC |= 1<<2;
    delay(200);
    PORTC |= 1<<2;
    PORTC |= 1<<1;
    PORTC |= 1<<0;
     delay(200);
  }

  if((PINB&(1<<3)) != 0){
    servo.write(0);
    PORTC &= ~(1<<0);
    PORTC &= ~(1<<1);
    PORTC &= ~(1<<2);
    delay(200);
    PORTC |= 1<<2;
    PORTC |= 1<<1;
    PORTC |= 1<<0;
     delay(200);
    
  }
  if((PINB&(1<<3)) == 0){
   servo.write(90);
    PORTC &= ~(1<<0);
    PORTC |= 1<<1;
    PORTC |= 1<<2;
    delay(200);
    PORTC &= ~(1<<1);
    PORTC &= ~(1<<2);
    PORTC &= ~(1<<0);
     delay(200);
  }
  




}