Compare commits
23 Commits
do-not-mer
...
7e2dc0b7c9
| Author | SHA1 | Date | |
|---|---|---|---|
| 7e2dc0b7c9 | |||
| 29bd9f0e23 | |||
| a3b04d3e00 | |||
| 2d9eb496a3 | |||
| 42090eae56 | |||
| f7072a6207 | |||
| 3f37e7e2ff | |||
| a3e7be20d1 | |||
| c2204e71ab | |||
| 0664a619b3 | |||
| 227619df49 | |||
| 684447c01a | |||
| 95d7c0c2a3 | |||
| 7e0c3d24c1 | |||
| f190d38426 | |||
| cd21a73f82 | |||
| 0fa10194c2 | |||
| bb89e01aa1 | |||
| c690ae451b | |||
| d309b0098f | |||
| 37fb0a647e | |||
| e895fd1d2c | |||
| 70e09fb42b |
116
final/1main.py
Normal file
116
final/1main.py
Normal file
@@ -0,0 +1,116 @@
|
|||||||
|
|
||||||
|
from pybricks.hubs import PrimeHub
|
||||||
|
from pybricks.pupdevices import Motor, ColorSensor
|
||||||
|
from pybricks.parameters import Port, Stop, Color, Direction
|
||||||
|
from pybricks.robotics import DriveBase
|
||||||
|
from pybricks.tools import wait, StopWatch, multitask, run_task
|
||||||
|
import asyncio
|
||||||
|
|
||||||
|
hub = PrimeHub()
|
||||||
|
left_motor = Motor(Port.A, Direction.COUNTERCLOCKWISE)
|
||||||
|
right_motor = Motor(Port.B)
|
||||||
|
atarm1 = Motor(Port.E, Direction.COUNTERCLOCKWISE)
|
||||||
|
atarm2 = Motor(Port.F)
|
||||||
|
drive_base = DriveBase(left_motor, right_motor, wheel_diameter=56, axle_track=112)
|
||||||
|
color_sensor = ColorSensor(Port.C)
|
||||||
|
|
||||||
|
drive_base.settings(300, 500, 300, 200)
|
||||||
|
Color.ORANGE = Color(10, 100, 100)
|
||||||
|
Color.MAGENTA = Color(321, 100, 86)
|
||||||
|
|
||||||
|
|
||||||
|
async def Run1():
|
||||||
|
left_arm.run_angle(1000, 300)
|
||||||
|
right_arm.run_angle(1000,500)
|
||||||
|
await drive_base.straight(320)
|
||||||
|
|
||||||
|
await right_arm.run_angle(5000,-500, Stop.HOLD)
|
||||||
|
await right_arm.run_angle(5000,500, Stop.HOLD)
|
||||||
|
await right_arm.run_angle(5000,-500, Stop.HOLD)
|
||||||
|
await right_arm.run_angle(5000,500, Stop.HOLD)
|
||||||
|
await right_arm.run_angle(5000,-500, Stop.HOLD)
|
||||||
|
|
||||||
|
await drive_base.turn(-20)
|
||||||
|
await drive_base.straight(275)
|
||||||
|
await drive_base.turn(20)
|
||||||
|
await drive_base.straight(63)
|
||||||
|
|
||||||
|
await drive_base.turn(-30)
|
||||||
|
right_arm.run_angle(50,500)
|
||||||
|
await drive_base.turn(45)
|
||||||
|
await drive_base.straight(-135)
|
||||||
|
await drive_base.turn(-60)
|
||||||
|
await drive_base.straight(90)
|
||||||
|
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(-500)
|
||||||
|
|
||||||
|
async def Run2():
|
||||||
|
await drive_base.straight(200)
|
||||||
|
await drive_base.turn(-20)
|
||||||
|
await drive_base.straight(525)
|
||||||
|
await drive_base.turn(60)
|
||||||
|
|
||||||
|
await drive_base.straight(50)
|
||||||
|
await right_arm.run_angle(2000,1000)
|
||||||
|
await drive_base.straight(-50)
|
||||||
|
await drive_base.turn(45)
|
||||||
|
await drive_base.straight(50)
|
||||||
|
await right_arm.run_angle(350,-1000)
|
||||||
|
|
||||||
|
await drive_base.turn(-100)
|
||||||
|
await drive_base.straight(-600)
|
||||||
|
|
||||||
|
|
||||||
|
async def Run3():
|
||||||
|
await drive_base.straight(915)
|
||||||
|
await drive_base.turn(-90)
|
||||||
|
await drive_base.straight(60)
|
||||||
|
await left_arm.run_angle(10000,-15000)
|
||||||
|
await drive_base.straight(-60)
|
||||||
|
await drive_base.turn(85)
|
||||||
|
await drive_base.straight(2000)
|
||||||
|
|
||||||
|
|
||||||
|
async def Run5():
|
||||||
|
await drive_base.straight(420)
|
||||||
|
await right_arm.run_angle(300,-100)
|
||||||
|
await drive_base.straight(-100)
|
||||||
|
await right_arm.run_angle(300, 100)
|
||||||
|
await drive_base.straight(-350)
|
||||||
|
|
||||||
|
|
||||||
|
async def Run6():
|
||||||
|
await drive_base.straight(420)
|
||||||
|
await right_arm.run_angle(300,-100)
|
||||||
|
await drive_base.straight(-100)
|
||||||
|
await right_arm.run_angle(300, 100)
|
||||||
|
await drive_base.straight(-350)
|
||||||
|
|
||||||
|
|
||||||
|
async def main():
|
||||||
|
if color_sensor.color() == Color.ORANGE:
|
||||||
|
await Run1()
|
||||||
|
|
||||||
|
if color_sensor.color() == Color.GREEN:
|
||||||
|
await Run2()
|
||||||
|
|
||||||
|
if color_sensor.color() == Color.WHITE:
|
||||||
|
await Run3()
|
||||||
|
|
||||||
|
if color_sensor.color() == Color.YELLOW:
|
||||||
|
await Run5()
|
||||||
|
|
||||||
|
if color_sensor.color() == Color.BLUE:
|
||||||
|
await Run6()
|
||||||
|
|
||||||
|
|
||||||
|
print(f'Detected color: {color_sensor.color()}')
|
||||||
|
|
||||||
|
# Main execution loop
|
||||||
|
while True:
|
||||||
|
run_task(main())
|
||||||
|
wait(100)
|
||||||
113
final/2main.py
Normal file
113
final/2main.py
Normal file
@@ -0,0 +1,113 @@
|
|||||||
|
|
||||||
|
from pybricks.hubs import PrimeHub
|
||||||
|
from pybricks.pupdevices import Motor, ColorSensor
|
||||||
|
from pybricks.parameters import Port, Stop, Color, Direction
|
||||||
|
from pybricks.robotics import DriveBase
|
||||||
|
from pybricks.tools import wait, StopWatch, multitask, run_task
|
||||||
|
|
||||||
|
|
||||||
|
left_motor = Motor(Port.A, Direction.COUNTERCLOCKWISE)
|
||||||
|
right_motor = Motor(Port.B)
|
||||||
|
left_arm = Motor(Port.C, Direction.COUNTERCLOCKWISE)
|
||||||
|
right_arm = Motor(Port.D)
|
||||||
|
|
||||||
|
drive_base = DriveBase(left_motor, right_motor, wheel_diameter=68.8, axle_track=180)
|
||||||
|
|
||||||
|
drive_base.settings(550,700,100,100)
|
||||||
|
|
||||||
|
drive_base.use_gyro(True)
|
||||||
|
|
||||||
|
async def Run1():
|
||||||
|
left_arm.run_angle(1000, 300)
|
||||||
|
right_arm.run_angle(1000,500)
|
||||||
|
await drive_base.straight(320)
|
||||||
|
|
||||||
|
await right_arm.run_angle(5000,-500, Stop.HOLD)
|
||||||
|
await right_arm.run_angle(5000,500, Stop.HOLD)
|
||||||
|
await right_arm.run_angle(5000,-500, Stop.HOLD)
|
||||||
|
await right_arm.run_angle(5000,500, Stop.HOLD)
|
||||||
|
await right_arm.run_angle(5000,-500, Stop.HOLD)
|
||||||
|
|
||||||
|
await drive_base.turn(-20)
|
||||||
|
await drive_base.straight(275)
|
||||||
|
await drive_base.turn(20)
|
||||||
|
await drive_base.straight(63)
|
||||||
|
|
||||||
|
await drive_base.turn(-30)
|
||||||
|
right_arm.run_angle(50,500)
|
||||||
|
await drive_base.turn(45)
|
||||||
|
await drive_base.straight(-135)
|
||||||
|
await drive_base.turn(-60)
|
||||||
|
await drive_base.straight(90)
|
||||||
|
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(-500)
|
||||||
|
|
||||||
|
async def Run2():
|
||||||
|
await drive_base.straight(200)
|
||||||
|
await drive_base.turn(-20)
|
||||||
|
await drive_base.straight(525)
|
||||||
|
await drive_base.turn(60)
|
||||||
|
|
||||||
|
await drive_base.straight(50)
|
||||||
|
await right_arm.run_angle(2000,1000)
|
||||||
|
await drive_base.straight(-50)
|
||||||
|
await drive_base.turn(45)
|
||||||
|
await drive_base.straight(50)
|
||||||
|
await right_arm.run_angle(350,-1000)
|
||||||
|
|
||||||
|
await drive_base.turn(-100)
|
||||||
|
await drive_base.straight(-600)
|
||||||
|
|
||||||
|
|
||||||
|
async def Run3():
|
||||||
|
await drive_base.straight(915)
|
||||||
|
await drive_base.turn(-90)
|
||||||
|
await drive_base.straight(60)
|
||||||
|
await left_arm.run_angle(10000,-15000)
|
||||||
|
await drive_base.straight(-60)
|
||||||
|
await drive_base.turn(85)
|
||||||
|
await drive_base.straight(2000)
|
||||||
|
|
||||||
|
|
||||||
|
async def Run5():
|
||||||
|
await drive_base.straight(420)
|
||||||
|
await right_arm.run_angle(300,-100)
|
||||||
|
await drive_base.straight(-100)
|
||||||
|
await right_arm.run_angle(300, 100)
|
||||||
|
await drive_base.straight(-350)
|
||||||
|
|
||||||
|
|
||||||
|
async def Run6():
|
||||||
|
await drive_base.straight(420)
|
||||||
|
await right_arm.run_angle(300,-100)
|
||||||
|
await drive_base.straight(-100)
|
||||||
|
await right_arm.run_angle(300, 100)
|
||||||
|
await drive_base.straight(-350)
|
||||||
|
|
||||||
|
|
||||||
|
def main():
|
||||||
|
if color_sensor.color() == Color.GREEN:
|
||||||
|
Run1()
|
||||||
|
|
||||||
|
if color_sensor.color() == Color.WHITE:
|
||||||
|
Run2()
|
||||||
|
|
||||||
|
if color_sensor.color() == Color.YELLOW:
|
||||||
|
Run3()
|
||||||
|
|
||||||
|
if color_sensor.color() == Color.BLUE:
|
||||||
|
Run5()
|
||||||
|
|
||||||
|
if color_sensor.color() == Color.RED:
|
||||||
|
Run6()
|
||||||
|
|
||||||
|
print(f'Detected color: {color_sensor.color()}')
|
||||||
|
|
||||||
|
# Main execution loop
|
||||||
|
while True:
|
||||||
|
main()
|
||||||
|
wait(100)
|
||||||
102
final/3main.py
Normal file
102
final/3main.py
Normal file
@@ -0,0 +1,102 @@
|
|||||||
|
from pybricks.hubs import PrimeHub
|
||||||
|
from pybricks.pupdevices import Motor, ColorSensor
|
||||||
|
from pybricks.parameters import Port, Stop, Color, Direction
|
||||||
|
from pybricks.robotics import DriveBase
|
||||||
|
from pybricks.tools import wait, StopWatch, multitask, run_task
|
||||||
|
|
||||||
|
async def Run1():
|
||||||
|
await multitask(left_arm.run_angle(1000, 300), right_arm.run_angle(1000,500))
|
||||||
|
await drive_base.straight(320)
|
||||||
|
|
||||||
|
await right_arm.run_angle(5000,-500, Stop.HOLD)
|
||||||
|
await right_arm.run_angle(5000,500, Stop.HOLD)
|
||||||
|
await right_arm.run_angle(5000,-500, Stop.HOLD)
|
||||||
|
await right_arm.run_angle(5000,500, Stop.HOLD)
|
||||||
|
await right_arm.run_angle(5000,-500, Stop.HOLD)
|
||||||
|
|
||||||
|
await drive_base.turn(-20)
|
||||||
|
await drive_base.straight(275)
|
||||||
|
await drive_base.turn(20)
|
||||||
|
await drive_base.straight(63)
|
||||||
|
|
||||||
|
await multitask(drive_base.turn(-30), right_arm.run_angle(50,500))
|
||||||
|
await drive_base.turn(45)
|
||||||
|
await drive_base.straight(-135)
|
||||||
|
await drive_base.turn(-60)
|
||||||
|
await drive_base.straight(90)
|
||||||
|
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(-500)
|
||||||
|
|
||||||
|
async def Run2():
|
||||||
|
await drive_base.straight(200)
|
||||||
|
await drive_base.turn(-20)
|
||||||
|
await drive_base.straight(525)
|
||||||
|
await drive_base.turn(60)
|
||||||
|
|
||||||
|
await drive_base.straight(50)
|
||||||
|
await right_arm.run_angle(2000,1000)
|
||||||
|
await drive_base.straight(-50)
|
||||||
|
await drive_base.turn(45)
|
||||||
|
await drive_base.straight(50)
|
||||||
|
await right_arm.run_angle(350,-1000)
|
||||||
|
|
||||||
|
await drive_base.turn(-100)
|
||||||
|
await drive_base.straight(-600)
|
||||||
|
|
||||||
|
async def Run3():
|
||||||
|
await drive_base.straight(915)
|
||||||
|
await drive_base.turn(-90)
|
||||||
|
await drive_base.straight(60)
|
||||||
|
await left_arm.run_angle(10000,-15000)
|
||||||
|
await drive_base.straight(-60)
|
||||||
|
await drive_base.turn(85)
|
||||||
|
await drive_base.straight(2000)
|
||||||
|
|
||||||
|
async def Run5():
|
||||||
|
await drive_base.straight(420)
|
||||||
|
await right_arm.run_angle(300,-100)
|
||||||
|
await drive_base.straight(-100)
|
||||||
|
await right_arm.run_angle(300, 100)
|
||||||
|
await drive_base.straight(-350)
|
||||||
|
|
||||||
|
|
||||||
|
async def Run6():
|
||||||
|
await drive_base.straight(420)
|
||||||
|
await right_arm.run_angle(300,-100)
|
||||||
|
await drive_base.straight(-100)
|
||||||
|
await right_arm.run_angle(300, 100)
|
||||||
|
await drive_base.straight(-350)
|
||||||
|
|
||||||
|
async def main():
|
||||||
|
while True:
|
||||||
|
detected_color = color_sensor.color(True)
|
||||||
|
|
||||||
|
if detected_color == Color.GREEN:
|
||||||
|
print('Detected color: Green')
|
||||||
|
await Run1()
|
||||||
|
|
||||||
|
elif detected_color == Color.WHITE:
|
||||||
|
print('Detected color: White')
|
||||||
|
await Run2()
|
||||||
|
|
||||||
|
elif detected_color == Color.YELLOW:
|
||||||
|
print('Detected color: Yellow')
|
||||||
|
await Run3()
|
||||||
|
|
||||||
|
elif detected_color == Color.BLUE:
|
||||||
|
print('Detected color: Blue')
|
||||||
|
await Run5()
|
||||||
|
|
||||||
|
elif detected_color == Color.RED:
|
||||||
|
print('Detected color: Red')
|
||||||
|
await Run6()
|
||||||
|
|
||||||
|
else:
|
||||||
|
print("None detected")
|
||||||
|
|
||||||
|
# Main execution
|
||||||
|
run_task(main())
|
||||||
227
final/main4.py
Normal file
227
final/main4.py
Normal file
@@ -0,0 +1,227 @@
|
|||||||
|
from pybricks.hubs import PrimeHub
|
||||||
|
from pybricks.pupdevices import Motor, ColorSensor
|
||||||
|
from pybricks.parameters import Port, Stop, Color, Direction
|
||||||
|
from pybricks.robotics import DriveBase
|
||||||
|
from pybricks.tools import wait, StopWatch, multitask, run_task
|
||||||
|
|
||||||
|
hub = PrimeHub()
|
||||||
|
left_motor = Motor(Port.A, Direction.COUNTERCLOCKWISE)
|
||||||
|
right_motor = Motor(Port.B)
|
||||||
|
left_arm = Motor(Port.C, Direction.COUNTERCLOCKWISE)
|
||||||
|
right_arm = Motor(Port.D)
|
||||||
|
drive_base = DriveBase(left_motor, right_motor, wheel_diameter=68.8, axle_track=180)
|
||||||
|
drive_base.settings(550,700,100,100)
|
||||||
|
drive_base.use_gyro(True)
|
||||||
|
color_sensor = ColorSensor(Port.F)
|
||||||
|
hub.speaker.volume(50) # Set the volume of the speaker
|
||||||
|
|
||||||
|
async def Run1():
|
||||||
|
left_arm.run_angle(1000, 300)
|
||||||
|
right_arm.run_angle(1000,500)
|
||||||
|
await drive_base.straight(320)
|
||||||
|
await right_arm.run_angle(5000,-500, Stop.HOLD)
|
||||||
|
await right_arm.run_angle(5000,500, Stop.HOLD)
|
||||||
|
await right_arm.run_angle(5000,-500, Stop.HOLD)
|
||||||
|
await right_arm.run_angle(5000,500, Stop.HOLD)
|
||||||
|
await right_arm.run_angle(5000,-500, Stop.HOLD)
|
||||||
|
await drive_base.turn(-20)
|
||||||
|
await drive_base.straight(277)
|
||||||
|
await drive_base.turn(20)
|
||||||
|
await drive_base.straight(65)
|
||||||
|
await drive_base.turn(-30)
|
||||||
|
right_arm.run_angle(50,500)
|
||||||
|
await drive_base.turn(45)
|
||||||
|
await drive_base.straight(-145)
|
||||||
|
await drive_base.turn(-60)
|
||||||
|
await drive_base.straight(90)
|
||||||
|
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():
|
||||||
|
await drive_base.straight(200)
|
||||||
|
await drive_base.turn(-20)
|
||||||
|
await drive_base.straight(525)
|
||||||
|
await drive_base.turn(60)
|
||||||
|
await drive_base.straight(50)
|
||||||
|
await right_arm.run_angle(2000,1000)
|
||||||
|
await drive_base.straight(-50)
|
||||||
|
await drive_base.turn(45)
|
||||||
|
await drive_base.straight(50)
|
||||||
|
await right_arm.run_angle(350,-1000)
|
||||||
|
await drive_base.straight(-100)
|
||||||
|
await drive_base.turn(-100)
|
||||||
|
await drive_base.straight(-600)
|
||||||
|
async def Run3():
|
||||||
|
await drive_base.straight(920)
|
||||||
|
await drive_base.turn(-90,Stop.HOLD)
|
||||||
|
await drive_base.straight(65)
|
||||||
|
drive_base.turn(-10)
|
||||||
|
await left_arm.run_angle(10000,-4000)
|
||||||
|
await drive_base.straight(-100)
|
||||||
|
await drive_base.turn(90)
|
||||||
|
await drive_base.straight(2000)
|
||||||
|
async def Run5():
|
||||||
|
await drive_base.straight(420)
|
||||||
|
await right_arm.run_angle(300,-100)
|
||||||
|
await drive_base.straight(-100)
|
||||||
|
await right_arm.run_angle(300, 100)
|
||||||
|
await drive_base.straight(-350)
|
||||||
|
async def Run6():
|
||||||
|
await drive_base.straight(420)
|
||||||
|
await right_arm.run_angle(300,-100)
|
||||||
|
await drive_base.straight(-100)
|
||||||
|
await right_arm.run_angle(300, 100)
|
||||||
|
await drive_base.straight(-350)
|
||||||
|
# Celebration sound types
|
||||||
|
class CelebrationSound:
|
||||||
|
VICTORY_FANFARE = 0
|
||||||
|
LEVEL_UP = 1
|
||||||
|
SUCCESS_CHIME = 2
|
||||||
|
TA_DA = 3
|
||||||
|
POWER_UP = 4
|
||||||
|
RICKROLL_INSPIRED = 5
|
||||||
|
|
||||||
|
async def play_victory_fanfare():
|
||||||
|
"""Classic victory fanfare"""
|
||||||
|
notes = [
|
||||||
|
(262, 200), # C4
|
||||||
|
(262, 200), # C4
|
||||||
|
(262, 200), # C4
|
||||||
|
(349, 600), # F4
|
||||||
|
]
|
||||||
|
|
||||||
|
for freq, duration in notes:
|
||||||
|
await hub.speaker.beep(freq, duration)
|
||||||
|
await wait(50)
|
||||||
|
async def play_level_up():
|
||||||
|
"""Upward scale for level completion"""
|
||||||
|
notes = [
|
||||||
|
(262, 100), # C4
|
||||||
|
(294, 100), # D4
|
||||||
|
(330, 100), # E4
|
||||||
|
(349, 100), # F4
|
||||||
|
(392, 100), # G4
|
||||||
|
(440, 100), # A4
|
||||||
|
(494, 100), # B4
|
||||||
|
(523, 300), # C5
|
||||||
|
]
|
||||||
|
|
||||||
|
for freq, duration in notes:
|
||||||
|
await hub.speaker.beep(freq, duration)
|
||||||
|
await wait(20)
|
||||||
|
async def play_success_chime():
|
||||||
|
"""Simple success notification"""
|
||||||
|
notes = [
|
||||||
|
(523, 150), # C5
|
||||||
|
(659, 150), # E5
|
||||||
|
(784, 300), # G5
|
||||||
|
]
|
||||||
|
|
||||||
|
for freq, duration in notes:
|
||||||
|
await hub.speaker.beep(freq, duration)
|
||||||
|
await wait(50)
|
||||||
|
async def play_ta_da():
|
||||||
|
"""Classic "ta-da!" sound"""
|
||||||
|
notes = [
|
||||||
|
(392, 200), # G4
|
||||||
|
(523, 400), # C5
|
||||||
|
]
|
||||||
|
|
||||||
|
for freq, duration in notes:
|
||||||
|
await hub.speaker.beep(freq, duration)
|
||||||
|
await wait(100)
|
||||||
|
async def play_power_up():
|
||||||
|
"""Rising power-up sound"""
|
||||||
|
for freq in range(200, 800, 50):
|
||||||
|
await hub.speaker.beep(freq, 50)
|
||||||
|
await wait(10)
|
||||||
|
await hub.speaker.beep(1000, 200)
|
||||||
|
async def play_rickroll_inspired():
|
||||||
|
"""Fun 80s-style dance beat inspired sound"""
|
||||||
|
# Upbeat bouncy rhythm
|
||||||
|
pattern = [
|
||||||
|
(392, 200), (440, 200), (494, 200), (523, 200),
|
||||||
|
(440, 200), (392, 200), (349, 200), (392, 300),
|
||||||
|
(440, 200), (392, 200), (349, 200), (330, 400),
|
||||||
|
]
|
||||||
|
|
||||||
|
for freq, duration in pattern:
|
||||||
|
await hub.speaker.beep(freq, duration)
|
||||||
|
await wait(50)
|
||||||
|
async def celebrate_mission_complete(sound_type=CelebrationSound.SUCCESS_CHIME):
|
||||||
|
"""
|
||||||
|
Main celebration function to call after completing a mission.
|
||||||
|
Plays a sound and shows light animation.
|
||||||
|
|
||||||
|
Args:
|
||||||
|
sound_type: CelebrationSound enum value (default: SUCCESS_CHIME)
|
||||||
|
"""
|
||||||
|
# Light show
|
||||||
|
hub.light.on(Color.GREEN)
|
||||||
|
|
||||||
|
# Play the selected celebration sound
|
||||||
|
if sound_type == CelebrationSound.VICTORY_FANFARE:
|
||||||
|
await play_victory_fanfare()
|
||||||
|
elif sound_type == CelebrationSound.LEVEL_UP:
|
||||||
|
await play_level_up()
|
||||||
|
elif sound_type == CelebrationSound.SUCCESS_CHIME:
|
||||||
|
await play_success_chime()
|
||||||
|
elif sound_type == CelebrationSound.TA_DA:
|
||||||
|
await play_ta_da()
|
||||||
|
elif sound_type == CelebrationSound.POWER_UP:
|
||||||
|
await play_power_up()
|
||||||
|
elif sound_type == CelebrationSound.RICKROLL_INSPIRED:
|
||||||
|
await play_rickroll_inspired()
|
||||||
|
else:
|
||||||
|
await play_success_chime() # Default fallback
|
||||||
|
|
||||||
|
# Blink the light
|
||||||
|
for _ in range(3):
|
||||||
|
hub.light.off()
|
||||||
|
await wait(100)
|
||||||
|
hub.light.on(Color.GREEN)
|
||||||
|
await wait(100)
|
||||||
|
|
||||||
|
hub.light.off()
|
||||||
|
|
||||||
|
async def main():
|
||||||
|
while True:
|
||||||
|
|
||||||
|
await celebrate_mission_complete(CelebrationSound.LEVEL_UP)
|
||||||
|
color_reflected_percent = await color_sensor.reflection()
|
||||||
|
print(color_reflected_percent)
|
||||||
|
|
||||||
|
color_detected = await color_sensor.color()
|
||||||
|
print(f'Detected color: {color_detected}')
|
||||||
|
|
||||||
|
if color_detected == Color.GREEN:
|
||||||
|
print('Running Mission 1')
|
||||||
|
await Run1()
|
||||||
|
await celebrate_mission_complete(CelebrationSound.VICTORY_FANFARE)
|
||||||
|
elif color_detected == Color.WHITE:
|
||||||
|
print('Running Mission 2')
|
||||||
|
await Run2()
|
||||||
|
await celebrate_mission_complete(CelebrationSound.RICKROLL_INSPIRED)
|
||||||
|
elif color_detected == Color.YELLOW:
|
||||||
|
print('Running Mission 3')
|
||||||
|
await Run3()
|
||||||
|
await celebrate_mission_complete(CelebrationSound.SUCCESS_CHIME)
|
||||||
|
elif color_detected == Color.BLUE:
|
||||||
|
print('Running Mission 5')
|
||||||
|
await Run5()
|
||||||
|
await celebrate_mission_complete(CelebrationSound.POWER_UP)
|
||||||
|
elif color_detected == Color.RED:
|
||||||
|
print('Running Mission 6')
|
||||||
|
await Run6()
|
||||||
|
await celebrate_mission_complete(CelebrationSound.LEVEL_UP)
|
||||||
|
else:
|
||||||
|
hub.light.off()
|
||||||
|
left_motor.stop()
|
||||||
|
right_motor.stop()
|
||||||
|
await wait(100) #prevent loop from iterating fast
|
||||||
|
|
||||||
|
# Main execution loop
|
||||||
|
run_task(main())
|
||||||
278
final/main5.py
Normal file
278
final/main5.py
Normal file
@@ -0,0 +1,278 @@
|
|||||||
|
from pybricks.hubs import PrimeHub
|
||||||
|
from pybricks.pupdevices import Motor, ColorSensor
|
||||||
|
from pybricks.parameters import Port, Stop, Color, Direction
|
||||||
|
from pybricks.robotics import DriveBase
|
||||||
|
from pybricks.tools import wait, StopWatch, multitask, run_task
|
||||||
|
|
||||||
|
hub = PrimeHub()
|
||||||
|
left_motor = Motor(Port.A, Direction.COUNTERCLOCKWISE)
|
||||||
|
right_motor = Motor(Port.B)
|
||||||
|
left_arm = Motor(Port.C)#, Direction.COUNTERCLOCKWISE)
|
||||||
|
right_arm = Motor(Port.D)
|
||||||
|
drive_base = DriveBase(left_motor, right_motor, wheel_diameter=68.8, axle_track=180)
|
||||||
|
drive_base.settings(550,700,100,100)
|
||||||
|
drive_base.use_gyro(True)
|
||||||
|
color_sensor = ColorSensor(Port.F)
|
||||||
|
Color.ORANGE = Color(37, 85, 95)
|
||||||
|
Color.BLUE = Color(230,100,100)
|
||||||
|
color_sensor.detectable_colors([Color.ORANGE, Color.BLUE, Color.GREEN, Color.WHITE, Color.RED, Color.YELLOW])
|
||||||
|
hub.speaker.volume(50) # Set the volume of the speaker
|
||||||
|
color_sensor.detectable_colors()
|
||||||
|
# Celebration sound types
|
||||||
|
class CelebrationSound:
|
||||||
|
VICTORY_FANFARE = 0
|
||||||
|
LEVEL_UP = 1
|
||||||
|
SUCCESS_CHIME = 2
|
||||||
|
TA_DA = 3
|
||||||
|
POWER_UP = 4
|
||||||
|
RICKROLL_INSPIRED = 5
|
||||||
|
|
||||||
|
async def play_victory_fanfare():
|
||||||
|
"""Classic victory fanfare"""
|
||||||
|
notes = [
|
||||||
|
(262, 200), # C4
|
||||||
|
(262, 200), # C4
|
||||||
|
(262, 200), # C4
|
||||||
|
(349, 600), # F4
|
||||||
|
]
|
||||||
|
|
||||||
|
for freq, duration in notes:
|
||||||
|
await hub.speaker.beep(freq, duration)
|
||||||
|
await wait(50)
|
||||||
|
async def play_level_up():
|
||||||
|
"""Upward scale for level completion"""
|
||||||
|
notesold = [
|
||||||
|
(262, 100), # C4
|
||||||
|
(294, 100), # D4
|
||||||
|
(330, 100), # E4
|
||||||
|
(349, 100), # F4
|
||||||
|
(392, 100), # G4
|
||||||
|
(440, 100), # A4
|
||||||
|
(494, 100), # B4
|
||||||
|
(523, 300), # C5
|
||||||
|
]
|
||||||
|
notes = [
|
||||||
|
(277, 100),
|
||||||
|
(330, 100),
|
||||||
|
(277, 100),
|
||||||
|
(554, 100),
|
||||||
|
(277, 100),
|
||||||
|
(413, 100),
|
||||||
|
(330, 100),
|
||||||
|
(277, 100),
|
||||||
|
(413, 100),
|
||||||
|
(277, 100),
|
||||||
|
(554, 100),
|
||||||
|
(413, 100),
|
||||||
|
(277, 100),
|
||||||
|
(413, 100),
|
||||||
|
(554, 100),
|
||||||
|
(413, 100)
|
||||||
|
]
|
||||||
|
|
||||||
|
for freq, duration in notes:
|
||||||
|
await hub.speaker.beep(freq, duration)
|
||||||
|
#await wait(20)
|
||||||
|
async def play_success_chime():
|
||||||
|
"""Simple success notification"""
|
||||||
|
notes = [
|
||||||
|
(523, 150), # C5
|
||||||
|
(659, 150), # E5
|
||||||
|
(784, 300), # G5
|
||||||
|
]
|
||||||
|
|
||||||
|
for freq, duration in notes:
|
||||||
|
await hub.speaker.beep(freq, duration)
|
||||||
|
await wait(50)
|
||||||
|
async def play_ta_da():
|
||||||
|
"""Classic "ta-da!" sound"""
|
||||||
|
notes = [
|
||||||
|
(392, 200), # G4
|
||||||
|
(523, 400), # C5
|
||||||
|
]
|
||||||
|
|
||||||
|
for freq, duration in notes:
|
||||||
|
await hub.speaker.beep(freq, duration)
|
||||||
|
await wait(100)
|
||||||
|
async def play_power_up():
|
||||||
|
"""Rising power-up sound"""
|
||||||
|
for freq in range(200, 800, 50):
|
||||||
|
await hub.speaker.beep(freq, 50)
|
||||||
|
await wait(10)
|
||||||
|
await hub.speaker.beep(1000, 200)
|
||||||
|
async def play_rickroll_inspired():
|
||||||
|
"""Fun 80s-style dance beat inspired sound"""
|
||||||
|
# Upbeat bouncy rhythm
|
||||||
|
pattern = [
|
||||||
|
(392, 200), (440, 200), (494, 200), (523, 200),
|
||||||
|
(440, 200), (392, 200), (349, 200), (392, 300),
|
||||||
|
(440, 200), (392, 200), (349, 200), (330, 400),
|
||||||
|
]
|
||||||
|
|
||||||
|
for freq, duration in pattern:
|
||||||
|
await hub.speaker.beep(freq, duration)
|
||||||
|
await wait(50)
|
||||||
|
async def celebrate_mission_complete(sound_type=CelebrationSound.SUCCESS_CHIME):
|
||||||
|
"""
|
||||||
|
Main celebration function to call after completing a mission.
|
||||||
|
Plays a sound and shows light animation.
|
||||||
|
|
||||||
|
Args:
|
||||||
|
sound_type: CelebrationSound enum value (default: SUCCESS_CHIME)
|
||||||
|
"""
|
||||||
|
# Light show
|
||||||
|
hub.light.on(Color.GREEN)
|
||||||
|
|
||||||
|
# Play the selected celebration sound
|
||||||
|
if sound_type == CelebrationSound.VICTORY_FANFARE:
|
||||||
|
await play_victory_fanfare()
|
||||||
|
elif sound_type == CelebrationSound.LEVEL_UP:
|
||||||
|
await play_level_up()
|
||||||
|
elif sound_type == CelebrationSound.SUCCESS_CHIME:
|
||||||
|
await play_success_chime()
|
||||||
|
elif sound_type == CelebrationSound.TA_DA:
|
||||||
|
await play_ta_da()
|
||||||
|
elif sound_type == CelebrationSound.POWER_UP:
|
||||||
|
await play_power_up()
|
||||||
|
elif sound_type == CelebrationSound.RICKROLL_INSPIRED:
|
||||||
|
await play_rickroll_inspired()
|
||||||
|
else:
|
||||||
|
await play_success_chime() # Default fallback
|
||||||
|
|
||||||
|
# Blink the light
|
||||||
|
for _ in range(3):
|
||||||
|
hub.light.off()
|
||||||
|
await wait(100)
|
||||||
|
hub.light.on(Color.GREEN)
|
||||||
|
await wait(100)
|
||||||
|
|
||||||
|
hub.light.off()
|
||||||
|
|
||||||
|
async def Run1():
|
||||||
|
await multitask(left_arm.run_angle(1000, 300), right_arm.run_angle(1000,500))
|
||||||
|
await drive_base.straight(320)
|
||||||
|
|
||||||
|
await right_arm.run_angle(5000,-500, Stop.HOLD)
|
||||||
|
await right_arm.run_angle(5000,500, Stop.HOLD)
|
||||||
|
await right_arm.run_angle(5000,-500, Stop.HOLD)
|
||||||
|
await right_arm.run_angle(5000,500, Stop.HOLD)
|
||||||
|
await right_arm.run_angle(5000,-500, Stop.HOLD)
|
||||||
|
|
||||||
|
await drive_base.turn(-20)
|
||||||
|
await drive_base.straight(275)
|
||||||
|
await drive_base.turn(20)
|
||||||
|
await drive_base.straight(63)
|
||||||
|
|
||||||
|
await multitask(drive_base.turn(-30), right_arm.run_angle(50,500))
|
||||||
|
await drive_base.turn(45)
|
||||||
|
await drive_base.straight(-135)
|
||||||
|
await drive_base.turn(-60)
|
||||||
|
await drive_base.straight(90)
|
||||||
|
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(-500)
|
||||||
|
|
||||||
|
async def Run2():
|
||||||
|
await drive_base.straight(200)
|
||||||
|
await drive_base.turn(-20)
|
||||||
|
await drive_base.straight(525)
|
||||||
|
await drive_base.turn(60)
|
||||||
|
|
||||||
|
await drive_base.straight(50)
|
||||||
|
await right_arm.run_angle(2000,1000)
|
||||||
|
await drive_base.straight(-50)
|
||||||
|
await drive_base.turn(45)
|
||||||
|
await drive_base.straight(50)
|
||||||
|
await right_arm.run_angle(350,-1000)
|
||||||
|
|
||||||
|
await drive_base.turn(-100)
|
||||||
|
await drive_base.straight(-600)
|
||||||
|
|
||||||
|
|
||||||
|
async def Run3():
|
||||||
|
await drive_base.straight(915)
|
||||||
|
await drive_base.turn(-90)
|
||||||
|
await drive_base.straight(60)
|
||||||
|
await left_arm.run_angle(10000,-15000)
|
||||||
|
await drive_base.straight(-60)
|
||||||
|
await drive_base.turn(85)
|
||||||
|
await drive_base.straight(2000)
|
||||||
|
|
||||||
|
async def Run4():
|
||||||
|
await drive_base.straight(519)
|
||||||
|
await left_arm.run_angle(300, -100)
|
||||||
|
await left_arm.run_angle(300, 500)
|
||||||
|
await drive_base.straight(180)
|
||||||
|
await drive_base.turn(-37)
|
||||||
|
await drive_base.straight(50)
|
||||||
|
await right_arm.run_angle(300, -400)
|
||||||
|
await drive_base.straight(-150)
|
||||||
|
await drive_base.turn(125)
|
||||||
|
await drive_base.straight(50)
|
||||||
|
await right_arm.run_angle(300, 400)
|
||||||
|
await drive_base.straight(-75)
|
||||||
|
await right_arm.run_angle(300, 300)
|
||||||
|
await drive_base.turn(-40)
|
||||||
|
await drive_base.straight(250)
|
||||||
|
await right_arm.run_angle(100, -300)
|
||||||
|
await drive_base.straight(30)
|
||||||
|
await right_arm.run_angle(50,-250)
|
||||||
|
await drive_base.turn(30)
|
||||||
|
await drive_base.straight(-200)
|
||||||
|
await drive_base.turn(-50)
|
||||||
|
await drive_base.straight(-800)
|
||||||
|
|
||||||
|
async def Run5():
|
||||||
|
await drive_base.straight(420)
|
||||||
|
await right_arm.run_angle(300,-100)
|
||||||
|
await drive_base.straight(-100)
|
||||||
|
await right_arm.run_angle(300, 100)
|
||||||
|
await drive_base.straight(-350)
|
||||||
|
|
||||||
|
|
||||||
|
async def Run6():
|
||||||
|
await drive_base.straight(420)
|
||||||
|
await right_arm.run_angle(300,-100)
|
||||||
|
await drive_base.straight(-100)
|
||||||
|
await right_arm.run_angle(300, 100)
|
||||||
|
await drive_base.straight(-350)
|
||||||
|
async def main():
|
||||||
|
while True:
|
||||||
|
|
||||||
|
await celebrate_mission_complete(CelebrationSound.LEVEL_UP)
|
||||||
|
color_reflected_percent = await color_sensor.reflection()
|
||||||
|
print(color_reflected_percent)
|
||||||
|
|
||||||
|
color_detected = await color_sensor.color()
|
||||||
|
print(f'Detected color: {color_detected.h}, {color_detected.s}, {color_detected.v}')
|
||||||
|
if color_reflected_percent > 0:
|
||||||
|
if color_detected == Color.GREEN:
|
||||||
|
print('Running Mission 1')
|
||||||
|
await Run1()
|
||||||
|
await celebrate_mission_complete(CelebrationSound.VICTORY_FANFARE)
|
||||||
|
elif color_detected == Color.WHITE:
|
||||||
|
print('Running Mission 2')
|
||||||
|
await Run2()
|
||||||
|
await celebrate_mission_complete(CelebrationSound.RICKROLL_INSPIRED)
|
||||||
|
elif color_detected == Color.YELLOW:
|
||||||
|
print('Running Mission 3')
|
||||||
|
await Run3()
|
||||||
|
await celebrate_mission_complete(CelebrationSound.SUCCESS_CHIME )
|
||||||
|
elif color_detected == Color.BLUE:
|
||||||
|
print('Running Mission 4')
|
||||||
|
await Run4()
|
||||||
|
await celebrate_mission_complete(CelebrationSound.POWER_UP)
|
||||||
|
elif color_detected == Color.RED:
|
||||||
|
print('Running Mission 5')
|
||||||
|
await Run5()
|
||||||
|
await celebrate_mission_complete(CelebrationSound.LEVEL_UP)
|
||||||
|
else:
|
||||||
|
hub.light.off()
|
||||||
|
left_motor.stop()
|
||||||
|
right_motor.stop()
|
||||||
|
await wait(1000) #prevent loop from iterating fast
|
||||||
|
# Main execution loop
|
||||||
|
run_task(main())
|
||||||
0
members/Ayaan.txt
Normal file
0
members/Ayaan.txt
Normal file
0
members/Carlos.txt
Normal file
0
members/Carlos.txt
Normal file
7
members/Johannes
Normal file
7
members/Johannes
Normal file
@@ -0,0 +1,7 @@
|
|||||||
|
I am Johannes
|
||||||
|
|
||||||
|
I am the building manager for the team. I like making art.
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
Parthiv, Diddy will touch you tonight.
|
||||||
1
members/Vickram.txt
Normal file
1
members/Vickram.txt
Normal file
@@ -0,0 +1 @@
|
|||||||
|
Hello my name is Vickram and I like coding and video games.
|
||||||
@@ -1,5 +1,5 @@
|
|||||||
# Guys please use the same setup code and put into the imports for consistency
|
# Guys please use the same setup code and put into the imports for consistency
|
||||||
script_names = ["untitled14.py", "untitled13.py"] # This is a list of the files of the mission runs
|
script_names = ["Run1.py", "Run2.py", "Run3.py", "Run5.py", "Run6.py"] # This is a list of the files of the mission runs
|
||||||
content = ""
|
content = ""
|
||||||
imports = """
|
imports = """
|
||||||
from pybricks.hubs import PrimeHub
|
from pybricks.hubs import PrimeHub
|
||||||
@@ -72,7 +72,7 @@ function_calls = []
|
|||||||
|
|
||||||
# Define colors properly - one per script
|
# Define colors properly - one per script
|
||||||
colors = [
|
colors = [
|
||||||
'Color.ORANGE', 'Color.GREEN', 'Color.BLACK', 'Color.WHITE',
|
'Color.ORANGE', 'Color.GREEN', 'Color.WHITE',
|
||||||
'Color.YELLOW', 'Color.BLUE', 'Color.MAGENTA', 'Color.RED', 'Color.BROWN'
|
'Color.YELLOW', 'Color.BLUE', 'Color.MAGENTA', 'Color.RED', 'Color.BROWN'
|
||||||
]
|
]
|
||||||
|
|
||||||
@@ -96,7 +96,7 @@ for i, f_name in enumerate(script_names):
|
|||||||
m.write(func_def)
|
m.write(func_def)
|
||||||
|
|
||||||
# Assign one color per script
|
# Assign one color per script
|
||||||
color_condition = colors[i % len(colors)]
|
color_condition = colors[i]
|
||||||
function_calls.append({
|
function_calls.append({
|
||||||
'name': func_name,
|
'name': func_name,
|
||||||
'is_async': is_async,
|
'is_async': is_async,
|
||||||
@@ -120,10 +120,10 @@ with open("main.py", 'a') as m:
|
|||||||
m.write(f" await {func_info['name']}()\n")
|
m.write(f" await {func_info['name']}()\n")
|
||||||
else:
|
else:
|
||||||
m.write(f" {func_info['name']}()\n")
|
m.write(f" {func_info['name']}()\n")
|
||||||
m.write(" return # Exit after running one function\n")
|
m.write(" \n")
|
||||||
|
|
||||||
# Add a default case
|
# Add a default case
|
||||||
m.write(" # Default case - no matching color detected\n")
|
m.write(" \n")
|
||||||
m.write(" print(f'Detected color: {color_sensor.color()}')\n")
|
m.write(" print(f'Detected color: {color_sensor.color()}')\n")
|
||||||
|
|
||||||
# Write the main loop
|
# Write the main loop
|
||||||
@@ -132,8 +132,3 @@ with open("main.py", 'a') as m:
|
|||||||
m.write("while True:\n")
|
m.write("while True:\n")
|
||||||
m.write(" run_task(main())\n")
|
m.write(" run_task(main())\n")
|
||||||
m.write(" wait(100)\n")
|
m.write(" wait(100)\n")
|
||||||
|
|
||||||
print("Script merger completed successfully!")
|
|
||||||
print("Functions created:")
|
|
||||||
for func_info in function_calls:
|
|
||||||
print(f" - {func_info['name']}() triggered by {func_info['color']} (from {func_info['filename']})")
|
|
||||||
Reference in New Issue
Block a user