From e642f13e8e04c20091de7c5046189421ff5214c6 Mon Sep 17 00:00:00 2001
From: NikolajDanger <nikolajgade@live.dk>
Date: Wed, 7 Sep 2022 15:05:06 +0200
Subject: [PATCH] :sparkles:

---
 square.py | 12 ++++++++++++
 1 file changed, 12 insertions(+)

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)