diff options
| -rw-r--r-- | System/test_System.py | 14 |
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)
|