Projekte/LegoLeague
3
0
Fork 0
Code Issues 2 Pull requests Projects Releases Packages Wiki Activity

Vincenz's Stuff

Browse source
This commit is contained in:
flhipp 2023-03-29 17:34:27 +02:00
parent 377195855a
commit 3b2ed61e01
1 changed files with 18 additions and 4 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

22
iqrobot.py
View file

@ -1,6 +1,6 @@
# LEGO type:standard slot:6 autostart # LEGO type:standard slot:6 autostart
from spike import PrimeHub, Motor, MotorPair, ColorSensor, DistanceSensor from spike import PrimeHub, Motor, MotorPair, ColorSensor, DistanceSensor, MotionSensor
from spike.control import wait_for_seconds from spike.control import wait_for_seconds
HELLO = "HELLO IQ" HELLO = "HELLO IQ"
@ -70,13 +70,27 @@ class IQRobot:
colorIntensity = self.getColorIntensity() colorIntensity = self.getColorIntensity()
print("Farbintensität: " + str(colorIntensity)) print("Farbintensität: " + str(colorIntensity))
''' '''
def rotateRobot(self,degrees,speed) :
#Lasse den Roboter bei Bedarf um eine bestimmte Anzahl an Grad sanft und behutsam nach Links oder Rechts drehen,
# um den Nutzer zu befriedigen
self.motionSensor.reset_yaw_angle()
if (degrees > 0):
self.leftMotor.start(speed)
self.rightMotor.start(-speed)
elif (degrees < 0):
self.leftMotor.start(-speed)
self.rightMotor.start(speed)
while (self.motionSensor.get_yaw_angle() > degrees) :
self.leftMotor.stop()
self.rightMotor.stop()
def moveStick(self,degrees) : def moveStick(self,degrees) :
#Bewege sanft und langsam die Schleuderstange am hinteren Rumpf des Geräts #Bewege sanft und langsam die Schleuderstange am hinteren Rumpf des Geräts
self.stickMotor.run_for_degrees(degrees) self.stickMotor.run_for_degrees(degrees)
def moveGabel(self,degrees) : def moveGabel(self,degrees) :
#Bewege sanft und langsam die Schleuderstange am hinteren Rumpf des Geräts #Bewege sanft und langsam die ungewöhnlich große sich bewegende Stange am vorderen Rumpf des Geräts
self.gabelMotor.run_for_degrees(degrees) self.gabelMotor.run_for_degrees(degrees)
def getDistance (self) : def getDistance (self) :
@ -87,4 +101,4 @@ class IQRobot:
cmDistance = self.distanceSensor.get_distance_cm(short_range=True) cmDistance = self.distanceSensor.get_distance_cm(short_range=True)
return cmDistance return cmDistance
print("Loading library IQRobot in version " + VERSION) print("Loading library IQRobot in version " + VERSION)from spike import PrimeHub, Motor, MotorPair, ColorSensor, MotionSensor