Commit 9c254ace authored by Timothy Stack's avatar Timothy Stack

Don't move backwards unless the distance is < 0.25 meters, we want to

avoid them getting bound up...
parent ae3ce1a6
......@@ -250,7 +250,7 @@ void wheelManager::setDestination(float x, float y, wmCallback *callback)
* Check if we can make the move by backing up instead of turning all the
* way around and moving forward.
*/
if (fabsf(angle) > M_PI_2) {
if ((distance <= 0.25) && (fabsf(angle) > M_PI_2)) {
if (angle >= 0.0)
angle -= M_PI;
else
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment