diff --git a/README.md b/README.md index d7c0858..baba04a 100644 --- a/README.md +++ b/README.md @@ -16,7 +16,7 @@ Importiere den Code entweder über die Shell oder einen Git Client: - für Mac oder Windows: https://www.sourcetreeapp.com/ -Benutzername und Passwort für Makerlab eingeben +Username und PW für Makerlab eingeben Übersicht über Git Commands: https://ndpsoftware.com/git-cheatsheet.html#loc=workspace; diff --git a/iqrobot.py b/iqrobot.py index d2750f3..0ea4b35 100644 --- a/iqrobot.py +++ b/iqrobot.py @@ -2,7 +2,7 @@ import math -from spike import PrimeHub, Motor, MotorPair, ColorSensor, MotionSensor, DistanceSensor +from spike import PrimeHub, Motor, MotorPair, ColorSensor, MotionSensor from spike.control import wait_for_seconds HELLO = "HELLO IQ" @@ -27,21 +27,17 @@ class IQRobot: self.bothFrontMotors: MotorPair = MotorPair(FRONT_MOTOR_LEFT_PORT, FRONT_MOTOR_RIGHT_PORT) - self.linker_motor: Motor = Motor(LEFT_MOTOR_PORT) - self.antrieb: MotorPair = MotorPair(LEFT_MOTOR_PORT, RIGHT_MOTOR_PORT) # Radumfang neu berechnen und Motor konfigurieren # Radius der Antriebsräder self.rad_radius = 2.1 # Abstand zwischen Rädern (Mitte) und Vorderseite des Roboters self.abstand_rad_front = 5.55 - self.rad_umfang = 2 * math.pi * self.rad_radius - self.antrieb.set_motor_rotation(self.rad_umfang) + rad_umfang = 2 * math.pi * self.rad_radius + self.antrieb.set_motor_rotation(rad_umfang) self.bewegungsSensor: MotionSensor = MotionSensor() - self.abstandsSensor: DistanceSensor = DistanceSensor("D") - def show(self, image: str): ''' @@ -51,9 +47,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 - def drehe(self, grad=90, with_reset=True): """ Funktion um den Roboter auf der Stelle zu drehen @@ -82,32 +75,23 @@ class IQRobot: print ("Final Ziel: {}, Aktuell: {}".format(ziel, aktuell)) - def fahre_gerade_aus(self, cm, speed=20): - self.linker_motor.set_degrees_counted(0) + def fahre_gerade_geregelt(self, cm): + """ + WIP by Lars & Klaus + """ 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: - wait_for_seconds(0.05) - sum_cm = self.strecke_gefahren() + self.antrieb.move(1) versatz = self.bewegungsSensor.get_yaw_angle() - sum_versatz = sum_versatz + versatz - abweichung = (kp * versatz + ki * sum_versatz) / 100 - linker_speed = speed * (1 - abweichung) - rechter_speed = speed * (1 + abweichung) - self.antrieb.start_tank_at_power(int(linker_speed), int(rechter_speed)) - #print("Versatz: " + str(versatz) + " , linker Speed: " + str(linker_speed) + ", rechter Speed: " + str(rechter_speed) + ", strecke: " + str(sum_cm)) + self.drehe(grad=-versatz) + self.bewegungsSensor.reset_yaw_angle() + sum_cm = sum_cm + 1 - self.antrieb.stop() - self.drehe(-versatz) + self.antrieb.move(cm - sum_cm) def fahre_mit_drehung(self, strecke1, grad, strecke2): @@ -121,7 +105,7 @@ class IQRobot: self.fahre_gerade_geregelt(strecke2 - self.abstand_rad_front) - def fahre_gerade_aus_alt(self, cm: float, speed: int): + def fahre_gerade_aus(self, cm: float, speed: int): """ Funktion zum gerade aus fahren mit Korrektur am Ende @@ -151,15 +135,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() - while abstand_gerade > abstand: - abstand_gerade = self.abstandsSensor.get_distance_cm() - print(str(abstand_gerade)) - self.antrieb.stop() - print("successfully loaded the IQ Lego teams code :)") @@ -170,4 +145,3 @@ print("successfully loaded the IQ Lego teams code :)") - diff --git a/main.py b/main.py index 7154a34..1ffdb3c 100644 --- a/main.py +++ b/main.py @@ -79,14 +79,6 @@ iqRobot: iq.IQRobot = iq.IQRobot(hub) # Führe Funktionen aus unser Robot Klasse aus: iqRobot.show('HAPPY') -def huenchenaufgabe(): - iqRobot.fahre_gerade_aus(40,60) - iqRobot.drehe(-40,True) - iqRobot.fahre_gerade_aus(20,60) - iqRobot.drehe(-20) - iqRobot.fahre_gerade_aus(55,60) - iqRobot.heber(10,30) - def hologram_alt(): iqRobot.fahre_gerade_aus(cm=75,speed=80) iqRobot.drehe(45, False) @@ -95,6 +87,7 @@ def hologram_alt(): iqRobot.drehe(-45, False) iqRobot.fahre_gerade_aus(cm=-75,speed=50) + def druckmaschine(): iqRobot.fahre_gerade_aus(19,30) iqRobot.drehe(-45) @@ -123,4 +116,4 @@ def augmented_reality(): druckmaschine() hologram() -augmented_reality() +augmented_reality() \ No newline at end of file