From c15d8f0fd62d687a62aea75fd2069ecba982e95b Mon Sep 17 00:00:00 2001 From: Johannes <31liwaj@elmbrookstudents.org> Date: Wed, 7 Oct 2026 02:02:12 +0000 Subject: [PATCH] Update discovery-phase/missions/Showcase_codes.py --- discovery-phase/missions/Showcase_codes.py | 231 ++++++++++----------- 1 file changed, 114 insertions(+), 117 deletions(-) diff --git a/discovery-phase/missions/Showcase_codes.py b/discovery-phase/missions/Showcase_codes.py index a4288a1..caa2744 100644 --- a/discovery-phase/missions/Showcase_codes.py +++ b/discovery-phase/missions/Showcase_codes.py @@ -15,8 +15,8 @@ Improvements over baseline: from pybricks.tools import StopWatch, wait import umath -WHEEL_DIAMETER = 68.8 # mm — adjust to your wheel (Done) -AXLE_TRACK = 180 # mm — used only if you add turning later (Done) +WHEEL_DIAMETER = 62.4 # mm — adjust to your wheel (Done) +AXLE_TRACK = 150 # mm — used only if you add turning later (Done) LOOP_MS = 20 # fixed control loop period RAMP_MM = 50 # begin decelerating this far from target MIN_SPEED = 80 # floor speed during ramp (avoid stall) @@ -202,100 +202,8 @@ async def multilift_down(rotation_angle): ) -async def Run1(): # Flip The Rock, Lucky Leaves, Reaching Roots - Johannes +async def Run1(): # Flip The Rock, Lucky Leaves, Reaching Roots - Rishabh - await set_speed(600,200,300,200) - await drive_base.straight(500) - await multitask( - drive_base.straight(-200), - right_arm.run_angle(400,-150) - ) - await set_speed(600,500,100,200) - await drive_base.turn(45) - await drive_base.straight(346) - await drive_base.turn(-68) - await multitask( - left_arm.run_angle(600,240), - set_speed(300,200,300,200), - drive_base.straight(280) - ) - await left_arm.run_angle(600,-100) - await drive_base.turn(22) - await drive_base.straight(-100) - await right_arm.run_angle(5000,45) - await set_speed(600,500,100,200) - await drive_base.straight(200) - await drive_base.arc(-1500,None,-1000) - -async def Run2(): # Exploding Seeds - Johannes - - await multitask( - right_arm.run_angle(400,-100), - left_arm.run_angle(300,100), - drive_base.arc(150,None,115) - ) - await drive_base.straight(270) - await left_arm.run_angle(300,-100) - await drive_base.straight(-100) - await left_arm.run_angle(300,-100) - await drive_base.arc(-1000,None,-800) - - -async def Run2_1(): # Drone Survey, Experimental - Johannes - - await multitask( - right_arm.run_angle(400,100), - set_speed(600,200,300,200), - drive_base.straight(300) - ) - set_speed(600,500,300,200) - await drive_base.straight(470) - await drive_base.turn(-15) - await drive_base.straight(55) - await drive_base.straight(-280) - await drive_base.turn(15) - await right_arm.run_angle(400,-100) - await drive_base.straight(40) - await drive_base.turn(-15) - await drive_base.straight(50) - await drive_base.turn(-25) - - -async def Run3(): # Window to the Past, Leaf Cutter, Humongous Fungus, Experimental - Johannes - - await drive_base.straight(98) - await drive_base.turn(-45) - await drive_base.straight(300) - await right_arm.run_angle(300,120) - await drive_base.straight(290) - await drive_base.turn(50) - await drive_base.straight(250) - await drive_base.turn(40) - set_speed(100,200,300,200) - await drive_base.straight(177) - await drive_base.straight(-145) - await drive_base.turn(85) - await drive_base.straight(232) - set_speed(600, 500, 300, 200) - await drive_base.straight(-138) - await multitask( - drive_base.turn(-36), - right_arm.run_angle(200,-140) - ) - set_speed(100,200,300,200) - await drive_base.straight(230) - await right_arm.run_angle(300,105) - await wait(200) - await drive_base.turn(-90) - await drive_base.straight(-170) - set_speed(600,500,300,200) - await drive_base.straight(100) - await drive_base.arc(800,None,-900) - - -async def Run4(): #Flip the Rock, Lucky Leaves, Reaching Roots - Rishabh - - #Run await drive_base.straight(550)#Works (600(Previous)) await drive_base.straight(-200) await drive_base.turn(45) @@ -311,17 +219,99 @@ async def Run4(): #Flip the Rock, Lucky Leaves, Reaching Roots - Rishabh await drive_base.turn(30) await drive_base.straight(-1000) +async def Run2(): # Exploding Seeds - Johannes -async def Run5(): + await multitask( + right_arm.run_angle(400,-100), + drive_base.arc(150,None,115), + ) + await drive_base.straight(270) + await left_arm.run_angle(300,-80) + await drive_base.straight(-100) + await left_arm.run_angle(300,-100) + await drive_base.arc(-1000,None,-800) -async def Run6_7(): +async def Run3(): # Drone Survey - Johannes + + await multitask( + left_arm.run_angle(400,-300), + right_arm.run_angle(400,100), + drive_base.straight(900) + ) + await drive_base.turn(-25) + await drive_base.straight(110) + await drive_base.turn(-35) + await drive_base.turn(35) + await drive_base.straight(-30) + await drive_base.turn(25) + await drive_base.straight(-200) + await drive_base.turn(-45) + await drive_base.straight(500) + await drive_base.turn(75) + await drive_base.straight(700) -async def Run10(): - +async def Run4(): # Window to the Past, Leaf Cutter, Humongous Fungus, Experimental - Johannes -async def Run11(): # Interchangable Mission - Parthiv + await drive_base.straight(110) + await drive_base.turn(-45) + await drive_base.straight(280) + await right_arm.run_angle(300,120) + await left_arm.run_angle(400,200) + await drive_base.straight(-70) + await left_arm.run_angle(600,-110) + await drive_base.straight(370) + await drive_base.turn(50) + await multitask( + drive_base.straight(250), + left_arm.run_angle(600,-60) + ) + await drive_base.turn(40) + set_speed(100,200,300,200) + await drive_base.straight(170) + await drive_base.straight(-135) + await drive_base.turn(80) + await drive_base.straight(85) + await multitask( + drive_base.turn(-36), + right_arm.run_angle(200,-140) + ) + set_speed(100,200,300,200) + await drive_base.straight(235) + await multitask( + right_arm.run_angle(300,100), + left_arm.run_angle(200,140) + ) + await wait(200) + await drive_base.straight(30) + await drive_base.turn(-90) + await drive_base.straight(-170) + set_speed(600,500,300,200) + await drive_base.straight(100) + await drive_base.arc(800,None,-900) + + +async def Run5(): # Forest Elder - Parthiv + + await drive_base.straight(475) + await right_arm.run_angle(300,25) + await drive_base.turn(-20) + await left_arm.run_angle(200,245) + await drive_base.straight(60) + await drive_base.turn(25) + await left_arm.run_angle(100,-56.5) + await drive_base.straight(-50) + await drive_base.straight(50) + await drive_base.turn(-25) + await left_arm.run_angle(200,-200) + await drive_base.straight(-240) + await drive_base.turn(15) + await right_arm.run_angle(200,-200) + await drive_base.straight(-200) + await drive_base.stop + +async def Run6(): # Interchangable Mission - Parthiv await left_arm.run_angle(200,-80) await drive_base.arc(-350,angle=90) @@ -340,11 +330,15 @@ async def Run11(): # Interchangable Mission - Parthiv await drive_base.straight(-775) await drive_base.stop -async def Run12(): # Experimental Research Platform Lifter +async def Run7(): # Seed Dispersal - Parthiv + + set_speed(700,500,400,200) + await drive_base.straight(490) + await left_arm.run_angle(50,100) + await drive_base.straight(-490) + + - await multilift_up(1200) - await multilift_down(300) - await drive_base.straight(50) # Function to classify color based on HSV @@ -352,9 +346,9 @@ def detect_color(h, s, v, reflected): if reflected > 4: if h < 4 or h > 350: # red return "Red" - elif 3 < h < 40 and s > 70: # orange + elif 3 < h < 24 and s > 80: # orange return "Orange" - elif 47 < h < 56: # yellow + elif 30 < h < 60 and v > 50: # yellow return "Yellow" elif 70 < h < 160: # green - do it vertically not horizontally for accuracy return "Green" @@ -364,7 +358,8 @@ def detect_color(h, s, v, reflected): return "Blue" elif 260 < h < 350: # purple return "Purple" - + elif s < 15 and v > 70: # white + return "White" else: return "Unknown" return "Unknown" @@ -384,26 +379,28 @@ async def main(): if color == "Green": - print('Running Mission 1') + print('Running Mission 1, Detect Green') await Run1() elif color == "Red": - print('Running Mission 2') + print('Running Mission 2, Detect Red') await Run2() elif color == "Yellow": - print('Running Mission 3') + print('Running Mission 3, Detect Yellow') await Run3() elif color == "Blue": - print('Running Mission 4') + print('Running Mission 4, Detect Blue') await Run4() elif color == "Orange": - print('Running Mission 5') - await Run3() + print('Running Mission 5, Detect Orange') + await Run5() elif color == "Purple": - print('Running Mission 11') - await Run11() + print('Running Mission 6, Detect Purple') + await Run6() elif color == "Light_Blue": - print("Running Mission 12") - await Run12() + print('Running Mission 7, Detect Cyan') + await Run7() + elif color == "White": + print('Detect White') else: print(f"Unknown color detected (Hue: {h}, Sat: {s}, Val: {v})") #pass