Update codes_for_scrimmage/hazmat/Heavy_lifting_final.py
This commit is contained in:
@@ -17,20 +17,17 @@ drive_base.settings(600,500,300,200)
|
|||||||
drive_base.use_gyro(True)
|
drive_base.use_gyro(True)
|
||||||
|
|
||||||
async def main():
|
async def main():
|
||||||
#Get to mission
|
#await drive_base.straight(200)
|
||||||
await drive_base.straight(200)
|
|
||||||
await drive_base.turn(-20)
|
await drive_base.turn(-20)
|
||||||
await drive_base.straight(525)
|
await drive_base.straight(536)
|
||||||
await drive_base.turn(60)
|
await drive_base.turn(60, Stop.HOLD)
|
||||||
#Solve mission
|
await drive_base.straight(30)
|
||||||
await drive_base.straight(50)
|
|
||||||
await right_arm.run_angle(2000,1000)
|
await right_arm.run_angle(5000,2900)
|
||||||
await drive_base.straight(-50)
|
await drive_base.straight(40)
|
||||||
await drive_base.turn(45)
|
await right_arm.run_angle(5000,-4000)
|
||||||
await drive_base.straight(50)
|
await drive_base.straight(-60)
|
||||||
await right_arm.run_angle(350,-1000)
|
|
||||||
#Return home
|
await drive_base.turn(-60)
|
||||||
await drive_base.straight(-100)
|
await drive_base.straight(-670)
|
||||||
await drive_base.turn(-100)
|
|
||||||
await drive_base.straight(-600)
|
|
||||||
run_task(main())
|
run_task(main())
|
||||||
Reference in New Issue
Block a user