Merge pull request 'Abstandssensor' (#9) from laptop_3 into main

Reviewed-on: #9
Reviewed-by: Lars Haferkamp <lahaferk@linuxmuster.lan>

iqrobot.py

@@ -2,7 +2,7 @@
 
 import math
 
-from spike import PrimeHub, Motor, MotorPair, ColorSensor, MotionSensor
+from spike import PrimeHub, Motor, MotorPair, ColorSensor, MotionSensor, DistanceSensor
 from spike.control import wait_for_seconds
 
 HELLO = "HELLO IQ"
@@ -40,6 +40,8 @@ class IQRobot:
 
         self.bewegungsSensor: MotionSensor = MotionSensor()
 
+        self.abstandsSensor: DistanceSensor = DistanceSensor("D")
+
 
     def show(self, image: str):
         '''
@@ -150,6 +152,15 @@ class IQRobot:
         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 :)")
 
 
@@ -159,3 +170,4 @@ print("successfully loaded the IQ Lego teams code :)")
 
 
 
+