1 files changed, 3 insertions, 11 deletions
diff --git a/System/test_System.py b/System/test_System.py
index 21ed336..c05affc 100644
--- a/System/test_System.py
+++ b/System/test_System.py
@@ -2,20 +2,12 @@
 # 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
+from System.system import System
         
 # 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)
+    print("Angle: " + str(angle) + ", Linear: " + str(linear))
+    time.sleep(0.2)