From 10a1b6d9d808e8ae13b3c1712977d2e24bd8319c Mon Sep 17 00:00:00 2001
From: Daniel Bulant <danbulant@gmail.com>
Date: Fri, 28 Nov 2025 15:38:27 +0100
Subject: [PATCH] angle monitoring

---
 rpi/angle-test.py | 23 +++++++++++++++++++++++
 1 file changed, 23 insertions(+)
 create mode 100644 rpi/angle-test.py

diff --git a/rpi/angle-test.py b/rpi/angle-test.py
new file mode 100644
index 0000000..cd2aaed
--- /dev/null
+++ b/rpi/angle-test.py
@@ -0,0 +1,23 @@
+import smbus2
+import time
+
+# Define I2C address and bus
+AS5600_ADDR = 0x36
+ANGLE_REG = 0x0E
+
+bus = smbus2.SMBus(1)
+
+def read_angle():
+    # Read two bytes from the angle register
+    raw_data = bus.read_i2c_block_data(AS5600_ADDR, ANGLE_REG, 2)
+    angle = (raw_data[0] << 8) | raw_data[1]  # Combine MSB and LSB
+    angle = angle & 0x0FFF  # Mask to 12 bits
+    return (angle / 4096.0) * 360.0  # Convert to degrees
+
+try:
+    while True:
+        angle = read_angle()
+        print(f"Angle: {angle:.2f} degrees")
+        time.sleep(0.5)
+except KeyboardInterrupt:
+    print("Exiting...")