iqrobot.py

@@ -96,21 +96,33 @@ class IQRobot:
         :param int cm: Strecke in cm, die der Roboter geradeaus fahren soll
         :param int speed: Geschwindigkeit zum Fahren der Strecke, Standard: 20
         """
+
+        # ist überhaupt etwas zu tun für uns? d.h. cm = 0
+        if cm == 0 :
+            print("nichts zu tun")
+            return
+        
+        # wollen wir vorwärts oder rückwarts fahren?
+        richtung = 1
+        if cm < 0:
+            richtung = -1
+
         self.linker_motor.set_degrees_counted(0)
         self.bewegungsSensor.reset_yaw_angle()
 
         self.antrieb.start_tank(10, 10)
         self.antrieb.set_default_speed(10)
 
-        linker_speed=speed      # Gescwindigkeit linker Motor
-        rechter_speed=speed     # Gescwindigkeit rechter Motor
-        kp = 1.5                # Verstärkungsfaktor zur Regelung
-        ki = 1.0                # Integralfaktor zur Regelung
-        sum_cm = 0              # bereits gefahrene Strecke
-        sum_versatz = 0         # Summe des Versatzes über Zeit
+        linker_speed=speed * richtung   # Geschwindigkeit linker Motor
+        rechter_speed=speed * richtung  # Geschwindigkeit rechter Motor
+        kp = 1.5                        # Verstärkungsfaktor zur Regelung
+        ki = 1.0                        # Integralfaktor zur Regelung
+        sum_cm = 0                      # bereits gefahrene Strecke
+        versatz = 0                     # aktueller Versatz
+        sum_versatz = 0                 # Summe des Versatzes über Zeit
 
         # wiederhole solange die gefahrene Strecke noch nicht erreicht ist
-        while sum_cm < cm:
+        while sum_cm < cm * richtung:
             wait_for_seconds(0.05)
             sum_cm = self.strecke_gefahren()
             versatz = self.bewegungsSensor.get_yaw_angle()

main.py

@@ -120,7 +120,6 @@ def augmented_reality():
     iqRobot.drehe(-90)
     iqRobot.fahre_gerade_aus(5,20)
 
-
 druckmaschine()
 hologram()
 augmented_reality()