hi, schön das du wieder schreibst.
Bin aber nicht wewiter gekommen habe den code zwar etwas abgeändert aber immer noch der gleiche effekt.
Könntest du ihn vielleicht mal auf deinem RP6 ausprobieren ?
Code:
#include"RP6RobotBaseLib.h"
void servo_scl (uint8_t imp)
{
DDRC |= SCL;
PORTC |= SCL;
sleep(imp);
PORTC &= ~SCL;
sleep(200-imp);
}
void servo1(void)
{
uint8_t i=0, x;
i=0;
x=10;
while(i<10) //200ms
{
servo_scl(x);
i=i+1;
}
x=x+1;
move(70, BWD, DIST_MM(150), BLOCKING);
if (x<=15)
{
x=15;
}
i=0;
}
void servo2(void)
{
uint8_t i=0, x;
i=0;
x=10;
while(i<10) //200ms
{
servo_scl(x);
i=i+1;
}
x=x+1;
move(70, FWD, DIST_MM(150), BLOCKING);
if (x<=15)
{
x=15;
}
i=0;
}
int main(void)
{
initRobotBase();
powerON();
while(true)
{
servo1();
servo2();
}
while(true)
{
writeString_P("\n Endlosschleife");
}
return 0;
}
Lesezeichen