From e57d4afba62f75b4c6288f6acc37f4f81b034196 Mon Sep 17 00:00:00 2001
From: unknown <legouser@laptop-01.linuxmuster.lan>
Date: Wed, 3 May 2023 19:06:03 +0200
Subject: [PATCH] Schreibe L mit Movement und HubMotor

---
 iqrobot.py | 28 +++++++++++++++++++++++++++-
 main.py    |  9 +++------
 2 files changed, 30 insertions(+), 7 deletions(-)

diff --git a/iqrobot.py b/iqrobot.py
index 1595e5b..6a6f4f4 100644
--- a/iqrobot.py
+++ b/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 :)")
 
diff --git a/main.py b/main.py
index c6ba5c2..8e7aa3e 100644
--- a/main.py
+++ b/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()