Mit der Änderung von Magelan:
Code:
#include "RP6RobotBaseLib.h" //bindet die RP6RobotBaseLib.h ein
int main (void){
initRobotBase(); //initialsiert den Robby
powerON(); //aktiviert die Encoder usw.
while(1){
task_Bumpers(); //fragt alle 50ms die Bumper ab und speichert den Wert in "bumper_left" und "bumper_right"
if(bumper_left != false){ //wenn linker bumper betätigt...
setLEDs(0b111000); //schalte SL4, SL5 und SL6 ein
moveAtSpeed(0,0); //Stop
task_RP6System();
mSleep(1500); //1,5 Sekunden warten
move(60,BWD,DIST_MM(300),BLOCKING); //fahre 30cm Rückwärts
rotate(60,RIGHT,180,BLOCKING); //um 180° nach Rechts drehen
}
else{
setLEDs(0b000000); //schalte alle LEDs aus
changeDirection(FWD); //Motor Drehrichtung auf Vorwärts setzen
moveAtSpeed(80,80); //Fahre Vorwärts bis Bumper gedrückt wird
}
task_RP6System(); //fragt immer wieder die Encoder usw. ab
}
return 0;
}
Lesezeichen