This commit is contained in:
2024-05-02 07:16:51 +02:00
commit fc677d3804
12 changed files with 782 additions and 0 deletions

62
42100/42100_bot.py Normal file
View File

@@ -0,0 +1,62 @@
""" LEGO Liebherr LR 13000 / Xbox Controller / Pybricks
Top hub connects to Xbox controller.
Bottom hub receives the control data from the top one.
Controls:
Undercarriage
Left track forward ... Left trigger
Left track backward ... Left trigger + Button X pushed
Right track forward ... Right trigger
Right track backward ... Right trigger + Button A pushed
The superstructure turning ... Right joystick left / right
Crane
The boom raising / lowering ... Left joystick up / down
The jib raising / lowering ... Left joystick left / right
The hook raising / lowering ... Right joystick up / down
The lights on / off ... Button Y
"""
from pybricks.hubs import TechnicHub
from pybricks.pupdevices import Motor, Light
from pybricks.parameters import Button, Color, Direction, Port
from pybricks.tools import wait
from pybricks.iodevices import XboxController
hub = TechnicHub(observe_channels=[1])
superstr_motor = Motor(Port.D, positive_direction=Direction.COUNTERCLOCKWISE)
left_motor = Motor(Port.A, positive_direction=Direction.CLOCKWISE)
right_motor = Motor(Port.B, positive_direction=Direction.COUNTERCLOCKWISE)
# motors settings
LEFT_TRACK_SPEED = 800
RIGHT_TRACK_SPEED = 800
ROTATESPEED = 240 # motor speed to turn the crane superstructure
while True:
# Receive broadcast from the other hub.
data = hub.ble.observe(1)
if data is None:
# No data has been received in the last 1 second.
hub.light.on(Color.RED)
else:
# Data was received and is less that one second old.
hub.light.on(Color.GREEN)
# *data* contains the same values in the same order
# that were passed to hub.ble.broadcast() on the
# other hub.
rot_speed, left_tr_speed, right_tr_speed = data
# control of the superstructure turning
superstr_motor.run(rot_speed * ROTATESPEED / 80)
# left track control
left_motor.run(left_tr_speed * LEFT_TRACK_SPEED / 100)
# right track control
right_motor.run(right_tr_speed * RIGHT_TRACK_SPEED / 100)

121
42100/42100_top.py Normal file
View File

@@ -0,0 +1,121 @@
""" LEGO Liebherr LR 13000 / Xbox Controller / Pybricks
Top hub connects to Xbox controller.
Bottom hub receives the control data from the top one.
Controls:
Undercarriage
Left track forward ... Left trigger
Left track backward ... Left trigger + Button X pushed
Right track forward ... Right trigger
Right track backward ... Right trigger + Button A pushed
The superstructure turning ... Right joystick left / right
Crane
The boom raising / lowering ... Left joystick up / down
The jib raising / lowering ... Left joystick left / right
The hook raising / lowering ... Right joystick up / down
The lights on / off ... Button Y
"""
from pybricks.hubs import TechnicHub
from pybricks.pupdevices import Motor, Light
from pybricks.parameters import Button, Color, Direction, Port
from pybricks.tools import wait
from pybricks.iodevices import XboxController
hub = TechnicHub(broadcast_channel=1)
controller = XboxController()
boom_motor = Motor(Port.A, positive_direction=Direction.COUNTERCLOCKWISE)
arm_motor = Motor(Port.B, positive_direction=Direction.COUNTERCLOCKWISE)
bucket_motor = Motor(Port.C, positive_direction=Direction.CLOCKWISE)
scoop_motor = Motor(Port.D, positive_direction=Direction.CLOCKWISE)
# motors settings
BOOMSPEED = 1000
BUCKETSPEED = 100
ARMSPEED = 1000
SCOOPSPEED = 1000
hub.light.on(Color.GREEN)
while True:
# control of the boom raising and lowering
boom_speed = 0
horizontal, vertical = controller.joystick_left()
if vertical < -20:
boom_speed = vertical + 20
elif vertical > 20:
boom_speed = vertical - 20
boom_motor.run(boom_speed * BOOMSPEED / 80)
# control of the jib raising and lowering
bucket_speed = 0
horizontal, vertical = controller.joystick_left()
if horizontal < -20:
bucket_speed = horizontal + 20
elif horizontal > 20:
bucket_speed = horizontal - 20
bucket_motor.run(bucket_speed * BUCKETSPEED / 80)
# control of arm
arm_speed = 0
horizontal, vertical = controller.joystick_right()
if vertical < -20:
arm_speed = vertical + 20
elif vertical > 20:
arm_speed = vertical - 20
arm_motor.run(arm_speed * ARMSPEED / 80)
# control of scoop
scoop_speed = 0
horizontal, vertical = controller.joystick_right()
if horizontal < -20:
scoop_speed = vertical + 20
elif horizontal > 20:
scoop_speed = vertical - 20
scoop_motor_motor.run(scoop_speed * SCOOPSPEED / 80)
# control of the superstructure turning
rot_speed = 0
now_pressed = controller.buttons.pressed()
if controller.button.RIGHT:
rot_speed = ROTATESPEED
elif controller.button.LEFT:
rot_speed = -ROTATESPEED
# left track control
left_tr_speed = 0
now_pressed = controller.buttons.pressed()
if "X" in now_pressed:
brake, acceleration = controller.triggers()
if brake > 10:
left_tr_speed -= brake
else:
brake, acceleration = controller.triggers()
if brake > 10:
left_tr_speed += brake
# right track control
right_tr_speed = 0
now_pressed = controller.buttons.pressed()
if "A" in now_pressed:
brake, acceleration = controller.triggers()
if acceleration > 10:
right_tr_speed -= acceleration
else:
brake, acceleration = controller.triggers()
if acceleration > 10:
right_tr_speed += acceleration
# Set the broadcast data and start broadcasting if not already doing so.
data = (rot_speed, left_tr_speed, right_tr_speed)
hub.ble.broadcast(data)

Binary file not shown.

View File

@@ -0,0 +1,62 @@
""" LEGO Liebherr LR 13000 / Xbox Controller / Pybricks
Top hub connects to Xbox controller.
Bottom hub receives the control data from the top one.
Controls:
Undercarriage
Left track forward ... Left trigger
Left track backward ... Left trigger + Button X pushed
Right track forward ... Right trigger
Right track backward ... Right trigger + Button A pushed
The superstructure turning ... Right joystick left / right
Crane
The boom raising / lowering ... Left joystick up / down
The jib raising / lowering ... Left joystick left / right
The hook raising / lowering ... Right joystick up / down
The lights on / off ... Button Y
"""
from pybricks.hubs import TechnicHub
from pybricks.pupdevices import Motor, Light
from pybricks.parameters import Button, Color, Direction, Port
from pybricks.tools import wait
from pybricks.iodevices import XboxController
hub = TechnicHub(observe_channels=[1])
superstr_motor = Motor(Port.B, positive_direction=Direction.COUNTERCLOCKWISE)
left_motor = Motor(Port.C, positive_direction=Direction.CLOCKWISE)
right_motor = Motor(Port.D, positive_direction=Direction.COUNTERCLOCKWISE)
# motors settings
LEFT_TRACK_SPEED = 800
RIGHT_TRACK_SPEED = 800
ROTATESPEED = 240 # motor speed to turn the crane superstructure
while True:
# Receive broadcast from the other hub.
data = hub.ble.observe(1)
if data is None:
# No data has been received in the last 1 second.
hub.light.on(Color.RED)
else:
# Data was received and is less that one second old.
hub.light.on(Color.GREEN)
# *data* contains the same values in the same order
# that were passed to hub.ble.broadcast() on the
# other hub.
rot_speed, left_tr_speed, right_tr_speed = data
# control of the superstructure turning
superstr_motor.run(rot_speed * ROTATESPEED / 80)
# left track control
left_motor.run(left_tr_speed * LEFT_TRACK_SPEED / 100)
# right track control
right_motor.run(right_tr_speed * RIGHT_TRACK_SPEED / 100)

View File

@@ -0,0 +1,124 @@
""" LEGO Liebherr LR 13000 / Xbox Controller / Pybricks
Top hub connects to Xbox controller.
Bottom hub receives the control data from the top one.
Controls:
Undercarriage
Left track forward ... Left trigger
Left track backward ... Left trigger + Button X pushed
Right track forward ... Right trigger
Right track backward ... Right trigger + Button A pushed
The superstructure turning ... Right joystick left / right
Crane
The boom raising / lowering ... Left joystick up / down
The jib raising / lowering ... Left joystick left / right
The hook raising / lowering ... Right joystick up / down
The lights on / off ... Button Y
"""
from pybricks.hubs import TechnicHub
from pybricks.pupdevices import Motor, Light
from pybricks.parameters import Button, Color, Direction, Port
from pybricks.tools import wait
from pybricks.iodevices import XboxController
hub = TechnicHub(broadcast_channel=1)
controller = XboxController()
boom_motor = Motor(Port.A, positive_direction=Direction.COUNTERCLOCKWISE)
hook_motor = Motor(Port.B, positive_direction=Direction.COUNTERCLOCKWISE)
jib_motor = Motor(Port.D, positive_direction=Direction.CLOCKWISE)
light = Light(Port.C)
# motors settings
BOOMSPEED = 700
JIBSPEED = 700
HOOKSPEED = 800
light.off()
light_on = False
hub.light.on(Color.GREEN)
while True:
# Lights on/off
now_pressed = controller.buttons.pressed()
if "Y" in now_pressed:
if light_on:
light.off()
light_on = False
wait(10)
else:
light.on(100)
light_on = True
wait(10)
while "Y" in controller.buttons.pressed(): # wait until released
wait(10)
# control of the boom raising and lowering
boom_speed = 0
horizontal, vertical = controller.joystick_left()
if vertical < -20:
boom_speed = vertical + 20
elif vertical > 20:
boom_speed = vertical - 20
boom_motor.run(boom_speed * BOOMSPEED / 80)
# control of the jib raising and lowering
jib_speed = 0
horizontal, vertical = controller.joystick_left()
if horizontal < -20:
jib_speed = horizontal + 20
elif horizontal > 20:
jib_speed = horizontal - 20
jib_motor.run(jib_speed * JIBSPEED / 80)
# control of the hook raising and lowering
hook_speed = 0
horizontal, vertical = controller.joystick_right()
if vertical < -20:
hook_speed = vertical + 20
elif vertical > 20:
hook_speed = vertical - 20
hook_motor.run(hook_speed * HOOKSPEED / 80)
# control of the superstructure turning
rot_speed = 0
horizontal, vertical = controller.joystick_right()
if horizontal < -20:
rot_speed = horizontal + 20
elif horizontal > 20:
rot_speed = horizontal - 20
# left track control
left_tr_speed = 0
now_pressed = controller.buttons.pressed()
if "X" in now_pressed:
brake, acceleration = controller.triggers()
if brake > 10:
left_tr_speed -= brake
else:
brake, acceleration = controller.triggers()
if brake > 10:
left_tr_speed += brake
# right track control
right_tr_speed = 0
now_pressed = controller.buttons.pressed()
if "A" in now_pressed:
brake, acceleration = controller.triggers()
if acceleration > 10:
right_tr_speed -= acceleration
else:
brake, acceleration = controller.triggers()
if acceleration > 10:
right_tr_speed += acceleration
# Set the broadcast data and start broadcasting if not already doing so.
data = (rot_speed, left_tr_speed, right_tr_speed)
hub.ble.broadcast(data)

BIN
42100/Leibherr.zip Normal file

Binary file not shown.

118
42100/Leibherr/Lower hub.py Normal file
View File

@@ -0,0 +1,118 @@
#LOWER HUB
from pybricks.hubs import TechnicHub
from pybricks.pupdevices import Motor
from pybricks.parameters import Port, Stop, Color
from pybricks.tools import wait
from usys import stdin
from uselect import poll
hub = TechnicHub()
keyboard = poll()
keyboard.register(stdin)
left_track = Motor(Port.A)
right_track = Motor(Port.B)
turret = Motor(Port.D)
lSpeed = 0
rSpeed = 0
def trackMove(lSpeed, rSpeed):
left_track.run(speed = lSpeed)
right_track.run(speed = rSpeed)
while True:
if keyboard.poll(0):
key = stdin.read(1)
print("Key pressed", key)
if key in('4'):
key1 = 1000
elif key in('6'):
key1 = -1000
else:
key1 = 0
turret.run(key1 * 1000)
if key in('w'):
lSpeed = 1000
rSpeed = -1000
elif key in('s'):
lSpeed = -1000
rSpeed = 1000
elif key in('a'):
lSpeed = -1000
rSpeed = -1000
elif key in('d'):
lSpeed = 1000
rSpeed = 1000
elif key in('4'):
key1 = 1
elif key in('6'):
key1 = -1
else:
lSpeed = 0
rSpeed = 0
trackMove(lSpeed,rSpeed)

View File

@@ -0,0 +1,109 @@
#FOR UPPER HUB
from pybricks.hubs import TechnicHub
from pybricks.pupdevices import Motor
from pybricks.parameters import Port, Stop, Color
from pybricks.tools import wait
from usys import stdin
from uselect import poll
hub = TechnicHub()
keyboard = poll()
keyboard.register(stdin)
boom_motor = Motor(Port.A)
arm_motor = Motor(Port.B)
bucket_motor = Motor(Port.C)
scoop_motor = Motor(Port.D)
while True:
if keyboard.poll(0):
key = stdin.read(1)
print("Key pressed", key)
if key in ('w'):
key1 = 1
elif key in('s'):
key1 = -1
else:
key1 = 0
boom_motor.run(key1 * 1000)
if key in('a'):
key2 = 1
elif key in('d'):
key2 = -1
else:
key2 = 0
arm_motor.run(key2 * 1000)
if key in('8'):
key3 = 1
elif key in('2'):
key3 = -1
else:
key3 = 0
bucket_motor.run(key3 * 1000)
if key in('4'):
key4 = 1
elif key in('6'):
key4 = -1
else:
key4 = 0
scoop_motor.run(key4 * 1000)

Binary file not shown.

View File

@@ -0,0 +1,62 @@
""" LEGO Liebherr LR 13000 / Xbox Controller / Pybricks
Top hub connects to Xbox controller.
Bottom hub receives the control data from the top one.
Controls:
Undercarriage
Left track forward ... Left trigger
Left track backward ... Left trigger + Button X pushed
Right track forward ... Right trigger
Right track backward ... Right trigger + Button A pushed
The superstructure turning ... Right joystick left / right
Crane
The boom raising / lowering ... Left joystick up / down
The jib raising / lowering ... Left joystick left / right
The hook raising / lowering ... Right joystick up / down
The lights on / off ... Button Y
"""
from pybricks.hubs import TechnicHub
from pybricks.pupdevices import Motor, Light
from pybricks.parameters import Button, Color, Direction, Port
from pybricks.tools import wait
from pybricks.iodevices import XboxController
hub = TechnicHub(observe_channels=[1])
superstr_motor = Motor(Port.D, positive_direction=Direction.COUNTERCLOCKWISE)
left_motor = Motor(Port.A, positive_direction=Direction.CLOCKWISE)
right_motor = Motor(Port.B, positive_direction=Direction.COUNTERCLOCKWISE)
# motors settings
LEFT_TRACK_SPEED = 800
RIGHT_TRACK_SPEED = 800
ROTATESPEED = 240 # motor speed to turn the crane superstructure
while True:
# Receive broadcast from the other hub.
data = hub.ble.observe(1)
if data is None:
# No data has been received in the last 1 second.
hub.light.on(Color.RED)
else:
# Data was received and is less that one second old.
hub.light.on(Color.GREEN)
# *data* contains the same values in the same order
# that were passed to hub.ble.broadcast() on the
# other hub.
rot_speed, left_tr_speed, right_tr_speed = data
# control of the superstructure turning
superstr_motor.run(rot_speed * ROTATESPEED / 80)
# left track control
left_motor.run(left_tr_speed * LEFT_TRACK_SPEED / 100)
# right track control
right_motor.run(right_tr_speed * RIGHT_TRACK_SPEED / 100)

View File

@@ -0,0 +1,121 @@
""" LEGO Liebherr LR 13000 / Xbox Controller / Pybricks
Top hub connects to Xbox controller.
Bottom hub receives the control data from the top one.
Controls:
Undercarriage
Left track forward ... Left trigger
Left track backward ... Left trigger + Button X pushed
Right track forward ... Right trigger
Right track backward ... Right trigger + Button A pushed
The superstructure turning ... Right joystick left / right
Crane
The boom raising / lowering ... Left joystick up / down
The jib raising / lowering ... Left joystick left / right
The hook raising / lowering ... Right joystick up / down
The lights on / off ... Button Y
"""
from pybricks.hubs import TechnicHub
from pybricks.pupdevices import Motor, Light
from pybricks.parameters import Button, Color, Direction, Port
from pybricks.tools import wait
from pybricks.iodevices import XboxController
hub = TechnicHub(broadcast_channel=1)
controller = XboxController()
boom_motor = Motor(Port.A, positive_direction=Direction.COUNTERCLOCKWISE)
arm_motor = Motor(Port.B, positive_direction=Direction.COUNTERCLOCKWISE)
bucket_motor = Motor(Port.C, positive_direction=Direction.CLOCKWISE)
scoop_motor = Motor(Port.D, positive_direction=Direction.CLOCKWISE)
# motors settings
BOOMSPEED = 1000
BUCKETSPEED = 100
ARMSPEED = 1000
SCOOPSPEED = 1000
hub.light.on(Color.GREEN)
while True:
# # control of the boom raising and lowering
# boom_speed = 0
# horizontal, vertical = controller.joystick_left()
# if vertical < -20:
# boom_speed = vertical + 20
# elif vertical > 20:
# boom_speed = vertical - 20
# boom_motor.run(boom_speed * BOOMSPEED / 80)
# # control of the jib raising and lowering
# bucket_speed = 0
# horizontal, vertical = controller.joystick_left()
# if horizontal < -20:
# bucket_speed = horizontal + 20
# elif horizontal > 20:
# bucket_speed = horizontal - 20
# bucket_motor.run(bucket_speed * BUCKETSPEED / 80)
# # control of arm
# arm_speed = 0
# horizontal, vertical = controller.joystick_right()
# if vertical < -20:
# arm_speed = vertical + 20
# elif vertical > 20:
# arm_speed = vertical - 20
# arm_motor.run(arm_speed * ARMSPEED / 80)
# # control of scoop
# scoop_speed = 0
# horizontal, vertical = controller.joystick_right()
# if horizontal < -20:
# scoop_speed = vertical + 20
# elif horizontal > 20:
# scoop_speed = vertical - 20
# scoop_motor_motor.run(scoop_speed * SCOOPSPEED / 80)
# control of the superstructure turning
rot_speed = 0
now_pressed = controller.buttons.pressed()
if controller.button.RIGHT:
rot_speed = ROTATESPEED
elif controller.button.LEFT:
rot_speed = ROTATESPEED * -1
# left track control
left_tr_speed = 0
now_pressed = controller.buttons.pressed()
if "X" in now_pressed:
brake, acceleration = controller.triggers()
if brake > 10:
left_tr_speed -= brake
else:
brake, acceleration = controller.triggers()
if brake > 10:
left_tr_speed += brake
# right track control
right_tr_speed = 0
now_pressed = controller.buttons.pressed()
if "A" in now_pressed:
brake, acceleration = controller.triggers()
if acceleration > 10:
right_tr_speed -= acceleration
else:
brake, acceleration = controller.triggers()
if acceleration > 10:
right_tr_speed += acceleration
# Set the broadcast data and start broadcasting if not already doing so.
data = (rot_speed, left_tr_speed, right_tr_speed)
hub.ble.broadcast(data)

View File

@@ -0,0 +1,3 @@
# pybricks blocks file:{"blocks":{"languageVersion":0,"blocks":[{"type":"blockGlobalSetup","id":"bjK,wS1MYO7aiYkFSwd{","x":150,"y":100,"deletable":false},{"type":"blockGlobalStart","id":"3tJe|AWl0baN(wH9a$@.","x":150,"y":300,"deletable":false,"next":{"block":{"type":"blockPrint","id":"j,,T}?rBkaW$1v?olp4p","extraState":{"optionLevel":0},"inputs":{"TEXT0":{"shadow":{"type":"text","id":"!x5.0YiWya^`(y)yO5B8","fields":{"TEXT":"Hello, Pybricks!"}}}}}}}]},"variables":[{"name":"red","id":"b(K72kbjLK3eaWY0rZ|H","type":"ColorDef"},{"name":"orange","id":"c5QKn-VxQXjXw0PEXW{$","type":"ColorDef"},{"name":"yellow","id":"J2n}pzD-+3vRNACoH}A|","type":"ColorDef"},{"name":"green","id":"0(NPnGB8B#2Qj*3dMqMj","type":"ColorDef"},{"name":"cyan","id":"`cTjOq2c5Qt!:AB0MNE~","type":"ColorDef"},{"name":"blue","id":")~d23yr%3gimljv:M!%H","type":"ColorDef"},{"name":"violet","id":".;6s97*6~~o){?kf32Vu","type":"ColorDef"},{"name":"magenta","id":"hnOw;Pff:#:!OejeEBQ8","type":"ColorDef"},{"name":"white","id":"|u=R}I%9QzW(~|dUY+U}","type":"ColorDef"},{"name":"none","id":"*c=-CgnIE*K6T9Gxk[8}","type":"ColorDef"}],"info":{"type":"pybricks","version":"1.2.2"}}
# The main program starts here.
print('Hello, Pybricks!')