diff --git a/iqrobot.py b/iqrobot.py index 7f3551d..200abd9 100644 --- a/iqrobot.py +++ b/iqrobot.py @@ -1,6 +1,6 @@ # 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 HELLO = "HELLO IQ" @@ -70,13 +70,27 @@ class IQRobot: colorIntensity = self.getColorIntensity() 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) : #Bewege sanft und langsam die Schleuderstange am hinteren Rumpf des Geräts self.stickMotor.run_for_degrees(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) def getDistance (self) : @@ -87,4 +101,4 @@ class IQRobot: cmDistance = self.distanceSensor.get_distance_cm(short_range=True) return cmDistance - print("Loading library IQRobot in version " + VERSION) \ No newline at end of file + print("Loading library IQRobot in version " + VERSION)from spike import PrimeHub, Motor, MotorPair, ColorSensor, MotionSensor \ No newline at end of file