Nicht getestet:
Code:
#include "RP6RobotBaseLib.h"
uint8_t i,j;
int main(void)
{
initRobotBase();
DDRA |= 1;
while(true)
{
for(i=5;i<25; i++) // Schritte von 5 bis 25
{
for(j=0;j<10; j++) // Position 10 mal senden
{
PORTA |= 1; // Servo-PWM ein
sleep(i); // auf Winkel warten
PORTA &= ~1; // Servo-PWM aus
sleep(200-i); // auf 20ms warten
}
}
for(i=25;i>5; i--) // und zurück von 25 nach 5
{
for(j=0;j<10; j++)
{
PORTA |= 1;
sleep(i);
PORTA &= ~1;
sleep(200-i);
}
}
}
return(0); // wird nie erreicht
}
Gruß
mic
Lesezeichen