Michel/lego-pybricks-collection
1
0
Fork 0
Code Issues Pull Requests Activity

v0.0.0

Browse Source
This commit is contained in:
Michel
2022-10-07 20:46:58 +02:00
parent 17f532b6e6
commit 8d1ef9f63e
1 changed files with 46 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files
42100 Model C - Tracked Carrier by Nico71 (MOC-105180)/main_front.py
+46 -3
View File
@@ -7,9 +7,9 @@
# LEGO® Powerd UP 88010 Remote. #
# #
# Configuration of the Technic Hub: #
# Port A: Not used #
# Port A: Drive motor #
# Port B: Drive motor #
# Port C: Not used #
# Port C: Drive motor #
# Port D: Drive motor #
# #
################################################################################
@@ -29,8 +29,10 @@ from pybricks.hubs import TechnicHub
from pybricks.tools import wait
# Initialize the motors.
tracks_left = Motor(Port.D, Direction.COUNTERCLOCKWISE)
crane_top = Motor(Port.A, Direction.CLOCKWISE)
tracks_right = Motor(Port.B, Direction.CLOCKWISE)
engine = Motor(Port.C, Direction.CLOCKWISE)
tracks_left = Motor(Port.D, Direction.COUNTERCLOCKWISE)
# Connect to the remote.
remote = Remote()
@@ -42,12 +44,19 @@ hub = TechnicHub()
voltage_current = hub.battery.voltage()
voltage = voltage_current
engine_speed_set = 25
engine_speed = 0
engine_fail_counter_set = 20
engine_fail_counter = engine_fail_counter_set
while True:
# Check which buttons are pressed.
pressed = remote.buttons.pressed()
tracks_left_speed = 0
tracks_right_speed = 0
crane_top_speed = 0
# Choose the drive speed based on the left controls.
if Button.LEFT_PLUS in pressed:
@@ -61,8 +70,42 @@ while True:
elif Button.RIGHT_MINUS in pressed:
tracks_right_speed = -100
# Choose the drive speed based on the center controls.
if Button.LEFT in pressed:
crane_top_speed = 100
elif Button.RIGHT in pressed:
crane_top_speed = -100
if Button.CENTER in pressed:
if engine_speed is engine_speed_set or engine_speed is -engine_speed_set:
engine_speed = 0
engine_fail_counter = engine_fail_counter_set
else:
engine_speed = engine_speed_set
while Button.CENTER in pressed:
# Button debounce
wait(10)
pressed = remote.buttons.pressed()
tracks_left.dc(tracks_left_speed)
tracks_right.dc(tracks_right_speed)
crane_top.dc(crane_top_speed)
engine.dc(engine_speed)
if engine_speed < 0 or engine_speed > 0:
engine_speed_measured = engine.speed()
if engine_speed_measured < 0:
engine_speed_measured = -engine_speed_measured
if engine_speed_measured < 100:
if engine_fail_counter > 0:
engine_fail_counter = engine_fail_counter-1
else:
engine_speed = -engine_speed
engine_fail_counter = engine_fail_counter_set
else:
engine_fail_counter = engine_fail_counter_set
# Show battery status by hub LED.
# Get current voltage and gradually up or down the value.