1 files changed, 10 insertions, 6 deletions
diff --git a/System_Python/test_System.py b/System_Python/test_System.py
index af218e0..32ff56d 100644
--- a/System_Python/test_System.py
+++ b/System_Python/test_System.py
@@ -1,17 +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 (angle / 180.0) * 100.0
-		
+    return (abs(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
+    angle, linear = sys.measure()
+    #print(angle)
+    speed = control_function(angle)
+    print(speed)
+    sys.adjust(speed)
+    time.sleep(0.05)
+    
+\ No newline at end of file