From 552c783ce8102e3997ff60baceb1d28700a6e45e Mon Sep 17 00:00:00 2001
From: NikolajDanger <nikolajgade@live.dk>
Date: Wed, 7 Sep 2022 13:31:44 +0200
Subject: [PATCH] turn_test.py

---
 square.py | 27 ++++++++++++++++++++++++---
 1 file changed, 24 insertions(+), 3 deletions(-)

diff --git a/square.py b/square.py
index ad00c3f..bccfc7a 100644
--- a/square.py
+++ b/square.py
@@ -6,11 +6,11 @@ POWER = 70
 TURN_T = 0.079 # 10 degrees
 DRIVE_T = 0.22 # 10 centimeter
 
-RIGHT_WHEEL_OFFSET = 0
+RIGHT_WHEEL_OFFSET = 4
 
 CLOCKWISE_OFFSET = 0.96
 
-def square(arlo):
+def clockwise_square(arlo):
     while True:
         # Driving forward
         arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 1, 1)
@@ -26,12 +26,33 @@ def square(arlo):
 
         sleep(1)
 
+def counter_square(arlo):
+    while True:
+        # Driving forward
+        arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 1, 1)
+        sleep(DRIVE_T * 10)
+        arlo.stop()
+
+        sleep(1)
+
+        # Turning 90 degrees
+        arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 0, 1)
+        sleep(TURN_T * 9)
+        arlo.stop()
+
+        sleep(1)
+
 def main():
     # Initializes the robot and runs the
     arlo = robot.Robot()
 
+    direction = int(input("clockwise (1)/counter (2):"))
+
     try:
-        square(arlo)
+        if direction == 1:
+            clockwise_square(arlo)
+        else:
+            counter_square(arlo)
 
     except KeyboardInterrupt:
         arlo.stop()