ACS Funktioniert nicht richtig
Hey,
Mein ACS funktioniert nur auf der linken Seite, woran kann das liegen ?
Hier ist mal der Code falls da was falsch ist ^^
Code:
#include "RP6RobotBaseLib.h"
void acsStateChanged(void)
{
if(obstacle_left || obstacle_right)
{
moveAtSpeed(0,0);
move(100,BWD,DIST_CM(10),true);
changeDirection(RIGHT);
move(100,RIGHT,DIST_CM(15),true);
changeDirection(FWD);
moveAtSpeed(100,100);
}
}
int main(void)
{
initRobotBase();
setLEDs(0b111111);
mSleep(1500);
setLEDs(0b000001);
setACSPwrLow();
powerON();
ACS_setStateChangedHandler(acsStateChanged);
{
changeDirection(FWD);
moveAtSpeed(100,100);
}
{
while(true)
task_RP6System();
}
return 0;
}