Merge pull request 'Abstandssensor' (#9) from laptop_3 into main
Reviewed-on: #9 Reviewed-by: Lars Haferkamp <lahaferk@linuxmuster.lan>
This commit is contained in:
commit
060a72c2a7
1 changed files with 13 additions and 1 deletions
14
iqrobot.py
14
iqrobot.py
|
@ -2,7 +2,7 @@
|
||||||
|
|
||||||
import math
|
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
|
from spike.control import wait_for_seconds
|
||||||
|
|
||||||
HELLO = "HELLO IQ"
|
HELLO = "HELLO IQ"
|
||||||
|
@ -40,6 +40,8 @@ class IQRobot:
|
||||||
|
|
||||||
self.bewegungsSensor: MotionSensor = MotionSensor()
|
self.bewegungsSensor: MotionSensor = MotionSensor()
|
||||||
|
|
||||||
|
self.abstandsSensor: DistanceSensor = DistanceSensor("D")
|
||||||
|
|
||||||
|
|
||||||
def show(self, image: str):
|
def show(self, image: str):
|
||||||
'''
|
'''
|
||||||
|
@ -149,6 +151,15 @@ class IQRobot:
|
||||||
rotations=volle_umdrehung*prozent/100
|
rotations=volle_umdrehung*prozent/100
|
||||||
self.bothFrontMotors.move(rotations, unit='rotations',speed=20)
|
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 :)")
|
print("successfully loaded the IQ Lego teams code :)")
|
||||||
|
|
||||||
|
@ -159,3 +170,4 @@ print("successfully loaded the IQ Lego teams code :)")
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
Loading…
Reference in a new issue