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:
Rishikesh Lolapu
2025-11-04 01:18:44 +00:00
parent 9cdd9886e3
commit 401033b185
1 changed files with 30 additions and 31 deletions
Download Patch File Download Diff File Expand all files Collapse all files

61
codes_for_scrimmage/hazmat/mainhazmatUPD.py
View File

@@ -132,41 +132,40 @@ async def Run4(): # From Send_Over_Final.py
# Add Rishi's code here # Add Rishi's code here
async def Run5(): async def Run5():
await drive_base.straight(519) await drive_base.straight(700)
await left_arm.run_angle(-10000, 300) await drive_base.turn(-18)
await left_arm.run_angle(10000, 600)
await drive_base.straight(160)
await drive_base.turn(-30)
await drive_base.straight(50)
await right_arm.run_angle(3000, 3000)
await drive_base.straight(-150)
await drive_base.turn(120)
await drive_base.straight(25)
await right_arm.run_angle(10000, -3000)
await drive_base.straight(-110)
await drive_base.turn(-43)
await right_arm.run_angle(10000, -3000)
await drive_base.straight(295)
await right_arm.run_angle(10000, 9000)
await drive_base.straight(-65)
await drive_base.turn(45)
await drive_base.straight(175)
await drive_base.turn(26)
await drive_base.straight(-100)
await right_arm.run_angle(10000, -9000)
await drive_base.straight(100) await drive_base.straight(100)
await right_arm.run_angle(10000, 3500) await drive_base.straight(-205)
await drive_base.turn(-30) await drive_base.turn(63)
await drive_base.straight(-300) await drive_base.straight(125)
await drive_base.turn(-80) await arm_motor.run_angle(1000, -1200)
await drive_base.straight(-700) await drive_base.straight(84)
await arm_motor.run_angle(300, 1200)
await drive_base.straight(-875)
# Add - Adi's code here # Add - Adi's code here
async def Run6(): async def Run6():
await drive_base.straight(750) await drive_base.straight(500)
await drive_base.straight(-650) 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):