Aber ich möchte auch so gern das Programmieren können, verstehste das? Und mal einen Erfolg sehen, das ganze jahr schon war irgendwie alles nicht so gelaufen wie ich es mir vorgestellt hatte, und jetz will ich endlich mal etwas können was andere bei uns in der gegend nicht können
Code:
#include "RP6RobotBaseLib.h"
void task_Bumpers(void)
int main(void)
{
initRobotBase();
setLEDs(0b001001);
powerON();
moveAtSpeed(50,50);
//getLeftSpeed(50,30)
//getRightSpeed(30,50)
startStopwatch1();
startStopwatch2();
while(true)
{
setLEDs(0b000001);
setLEDs(0b000010);
setLEDs(0b000100);
setLEDs(0b001000);
setLEDs(0b010000);
setLEDs(0b100000);
setLEDs(0b111111);
if(getStopwatch1() > 4000)
{
move(60, FWD, DIST_MM(300), true);
rotate(30, LEFT, 180, true);
move(60, FWD, DIST_MM(300), true);
rotate(30, LEFT, 90, true);
move(60,FWD,DIST_MM(200), true);
rotate(30, RIGHT, 45, true);
setStopwatch1(0);
}
if(getStopwatch2() > 200)
{
if(getBumperLeft() && getBumperRight()) escape();
else if(getBumperLeft())
escapeLeft(move(30, BWD, DIST_MM(100), true), rotate(20, RIGHT, 45, true));
else if(getBumperRight())
escapeRight(move(30, BWD, DIST_MM(100), true), rotate(20, LEFT, 45, true));
mSleep(50);
setStopwatch2(0);
}
task_motionControl();
task_Bumpers();
}
return 0;
}
PS:Bin erst heute um 9:30 aufgestanden
Lesezeichen