Hi,
ich bin Roboteranfänger und habe zu Weihnachten einen RP6 bekommen.
Die Anleitung ist super aber ich habe ein kleines Problem und ich find den Fehler nicht.
Der Roboter soll auf die 2 Tastsensoren reagieren. Beim rechten soll er nach rechts hinten wegfahren und beim linken umgekehrt. Wenn beide gedrückt werden soll er sich einfach mal auf der stelle drehen.
Mein Problem ist das er nach einem tastendruck immer weiter nach hinten fährt und nicht wie gewünscht nach 0,5 sec wieder nach vorne....
Hier der Code:
Code:
#include "RP6RobotBaseLib.h"
void bumper(void)
{
if(getBumperLeft() && getBumperRight())
drehen();
else if(getBumperLeft())
rueckwaerts_links();
else if(getBumperRight())
rueckwaerts_rechts();
}
void vorwaerts(void)
{
changeDirection(FWD);
moveAtSpeed(70,70);
}
void drehen(void)
{
changeDirection(LEFT);
startStopwatch1();
if(getStopwatch1() > 500)
{
vorwaerts();
stopStopwatch1();
setStopwatch1(0);
}
}
void rueckwaerts_links(void)
{
changeDirection(BWD);
moveAtSpeed(40,120);
startStopwatch2();
if(getStopwatch2() > 500)
{
vorwaerts();
stopStopwatch2();
setStopwatch2(0);
}
}
void rueckwaerts_rechts(void)
{
changeDirection(BWD);
moveAtSpeed(120,40);
startStopwatch3();
if(getStopwatch3() > 500)
{
vorwaerts();
stopStopwatch3();
setStopwatch3(0);
}
}
int main(void)
{
initRobotBase();
powerON();
moveAtSpeed(70,70);
while(true)
{
bumper();
task_RP6System();
}
return 0;
}
Gruß Night989
Lesezeichen