diff --git a/square.py b/square.py index 73efc09..9319092 100644 --- a/square.py +++ b/square.py @@ -26,25 +26,26 @@ def clockwise_square(arlo): arlo.stop() sleep(0.5) - for _ in range(12): - # Driving forward - arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 1, 1) - sleep(DRIVE_T * 10) - arlo.stop() + for _ in range(3): + for _ in range(4): + # Driving forward + arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 1, 1) + sleep(DRIVE_T * 10) + arlo.stop() - sleep(1) + sleep(1) - # Turning 90 degrees - arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 1, 0) - sleep(TURN_T * 10 * CLOCKWISE_OFFSET) - arlo.stop() - sleep(0.2) - arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 0, 1) - sleep(TURN_T) - arlo.stop() + # Turning 90 degrees + arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 1, 0) + sleep(TURN_T * 10 * CLOCKWISE_OFFSET) + arlo.stop() + sleep(0.2) + arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 0, 1) + sleep(TURN_T) + arlo.stop() - - sleep(1) + sleep(1) + sleep(3) for _ in range(6): wiggle(arlo)