diff --git a/codes_for_scrimmage/hazmat/mainhazmatUPD.py b/codes_for_scrimmage/hazmat/mainhazmatUPD.py index 79f3692..d23f655 100644 --- a/codes_for_scrimmage/hazmat/mainhazmatUPD.py +++ b/codes_for_scrimmage/hazmat/mainhazmatUPD.py @@ -45,21 +45,27 @@ async def monitor_distance(): # New Section async def Run1(): # From M8_5.py + right_arm.run_angle(1000,450) - left_arm.run_angle(500,-80) + left_arm.run_angle(500,-90) await drive_base.straight(200) await drive_base.turn(-40) await drive_base.straight(325) - await left_arm.run_angle(500,80) + await left_arm.run_angle(500,90) await drive_base.straight(-100) await drive_base.straight(50) - await left_arm.run_angle(500,-170) + await left_arm.run_angle(500,-180) - await drive_base.straight(-270) - await drive_base.turn(40) - await drive_base.straight(135) + await drive_base.straight(-90) + left_arm.run_angle(500,180) + await drive_base.turn(-20) + await drive_base.turn(15) + + await drive_base.straight(-173) + await drive_base.turn(45) + await drive_base.straight(120) left_arm.run_angle(1000,-670) await right_arm.run_angle(5000,-450, Stop.HOLD) @@ -70,7 +76,7 @@ async def Run1(): # From M8_5.py right_arm.run_angle(5000,450, Stop.HOLD) await drive_base.turn(-35) - await drive_base.straight(300) + await drive_base.straight(297) await drive_base.turn(63) await drive_base.straight(170) @@ -78,12 +84,9 @@ async def Run1(): # From M8_5.py await drive_base.straight(87) await drive_base.turn(-15) - await drive_base.straight(-120) + await drive_base.straight(-90) await drive_base.turn(-100) - await drive_base.straight(300) - await drive_base.turn(-45) - await drive_base.straight(500) - + await drive_base.arc(-500,None,600) async def Run2(): # From Heavy_lifting_final.py await drive_base.straight(200)