diff --git a/iqrobot.py b/iqrobot.py index 01bf6dc..da99961 100644 --- a/iqrobot.py +++ b/iqrobot.py @@ -50,8 +50,36 @@ class IQRobot: self.movementMotors.stop() + def buchstabe_zu_segmenten(self, buchstabe): + # Segmente um Buchstaben zu schreiben + # 5_ + # 6 |__|4 + # 1 |7_|3 + # 2 + # + buchstabe_zu_segmenten = {"L": [1,1,0,0,0,1,0], "E": [1,1,0,0,1,1,1], "G": [1,1,1,0,1,1,0], "O": [1,1,1,1,1,1,0]} + return buchstabe_zu_segmenten[buchstabe] + def bewege_stift(self, richtung): + self.frontMotorRight.run_for_rotations(richtung*0.4) + + def schreibe_buchstabe(self, buchstabe): + print(f"Schreibe {buchstabe}") + segmente = self.buchstabe_zu_segmenten(buchstabe) + grad_drehung=90 + self.movementMotors.move(2) + self.drehe(grad_drehung) + for segment, segment_nummer in enumerate(segmente): + if segment==1: + self.bewege_stift(-1) + self.movementMotors.move(5) + if segment==1: + self.bewege_stift(1) + if segment_nummer+1 != 3: + self.drehe(grad_drehung) + + def schreibeL(self, schreibe=True, zurueck=False): if zurueck: step = 5 @@ -94,22 +122,14 @@ class IQRobot: # und fahre 2cm fohrwärts #stift hoch - def schreibeE(self): - print("Schreibe E") - - def schreibeG(self): - print("Schreibe G") - - - def schreibeO(self): - print("Schreibe O") def schreibeLego(self): - self.schreibeL() - self.schreibeL(schreibe=False, zurueck=True) - self.schreibeE() - self.schreibeG() - self.schreibeO() + #self.schreibeL() + #self.schreibeL(schreibe=False, zurueck=True) + self.schreibe_buchstabe("L") + self.schreibe_buchstabe("E") + self.schreibe_buchstabe("G") + self.schreibe_buchstabe("O") print("successfully loaded the IQ Lego teams code :)")