Skrevet ferdig funksjonalitet

oving_2/main.py

@@ -20,21 +20,41 @@
 ev3.speaker.beep()
 
 
+
+leftMotor = Motor(port=Port.A)
+rightMotor = Motor(port=Port.C)
+robotDriveBase = DriveBase(leftMotor, rightMotor, wheel_diameter=56, axle_track=110)
+
 startBtn = TouchSensor(port=Port.S1)
 usSensor = UltrasonicSensor(port=Port.S3)
 
 isPressed = False
 
+next_turn = 0
+
 while True:
-
     if(startBtn.pressed() and isPressed == False):
-        print("Knapp funker\n",
-              "Starter program.")
+        ev3.speaker.say("Excercise 2")
+        wait(500)
         isPressed = True
+        next_turn = 1
 
     elif(isPressed == True):
-        print(usSensor.distance())
-
+        if startBtn.pressed():
+            isPressed = False
+            break
+
+        elif(usSensor.distance() >= 75):
+            robotDriveBase.drive(-250, 0)
+        else:
+            robotDriveBase.turn(90 * next_turn)
+            robotDriveBase.straight(-150)
+            robotDriveBase.turn(90 * next_turn)
+            next_turn *= -1
+
+robotDriveBase.stop()
+ev3.speaker.say("Excercise done")
+
 
 
 print("The end..")