Drive all Test and bugfix

software/roboter/ev3/drive_arm.py

@@ -0,0 +1,17 @@
+#!/usr/bin/env python3
+from ev3dev2.motor import Motor, OUTPUT_B, OUTPUT_C, SpeedPercent
+import sys
+
+motorUpDown = Motor(OUTPUT_C)
+motorLeftRight = Motor(OUTPUT_B)
+
+plantID = int(sys.argv[1])
+
+# Set direction of arm rotation back to middle
+if plantID % 2 == 0:
+    leftRight = 50     # rotating right
+else:
+    leftRight = -50      # rotating left
+
+motorUpDown.on_for_seconds(SpeedPercent(-50), seconds=2.8)
+motorLeftRight.on_for_degrees(SpeedPercent(leftRight), 400)

software/roboter/ev3/drive_back_straight.py

@@ -0,0 +1,24 @@
+#!/usr/bin/env python3
+from ev3dev2.motor import LargeMotor, OUTPUT_A, OUTPUT_D, SpeedPercent
+from ev3dev2.sensor.lego import TouchSensor, UltrasonicSensor  
+from ev3dev2.sensor import INPUT_1, INPUT_4
+
+motorLeft = LargeMotor(OUTPUT_D)
+motorRight = LargeMotor(OUTPUT_A)
+sensorUltraSonic = UltrasonicSensor(INPUT_4)
+sensorTouch = TouchSensor(INPUT_1)
+
+motorLeft.on(SpeedPercent(-70), block=False)
+motorRight.on(SpeedPercent(-70))
+
+while True:
+    if sensorUltraSonic.distance_centimeters < 10:
+        motorLeft.on(SpeedPercent(-25), block=False)
+        motorRight.on(SpeedPercent(-25))
+        break
+
+
+    
+sensorTouch.wait_for_pressed(timeout_ms=None, sleep_ms=10)
+motorLeft.off()
+motorRight.off()