Code:
double turnDegrees = ahrs->GetYaw();
while(codriver.GetRawButton(12) == 1)
{
if(turnDegrees > -10 && turnDegrees < 10 && centered == FALSE )
{
myRobot.Drive(0.0, 0.0);
centered = TRUE;
}
else if (turnDegrees < -11 && turnDegrees > -180 && centered == FALSE)
{
myRobot.Drive(0.4, 1.0);
centered = FALSE;
}
else if (turnDegrees > 11 && turnDegrees < 180 && centered == FALSE)
{
myRobot.Drive(-0.4, 1.0);
centered = FALSE;
}
}
This is code I have come up with so far any suggestions would help.
Thank You!!