iqrobot.py

@@ -5,8 +5,7 @@ import math
 from spike import PrimeHub, Motor, MotorPair, ColorSensor, MotionSensor, DistanceSensor
 from spike.control import wait_for_seconds
 
-print("Lade IQ-Bibliothek")
-
+HELLO = "HELLO IQ"
 
 '''
 Wir nutzen "Duck typing", dh wir schreiben hinter jede Variabel mit ':' die Klasse, zB `leftMotor: Motor`
@@ -27,10 +26,6 @@ class IQRobot:
         FRONT_MOTOR_LEFT_PORT = "A"
 
         self.bothFrontMotors: MotorPair = MotorPair(FRONT_MOTOR_LEFT_PORT, FRONT_MOTOR_RIGHT_PORT)
-        self.linker_motor_vorne: Motor = Motor(FRONT_MOTOR_LEFT_PORT)
-        self.linker_motor_vorne.set_stall_detection(stop_when_stalled=True)
-        self.rechter_motor_vorne: Motor = Motor(FRONT_MOTOR_RIGHT_PORT)
-        self.rechter_motor_vorne.set_stall_detection(stop_when_stalled=True)
 
         self.linker_motor: Motor = Motor(LEFT_MOTOR_PORT)
         
@@ -55,13 +50,9 @@ class IQRobot:
         self.hub.light_matrix.show_image(image)
 
     def strecke_gefahren(self):
-        '''
-        Gibt die gefahrene Strecke basierend auf den Radumdrehungen zurück 
-        '''
         return -self.linker_motor.get_degrees_counted()/360 * self.rad_umfang
 
-
-    def drehe(self, grad=90, with_reset=True, speed=10):
+    def drehe(self, grad=90, with_reset=True):
         """
         Funktion um den Roboter auf der Stelle zu drehen
 
@@ -77,14 +68,14 @@ class IQRobot:
 
         # soll der Gierwinkel zurückgesetzt werden?
         if with_reset:
-            self.bewegungsSensor.reset_yaw_angle() # Gierwinkel zurücksetzen
+            self.bewegungsSensor.reset_yaw_angle()
         
         #steering = 100 if grad > 0 else -100
-        toleranz = 0 # Toleranz soll null sein. Kann erhöht werden, falls der Roboter sich unendlich dreht.
-        aktuell = self.bewegungsSensor.get_yaw_angle() # Aktuelle Position
+        toleranz = 0
+        aktuell = self.bewegungsSensor.get_yaw_angle()
         ziel = grad
         steering = 100 if ziel > aktuell else -100
-        self.antrieb.start(steering=steering, speed=speed) # Mit bestimmer Geschwindigkeit starten
+        self.antrieb.start(steering=steering, speed=10)
         differenz = ziel - aktuell
         print ("Start Ziel: {}, Aktuell: {}".format(ziel, aktuell))
 
@@ -115,13 +106,11 @@ class IQRobot:
         richtung = 1
         if cm < 0:
             richtung = -1
-            speed = speed * richtung # Die Geschwindigkeit soll negativ sein, wenn wir rückwärts fahren
+            speed = speed * richtung
 
-        # Alles zurücksetzen
-        self.linker_motor.set_degrees_counted(0) 
+        self.linker_motor.set_degrees_counted(0)
         self.bewegungsSensor.reset_yaw_angle()
 
-        # Mit irgendeiner Geschwindigkeit g>0 starten. Wert ist irrelevant
         self.antrieb.start_tank(10, 10)
         self.antrieb.set_default_speed(10)
 
@@ -135,18 +124,18 @@ class IQRobot:
 
         # wiederhole solange die gefahrene Strecke noch nicht erreicht ist
         while sum_cm < cm * richtung:
-            wait_for_seconds(0.05) # Sonst wird das zu oft ausgeführt
-            sum_cm = self.strecke_gefahren() * richtung # Gefahrene Strecke, ggf. eben negativ machen
-            versatz = self.bewegungsSensor.get_yaw_angle() # Um wie viel sind wir falsch?
+            wait_for_seconds(0.05)
+            sum_cm = self.strecke_gefahren() * richtung
+            versatz = self.bewegungsSensor.get_yaw_angle()
             sum_versatz = sum_versatz + versatz
-            abweichung = (kp * versatz + ki * sum_versatz) / 100 # Abweichung berechnen, um zu korrigieren
+            abweichung = (kp * versatz + ki * sum_versatz) / 100
             linker_speed = speed * (1 - abweichung * richtung) 
             rechter_speed = speed * (1 + abweichung * richtung)
-            self.antrieb.start_tank_at_power(int(linker_speed), int(rechter_speed)) # Mit neuer Geschwindigkeit starten
+            self.antrieb.start_tank_at_power(int(linker_speed), int(rechter_speed))
             #print("Versatz: " + str(versatz) + " , linker Speed: " + str(linker_speed) + ", rechter Speed: " + str(rechter_speed) + ", strecke: " + str(sum_cm))
 
-        self.antrieb.stop() # Stoppen
-        self.drehe(-versatz) # Da Versatz immer != 0, korrigieren
+        self.antrieb.stop()
+        self.drehe(-versatz)
 
     def fahre_mit_drehung(self, strecke1, grad, strecke2):
         """
@@ -158,13 +147,9 @@ class IQRobot:
         self.drehe(grad)
         self.fahre_gerade_geregelt(strecke2 - self.abstand_rad_front)
 
-
-    #deprecated
     def fahre_gerade_aus_alt(self, cm: float, speed: int):
         """
         Funktion zum gerade aus fahren mit Korrektur am Ende
-        Wird nicht mehr aktiv genutzt, da wir jetzt fahre_gerade_aus haben, 
-        welche geregelt ist, und der Roboter daher nicht schief wird.
 
         :param int cm: Zentimeter die gerade aus gefahren werden soll
         :param speed: Geschwindigkeit mit der gefahren wird
@@ -185,34 +170,14 @@ class IQRobot:
             print(drehung)
 
     def heber(self, cm,speed):
-        """
-        Lässt den Heber fahren
+        self.bothFrontMotors.move_tank(-cm*3.3,"cm", -speed, speed)
 
-        :param speed: Geschwindigkeit, mit der der Heber bewegt wird
-        :param cm: Um wie viel soll der Heber bewegt werden?
-        """
-        self.bothFrontMotors.move_tank(-cm*3.3,"cm", -speed, speed) # Heber bewegen
-
-    def schaufel(self,prozent, speed=20):
-        """
-        Lässt die Schaufel fahren
-
-        :param prozent: Auf wie viel Prozent soll die Schaufel bewegt werden?
-        """
+    def schaufel(self,prozent):
         volle_umdrehung=0.29
         rotations=volle_umdrehung*prozent/100
-        #self.bothFrontMotors.move(rotations, unit='rotations',speed=20)
-        self.bothFrontMotors.move_tank(rotations, 'rotations', speed, -speed)
+        self.bothFrontMotors.move(rotations, unit='rotations',speed=20)
 
-    # TODO: Geregeltes Fahren ist noch nicht eingebaut
     def fahre_bis_abstand(self, abstand: int, speed=30, geregelt=True):
-        """
-        Nutzt den Abstandssensor, um zu fahren, bis ein Abstand erreicht ist
-
-        :param abstand: Abstand zum Objekt
-        :param speed: Geschwindigkeit, mit der gefahren wird
-        :param geregelt: Soll mit Regler gefahren werden?
-        """
         self.antrieb.start_at_power(speed)
         abstand_gerade = self.abstandsSensor.get_distance_cm()
         while abstand_gerade > abstand:
@@ -221,7 +186,7 @@ class IQRobot:
         self.antrieb.stop()
 
         
-print("Fertig geladen.")
+print("successfully loaded the IQ Lego teams code :)")
 
 
 

main.py

@@ -27,11 +27,11 @@ def importFile(slotid=0, precompiled=False, module_name='importFile'):
     with open("/projects/.slots","rt") as f:
         slots = eval(str(f.read()))
         print(slots)
-    #print(os.listdir("/projects/"+str(slots[slotid]["id"])))
+    print(os.listdir("/projects/"+str(slots[slotid]["id"])))
     with open("/projects/"+str(slots[slotid]["id"])+"/__init__"+suffix,"rb") as f:
         print("trying to read import program")
         program = f.read()
-        #print(program)
+        print(program)
     try:
         os.remove("/"+module_name+suffix)
     except:
@@ -52,6 +52,14 @@ def importFile(slotid=0, precompiled=False, module_name='importFile'):
 # Dateiname und Modulname sollten gleich sein, dann kann man Code Completion nutzen
 importFile(slotid=6, precompiled=True, module_name="iqrobot")
 import iqrobot as iq
+print(iq.HELLO) 
+
+# Importiere Go Robot Code
+#importFile(slotid=3, precompiled=True, module_name="gorobot")
+#import gorobot as gr
+#gr.exampleFour()
+#gr.db.gyroRotation(90, 25, 35, 25)
+
 
 ################### Hauptcode ####################################
 '''
@@ -112,8 +120,6 @@ def augmented_reality():
     iqRobot.drehe(-90)
     iqRobot.fahre_gerade_aus(5,20)
 
-#iqRobot.fahre_gerade_aus(16, 20)
-#iqRobot.drehe(38)
-#iqRobot.fahre_gerade_aus(33,25)
-iqRobot.schaufel(1600, speed=100 )
-iqRobot.schaufel(-1600, speed=100 )
+druckmaschine()
+hologram()
+augmented_reality()