codes_for_scrimmage/hazmat/mainhazmatUPD.py

@@ -111,24 +111,36 @@ async def Run3():  # tip the scale.py
 
 
 async def Run4():  # From Send_Over_Final.py
-    # Get to mission
+        #Get to mission
     await drive_base.straight(920)
-    await drive_base.turn(-90, Stop.HOLD)
+    await drive_base.turn(-90,Stop.HOLD)
     await drive_base.straight(65)
-    # Solve mission
+    #Solve mission
     drive_base.turn(-10)
-    await left_arm.run_angle(10000, -4000)
-    # Get to Red Start
+    await left_arm.run_angle(10000,-4000)
+    #Get to Red Start
     await drive_base.straight(-110)
     await drive_base.turn(90)
     await drive_base.straight(500)
     
+    # while True:
+    #     distance_mm = await lazer_ranger.distance()
+    #     print('distancing...',distance_mm)
+
+    #     if distance_mm < 300:
+    #         drive_base.stop
+    #         break
+    #     else:
+    #         drive_base.straight(300)
+    #         print('running...')
+    #     await wait(10)
     await multitask(
         drive_forward(), 
         monitor_distance()
     )
 
 
+
 # Add Rishi's code here
 async def Run5(): 
     await drive_base.straight(519)