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

Update codes_for_scrimmage/hazmat/mainhazmatUPD.py

Browse Source
This commit is contained in:
Johannes
2025-11-06 01:53:13 +00:00
parent a50b0cd1d7
commit 974f87c4c4
1 changed files with 21 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

22
codes_for_scrimmage/hazmat/mainhazmatUPD.py
View File

@@ -155,7 +155,27 @@ async def Run5():
# Add - Adi's code here # Add - Adi's code here
async def Run6(): async def Run6():
await drive_base.stop await drive_base.straight(500)
await right_arm.run_angle(300,500)
await drive_base.straight(-75)
await right_arm.run_angle(300, -900)
await drive_base.straight(-350)
await wait(1000)
await drive_base.straight(800)
await drive_base.straight(-200)
await drive_base.turn(-15)
await drive_base.straight(350)
await drive_base.turn(-94)
await drive_base.straight(-80)
await left_arm.run_angle(500, 900)
await drive_base.straight(50)
await drive_base.turn(-10)
await drive_base.straight(50)
await left_arm.run_angle(700, -200)
await drive_base.turn(30)
await drive_base.straight(-60)
await drive_base.turn(80)
await drive_base.straight(-900)
# Function to classify color based on HSV # Function to classify color based on HSV
def detect_color(h, s, v, reflected): def detect_color(h, s, v, reflected):
if reflected > 4: if reflected > 4: