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-04 01:10:02 +00:00
parent a65ad1470c
commit 3a45721812
1 changed files with 25 additions and 33 deletions
Download Patch File Download Diff File Expand all files Collapse all files

58
codes_for_scrimmage/hazmat/mainhazmatUPD.py
View File

@@ -21,7 +21,7 @@ drive_base = DriveBase(left_motor, right_motor, WHEEL_DIAMETER, AXLE_TRACK)
drive_base.settings(600, 500, 300, 200) drive_base.settings(600, 500, 300, 200)
drive_base.use_gyro(True) drive_base.use_gyro(True)
WALL_DISTANCE = 300 # mm WALL_DISTANCE = 200 # mm
async def drive_forward(): async def drive_forward():
"""Drive forward continuously using DriveBase.""" """Drive forward continuously using DriveBase."""
@@ -61,15 +61,9 @@ async def Run1(): # From M8_5.py
right_arm.run_angle(50, 500) right_arm.run_angle(50, 500)
await drive_base.turn(45) await drive_base.turn(45)
await drive_base.straight(-145) await drive_base.straight(-145)
await drive_base.turn(-60) await drive_base.turn(-30)
await drive_base.straight(90) await drive_base.straight(-700)
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)
async def Run2(): # From Heavy_lifting_final.py async def Run2(): # From Heavy_lifting_final.py
await drive_base.straight(200) await drive_base.straight(200)
await drive_base.turn(-20) await drive_base.turn(-20)
@@ -105,39 +99,37 @@ async def Run3(): # tip the scale.py
await drive_base.turn(40) # turning right await drive_base.turn(40) # turning right
await left_arm.run_angle(410,-400) #lift a little bit await left_arm.run_angle(410,-400) #lift a little bit
await drive_base.straight(80) await drive_base.straight(80)
await drive_base.turn(-41) #ma din din din dun 67 41 21 69 await drive_base.turn(-41) #ma din din din dun 67 41 21
await drive_base.straight(900) await drive_base.straight(900)
async def Run4(): # From Send_Over_Final.py async def Run4(): # From Send_Over_Final.py
#Get to mission right_arm.run_angle(800,800)
await drive_base.straight(920) await drive_base.straight(170)
await drive_base.turn(-90,Stop.HOLD) await drive_base.turn(-90)
await drive_base.straight(65)
#Solve mission await drive_base.straight(270)
await drive_base.turn(59)
await drive_base.straight(202)
await drive_base.turn(2)
await right_arm.run_angle(350,-800)
await right_arm.run_angle(800,800)
await drive_base.straight(-20)
await drive_base.straight(-35)
await drive_base.turn(-60)
await drive_base.straight(342)
await drive_base.turn(-89)
await drive_base.straight(75) # Tralelo Tralala shark with blue shoes
drive_base.turn(-10) drive_base.turn(-10)
await left_arm.run_angle(10000, 4000) await left_arm.run_angle(1000,-4000)
#Get to Red Start
await drive_base.straight(-110) await drive_base.straight(-110)
await drive_base.turn(90) await drive_base.turn(90)
# while True:
# distance_mm = await lazer_ranger.distance()
# print('distancing...',distance_mm)
# if distance_mm < 300:
# drive_base.stop
# break
# else:
# drive_base.straight(300)
# print('running...')
# await wait(10)
await multitask( await multitask(
drive_forward(), drive_forward(),
monitor_distance() monitor_distance()
) )
# 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(519)
@@ -159,9 +151,9 @@ async def Run5():
await drive_base.straight(-65) await drive_base.straight(-65)
await drive_base.turn(45) await drive_base.turn(45)
await drive_base.straight(175) await drive_base.straight(175)
await drive_base.turn(24.5) await drive_base.turn(26)
await drive_base.straight(-100) await drive_base.straight(-100)
await right_arm.run_angle(10000, -8500) 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 right_arm.run_angle(10000, 3500)
await drive_base.turn(-30) await drive_base.turn(-30)