aboutsummaryrefslogtreecommitdiffstats
diff options
context:
space:
mode:
-rw-r--r--System/test_System.py14
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)