From 33746aeab65c9164f430a851aab4e1e5f237e98f Mon Sep 17 00:00:00 2001
From: Jordi <jordibolz.jb@gmail.com>
Date: Wed, 25 Dec 2024 13:24:12 +0100
Subject: [PATCH] a

---
 calibration.py | 30 ++++++++++++++++++++++++++++++
 1 file changed, 30 insertions(+)
 create mode 100644 calibration.py

diff --git a/calibration.py b/calibration.py
new file mode 100644
index 0000000..019d399
--- /dev/null
+++ b/calibration.py
@@ -0,0 +1,30 @@
+import time
+from adafruit_servokit import ServoKit
+
+# Initialize ServoKit
+kit = ServoKit(channels=16)
+
+# Constants for angles
+ANGLE_START = 0
+ANGLE_MIDDLE = 110
+
+# Constants for delay
+DELAY = 1
+
+# Function to move a leg with user input
+def move_leg_with_prompt(leg, angle):
+    print(f"Leg {leg}: Currently at {kit.servo[leg].angle if kit.servo[leg].angle is not None else 'unknown'}. Moving to {angle}.")
+    input("Press Enter to continue...")
+    kit.servo[leg].angle = angle
+    time.sleep(DELAY)
+
+# Main function
+def main():
+    legs = [0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11]
+    while True:
+        for leg in legs:
+            move_leg_with_prompt(leg, ANGLE_START)
+            move_leg_with_prompt(leg, ANGLE_MIDDLE)
+
+if __name__ == "__main__":
+    main()