text: 
  #ifndef _servo_H_
  #define _servo_H_
  
  servo_init()
  {
  	
  	TCCR1A|=(1<<COM1A1)|(1<<COM1B1)|(1<<WGM11);        //NON Inverted PWM
    	TCCR1B|=(1<<WGM13)|(1<<WGM12)|(1<<CS11)|(1<<CS10); //PRESCALER=64 MODE 14(FAST PWM) extremeele
  
  	ICR1=4999;  //fPWM=50Hz (Period = 20ms Standard).
  
    	DDRD|=(1<<PD4)|(1<<PD5);   //PWM Pins as Out
  }
  float set_degree(int d)
  {
  	OCR1A =160+((22*d)/9);
  }
  
  #endif
  