Servo ansteuern Mega32

/************************************************************************************************************/

void EnableServoTestTimer ()

{

  DisableServoTestTimer ();

  // External crystal 16 MHz, Prescaler 8

  // Enable fast PWM mode 14 (table 47 page 113 ATMega16 Doc): 

  TCCR1A    = (1 << COM1A1) | (1 << WGM11);

  // Set prescaler 8

  TCCR1B    = (1 << CS11) | (1 << WGM13) | (1 << WGM12);  

  // Set PWM

  ICR1     = (uint16_t)40000;

  OCR1A    = (uint16_t)ServoPosition;    // min: 1800, neutral: 3000 max: 4200

  sei ();

}