Schreibe L mit Movement und HubMotor

iqrobot.py

@@ -16,7 +16,8 @@ class IQRobot:
         self.leftMotor: Motor = Motor(leftMotorPort)
         self.rightMotor: Motor = Motor(rightMotorPort)
         self.movementMotors: MotorPair = MotorPair(leftMotorPort, rightMotorPort) 
-        self.colorSensor: ColorSensor = ColorSensor(colorSensorPort)
+        #self.colorSensor: ColorSensor = ColorSensor(colorSensorPort)
+        self.hubMotor: Motor = Motor("F")
 
 
     def show(self, image: str):
@@ -38,9 +39,34 @@ class IQRobot:
         (red, green, blue, colorIntensity) = self.colorSensor.get_rgb_intensity()
         return colorIntensity
 
+    def schreibeL(self):
+        print("Schreibe L")
+        self.hubMotor.run_for_rotations(-0.06)
+        self.movementMotors.move(5)
+        self.rightMotor.run_for_degrees(90)
+        self.movementMotors.move(2)
+        self.hubMotor.run_for_rotations(0.06)
+
+        # Fahre 5 cm rückwerts  
+        # dann drehe nach rechts 90°
+        # und fahre 2cm fohrwärts 
+        #stift hoch
+
+    def schreibeE(self):
+        print("Schreibe E")
+
+    def schreibeG(self):
+        print("Schreibe G")
 
 
+    def schreibeO(self):
+        print("Schreibe O")
 
+    def schreibeLego(self):
+        self.schreibeL()
+        self.schreibeE()
+        self.schreibeG()
+        self.schreibeO()
 
 print("successfully loaded the IQ Lego teams code :)")
 

main.py

@@ -72,8 +72,8 @@ dh auch an die Funktionen im importierten Code übergeben werde
 
 # Definiere an welchen Ports die Sensoren angeschlossen sind 
 COLOR_SENSOR_PORT = 'E'
-LEFT_MOTOR_PORT = 'A'
-RIGHT_MOTOR_PORT = 'B'
+LEFT_MOTOR_PORT = 'D'
+RIGHT_MOTOR_PORT = 'A'
 
 # Initialisieren des Hubs, der Aktoren und Sensoren
 hub = PrimeHub()
@@ -83,10 +83,7 @@ iqRobot: iq.IQRobot = iq.IQRobot(hub, LEFT_MOTOR_PORT, RIGHT_MOTOR_PORT, COLOR_S
 
 # Führe Funktionen aus unser Robot Klasse aus:
 iqRobot.show('HAPPY')
-iqRobot.driveForward_for_sec(2.0)
-colorIntensity = iqRobot.getColorIntensity()
-print("Farbintensität: " + str(colorIntensity))
-
+iqRobot.schreibeLego()