1 files changed, 13 insertions, 0 deletions
diff --git a/System/Tests/test_System.py b/System/Tests/test_System.py
new file mode 100644
index 0000000..c05affc
--- /dev/null
+++ b/System/Tests/test_System.py
@@ -0,0 +1,13 @@
+# 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.system import System
+        
+# Main program
+sys = System(angular_units = 'Radians')
+while 1:
+    angle, linear = sys.measure()
+    print("Angle: " + str(angle) + ", Linear: " + str(linear))
+    time.sleep(0.2)
+