diff --git a/selflocalization/selflocalize.py b/selflocalization/selflocalize.py index 98223b5..7ef198b 100644 --- a/selflocalization/selflocalize.py +++ b/selflocalization/selflocalize.py @@ -175,7 +175,7 @@ def drive_towards_middle(est_pose, arlo): arlo.stop() else: arlo.go_diff(POWER, POWER, 1, 0) - sleep((abs(180 - turn_angle) * TURN_T * CLOCKWISE_OFFSET)/1000) + sleep((abs(turn_angle - 180) * TURN_T * CLOCKWISE_OFFSET)/1000) arlo.stop() arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 1, 1)