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

Gabel addiert

Browse source
This commit is contained in:
flhipp 2023-03-08 18:29:58 +01:00
parent 756a382af3
commit ee76b97d83
2 changed files with 19 additions and 3 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

9
iqrobot.py
View file

@ -12,7 +12,7 @@ damit man dann später auch wieder Code Completion hat bei Nutzung der Variablen
''' '''
class IQRobot: class IQRobot:
def __init__(self, hub: PrimeHub, leftMotorPort: str, rightMotorPort: str, colorSensorPort: str, stickMotorPort: str): def __init__(self, hub: PrimeHub, leftMotorPort: str, rightMotorPort: str, colorSensorPort: str, stickMotorPort: str, gabelMotorPort: str):
self.hub: PrimeHub = hub self.hub: PrimeHub = hub
self.leftMotor: Motor = Motor(leftMotorPort) self.leftMotor: Motor = Motor(leftMotorPort)
self.rightMotor: Motor = Motor(rightMotorPort) self.rightMotor: Motor = Motor(rightMotorPort)
@ -67,4 +67,9 @@ class IQRobot:
#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)
print("Loading library IQRobot in version " + VERSION) def moveGabel(self,degrees) :
#Bewege sanft und langsam die Schleuderstange am hinteren Rumpf des Geräts
self.gabelMotor.run_for_degrees(degrees)
print("Loading library IQRobot in version " + VERSION)

13
main.py
View file

@ -60,13 +60,15 @@ COLOR_SENSOR_PORT = 'E'
LEFT_MOTOR_PORT = 'A' LEFT_MOTOR_PORT = 'A'
RIGHT_MOTOR_PORT = 'B' RIGHT_MOTOR_PORT = 'B'
STICK_MOTOR_PORT = 'C' STICK_MOTOR_PORT = 'C'
GABEL_MOTOR_PORT = 'D'
# Initialisieren des Hubs, der Aktoren und Sensoren # Initialisieren des Hubs, der Aktoren und Sensoren
hub = PrimeHub() hub = PrimeHub()
# Initialisiere Robot Klasse mit unseren Funktionen # Initialisiere Robot Klasse mit unseren Funktionen
iqRobot: iq.IQRobot = iq.IQRobot(hub, LEFT_MOTOR_PORT, RIGHT_MOTOR_PORT, COLOR_SENSOR_PORT, STICK_MOTOR_PORT) iqRobot: iq.IQRobot = iq.IQRobot(hub, LEFT_MOTOR_PORT, RIGHT_MOTOR_PORT, COLOR_SENSOR_PORT, STICK_MOTOR_PORT, GABEL_MOTOR_PORT)
'''
while(True): while(True):
print('DIE FARBE IST ', iqRobot.colorSensor.get_color()) print('DIE FARBE IST ', iqRobot.colorSensor.get_color())
if (iqRobot.colorSensor.get_color() == "cyan"): if (iqRobot.colorSensor.get_color() == "cyan"):
@ -77,4 +79,13 @@ while(True):
print('Rot du Affe') print('Rot du Affe')
else: else:
print('Keine Farbe!') print('Keine Farbe!')
'''
iqRobot.moveGabel(50)