1 files changed, 21 insertions, 0 deletions
diff --git a/System/test_System.py b/System/test_System.py
new file mode 100644
index 0000000..21ed336
--- /dev/null
+++ b/System/test_System.py
@@ -0,0 +1,21 @@
+# This test file implements a super simple control-type function for testing the System library.
+# DO NOT TEST ON ASSEMBLED PHYSICAL SYSTEM! It will probably break it.
+import time
+
+from system import System
+
+# Return a speed based on current encoder angle.
+# Convert an angle to speed (180 degrees = max speed)
+def control_function(angle):
+    return (abs(angle) / 180.0) * 100.0
+        
+# Main program
+sys = System(angular_units = 'Radians')
+while 1:
+    angle, linear = sys.measure()
+    print(angle)
+    """speed = control_function(angle)
+    print(speed)
+    sys.adjust(speed)"""
+    time.sleep(0.05)
+