FLL_65266_LEGO_DYNAMICS/solutions_season_unearthed
Template
10
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases 7 Wiki Activity

Update competition_codes/state/sunprarie_state_main.py

Browse Source 
Slight updates to Send over and the first mission run.
This commit is contained in:
Johannes
2025-12-28 01:55:38 +00:00
parent 5a5b6d2d16
commit d9dec685c3
1 changed files with 14 additions and 18 deletions
Download Patch File Download Diff File Expand all files Collapse all files

32
competition_codes/state/sunprarie_state_main.py
View File

@@ -25,7 +25,7 @@ WALL_DISTANCE = 200 # mm
async def drive_forward():
"""Drive forward continuously using DriveBase."""
drive_base.drive(400, 0)
drive_base.drive(1000,0)
async def drive_backward():
"""Drive forward continuously using DriveBase."""
@@ -80,7 +80,11 @@ async def Run1():
async def solve_whats_on_sale():
right_arm.run_angle(500,30)
left_arm.run_angle(500,-119.5)
#Automated inconsistency
#left_arm.run_angle(500,-119.5)
left_arm.run_target(500,-121.5, Stop.HOLD)
await drive_base.straight(180)
await drive_base.turn(-40)
@@ -195,28 +199,20 @@ async def Run3():
)
async def solve_angler_artifacts():
await drive_base.straight(940)
await drive_base.straight(890)
await drive_base.turn(-90,Stop.HOLD)
await drive_base.straight(65)
await drive_base.straight(45)
#Solve
drive_base.turn(-10)
await left_arm.run_angle(10000,-3000)
await drive_base.straight(-110)
await left_arm.run_angle(10000,-750)
await drive_base.straight(-130)
await drive_base.turn(90)
await drive_base.arc(-150,-103, None)
await drive_base.turn(67)
async def solve_tip_the_scale():
await drive_base.turn(3)
await drive_base.straight(142.5)
await right_arm.run_angle(800,-150)
await right_arm.run_angle(900,150)
await drive_base.straight(-100)
await drive_base.turn(-65)
await drive_base.straight(300,Stop.COAST_SMART)
await drive_base.arc(10,-47, None)
#await drive_base.turn(-23, Stop.COAST_SMART)
await drive_base.straight(-200)
await drive_base.straight(60)
await drive_base.turn(22)