diff --git a/square.py b/square.py index 89f5c77..f0671ab 100644 --- a/square.py +++ b/square.py @@ -10,6 +10,15 @@ RIGHT_WHEEL_OFFSET = 4 CLOCKWISE_OFFSET = 0.82 +def wiggle(arlo): + arlo.go_diff(50, 53, 1, 0) + sleep(TURN_T * CLOCKWISE_OFFSET * 2) + arlo.stop() + sleep(0.3) + arlo.go_diff(50, 53, 0, 1) + sleep(TURN_T * 2) + arlo.stop() + def clockwise_square(arlo): arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 0, 1) sleep(TURN_T * 0.5) @@ -36,6 +45,9 @@ def clockwise_square(arlo): sleep(1) + for _ in range(6): + wiggle(arlo) + def counter_square(arlo): arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 0, 1) sleep(TURN_T * 0.5)