diff --git a/iqrobot.py b/iqrobot.py index d2750f3..e2e8890 100644 --- a/iqrobot.py +++ b/iqrobot.py @@ -42,7 +42,6 @@ class IQRobot: self.abstandsSensor: DistanceSensor = DistanceSensor("D") - def show(self, image: str): ''' Zeige Bild auf LED Matrix des Spikes @@ -50,7 +49,6 @@ class IQRobot: ''' self.hub.light_matrix.show_image(image) - def strecke_gefahren(self): return -self.linker_motor.get_degrees_counted()/360 * self.rad_umfang @@ -60,12 +58,18 @@ class IQRobot: :param int grad: Grad um die der Roboter gedreht werden soll mittels Vorzeichen +/- kann links oder rechts herum gedreht werden + :param bool with_reset: Parameter, um den Gierwinkel zurückzusetzen, Standard: True """ + + # ist überhaupt etwas zu tun für uns? d.h. grad ist enweder 0 oder 360 if grad == 0 or grad == 360 : print("nichts zu tun") return + + # soll der Gierwinkel zurückgesetzt werden? if with_reset: self.bewegungsSensor.reset_yaw_angle() + #steering = 100 if grad > 0 else -100 toleranz = 0 aktuell = self.bewegungsSensor.get_yaw_angle() @@ -74,28 +78,51 @@ class IQRobot: self.antrieb.start(steering=steering, speed=10) differenz = ziel - aktuell print ("Start Ziel: {}, Aktuell: {}".format(ziel, aktuell)) + + # wiederhole solange der Grad der Drehung noch nicht erreicht ist while abs(differenz) > toleranz : aktuell = self.bewegungsSensor.get_yaw_angle() differenz = ziel - aktuell pass + + # stoppe die Bewegung self.antrieb.stop() print ("Final Ziel: {}, Aktuell: {}".format(ziel, aktuell)) - def fahre_gerade_aus(self, cm, speed=20): + """ + Funktion um den Roboter geradeaus fahren zu lassen + + :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 - rechter_speed=speed - kp = 1.5 - ki = 1.0 - sum_cm = 0 - sum_versatz = 0 - while sum_cm < cm: + 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 * richtung: wait_for_seconds(0.05) sum_cm = self.strecke_gefahren() versatz = self.bewegungsSensor.get_yaw_angle() @@ -109,7 +136,6 @@ class IQRobot: self.antrieb.stop() self.drehe(-versatz) - def fahre_mit_drehung(self, strecke1, grad, strecke2): """ Funktion für eine Fahrt mit 1. Strecke, dann Drehung in der Mitte, dann 2. Strecke @@ -119,7 +145,6 @@ class IQRobot: self.fahre_gerade_geregelt(strecke1 + self.abstand_rad_front) self.drehe(grad) self.fahre_gerade_geregelt(strecke2 - self.abstand_rad_front) - def fahre_gerade_aus_alt(self, cm: float, speed: int): """ @@ -142,7 +167,7 @@ class IQRobot: self.antrieb.move(amount=richtung * 0.1, steering=100) drehung = self.bewegungsSensor.get_yaw_angle() print(drehung) - + def heber(self, cm,speed): self.bothFrontMotors.move_tank(-cm*3.3,"cm", -speed, speed) @@ -151,7 +176,6 @@ class IQRobot: rotations=volle_umdrehung*prozent/100 self.bothFrontMotors.move(rotations, unit='rotations',speed=20) - def fahre_bis_abstand(self, abstand: int, speed=30, geregelt=True): self.antrieb.start_at_power(speed) abstand_gerade = self.abstandsSensor.get_distance_cm() diff --git a/main.py b/main.py index 7154a34..628ff40 100644 --- a/main.py +++ b/main.py @@ -107,7 +107,7 @@ def hologram(): iqRobot.drehe(45) iqRobot.fahre_gerade_aus(15,30) iqRobot.fahre_gerade_aus(-15,30) - + def augmented_reality(): iqRobot.drehe(-135) iqRobot.fahre_gerade_aus(42,30) @@ -119,7 +119,6 @@ def augmented_reality(): iqRobot.fahre_gerade_aus(20,30) iqRobot.drehe(-90) iqRobot.fahre_gerade_aus(5,20) - druckmaschine() hologram()