Servo Beispiel

 

byte servo_var[SERVO_BUF(10)]; // Servo interne Variablen

 

// Ansteuerung von 3 Servos und beenden nach 10 Sek.

void main(void)

{

    // Max. 10 Servos, 20ms Intervall, Timer 3

    Servo_Init(101, servo_var, 1); 

 

    Servo_Set(72000);  // Servo Portbit 7   2000µs

    Servo_Set(61800);  // Servo Portbit 6   1800µs

    Servo_Set(51600);  // Servo Portbit 5   1600µs

 

    AbsDelay(5000);

 

    Servo_Set(71000);  // Servo Portbit 7   1000µs

 

    AbsDelay(5000);

 

    Servo_Set(70);     // alle Servos aus

    Servo_Set(60);

    Servo_Set(50);

}