Update codes_for_scrimmage/hazmat/mainhazmatUPD.py

This commit is contained in:
2025-10-24 00:52:40 +00:00
parent dbb0749ff3
commit 94bae3c140

View File

@@ -45,7 +45,7 @@ async def monitor_distance():
# New Section
async def Run1(): # From M8_5.py
left_arm.run_angle(1000, 300)
left_arm.run_angle(1000, -300)
right_arm.run_angle(1000, 500)
await drive_base.straight(320)
await right_arm.run_angle(5000, -500, Stop.HOLD)
@@ -63,9 +63,9 @@ async def Run1(): # From M8_5.py
await drive_base.straight(-145)
await drive_base.turn(-60)
await drive_base.straight(90)
await left_arm.run_angle(1000, -450)
await drive_base.straight(-145)
await left_arm.run_angle(1000, 450)
await drive_base.straight(-145)
await left_arm.run_angle(1000, -450)
await drive_base.straight(10)
await drive_base.turn(35)
await drive_base.straight(-600)
@@ -85,7 +85,7 @@ async def Run2(): # From Heavy_lifting_final.py
async def Run3(): # tip the scale.py
left_arm.run_angle(600,200)
left_arm.run_angle(600,-200)
right_arm.run_angle(500,200)
await drive_base.straight(70)
@@ -100,7 +100,7 @@ async def Run3(): # tip the scale.py
await drive_base.turn(66)
await drive_base.straight(7)
await left_arm.run_angle(560,-390) #going down
await left_arm.run_angle(560,390) #going down
print('turning now...')
await drive_base.turn(40) # turning right
await left_arm.run_angle(-410,-400) #lift a little bit