1 files changed, 17 insertions, 0 deletions
diff --git a/System_Python/test_System.py b/System_Python/test_System.py
new file mode 100644
index 0000000..af218e0
--- /dev/null
+++ b/System_Python/test_System.py
@@ -0,0 +1,17 @@
+# 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.
+
+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 (angle / 180.0) * 100.0
+		
+# Main program
+sys = System()
+while 1:
+	angle, linear = sys.measure()
+	speed = control_function(angle)
+	sys.adjust(speed)
+	
+\ No newline at end of file