diff --git a/iqrobot.py b/iqrobot.py
index cec7049..0ea4b35 100644
--- a/iqrobot.py
+++ b/iqrobot.py
@@ -27,16 +27,14 @@ 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()
 
@@ -49,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
@@ -80,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):
@@ -119,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