mirror of
https://github.com/pybricks/pybricks-projects.git
synced 2026-09-15 02:52:41 +00:00
David Lechner
31168708c5
EV3 and SPIKE are skipped for now since there are pending pull requests. Lines are wrapped somewhat short at 70 lines for better compatibility with the website.
48 lines
1.1 KiB
Python
48 lines
1.1 KiB
Python
from pybricks.hubs import MoveHub
|
|
from pybricks.pupdevices import Motor
|
|
from pybricks.parameters import Port, Stop, Color
|
|
from pybricks.tools import wait
|
|
|
|
# Initialize the arm motor
|
|
arm = Motor(Port.D)
|
|
arm.run_until_stalled(-100, duty_limit=30)
|
|
arm.reset_angle(0)
|
|
|
|
# Initialize the belt motor
|
|
belt = Motor(Port.B)
|
|
belt.run_until_stalled(-100, duty_limit=30)
|
|
belt.reset_angle(0)
|
|
|
|
# Component positions
|
|
FEET = 0
|
|
BELLY = 365
|
|
HEAD = 128
|
|
ARMS = 244
|
|
NECK = 521
|
|
BASE = 697
|
|
|
|
# Place all the elements
|
|
for element in (FEET, BELLY, ARMS, NECK, HEAD):
|
|
|
|
# Go to the element
|
|
belt.run_target(speed=200, target_angle=element)
|
|
|
|
# Grab the element
|
|
arm.run_time(speed=300, time=2000)
|
|
|
|
# Lift the element by going back to nearly zero
|
|
arm.run_target(speed=300, target_angle=55)
|
|
|
|
# Go to the base
|
|
belt.run_target(speed=200, target_angle=BASE)
|
|
wait(500)
|
|
|
|
# Put the element down
|
|
arm.run_time(speed=300, time=2000)
|
|
|
|
# Lift the arm back up
|
|
arm.run_target(speed=300, target_angle=0)
|
|
|
|
# When we are done, eject the result
|
|
belt.run_target(speed=200, target_angle=FEET)
|