Format document

This commit is contained in:
2023-11-20 20:58:29 +01:00
parent adfad36ec5
commit e3d4ff41be
9 changed files with 124 additions and 120 deletions
@@ -41,20 +41,21 @@ right_end = steering.run_until_stalled(200, then=Stop.HOLD)
# We are now at the right. Reset this angle to be half the difference. # We are now at the right. Reset this angle to be half the difference.
# That puts zero in the middle. # That puts zero in the middle.
steering.reset_angle((right_end - left_end)/2) steering.reset_angle((right_end - left_end) / 2)
steering.run_target(speed=200, target_angle=0, wait=False) steering.run_target(speed=200, target_angle=0, wait=False)
# Set steering angle # Set steering angle
steering_angle = (((right_end - left_end)/2)-5) steering_angle = ((right_end - left_end) / 2) - 5
# Set variable for gear # Set variable for gear
gear_total = 2 # Total number of gears. # Total number of gears.
gear_old = None # Empty variable to set later on (keep gear_total = 2
# empty!). # Empty variable to set later on (keep empty!).
gear = 1 # Gear at start (must be higher than 0 and gear_old = None
# lower or eaqual to gear_total). # Gear at start (must be higher than 0 and lower or eaqual to gear_total).
gear_color = ["BLUE", "RED"] # Number of colors should at least be gear = 1
# equal to gear_total. # Number of colors should at least be equal to gear_total.
gear_color = ["BLUE", "RED"]
# Battery variables # Battery variables
voltage_current = hub.battery.voltage() voltage_current = hub.battery.voltage()
@@ -77,7 +78,7 @@ while True:
if gear_old > 1: if gear_old > 1:
gear -= 1 gear -= 1
while Button.LEFT in pressed: while Button.LEFT in pressed:
# Button debounce # Button debounce
wait(10) wait(10)
pressed = remote.buttons.pressed() pressed = remote.buttons.pressed()
@@ -86,14 +87,14 @@ while True:
if gear_old < gear_total: if gear_old < gear_total:
gear += 1 gear += 1
while Button.RIGHT in pressed: while Button.RIGHT in pressed:
# Button debounce # Button debounce
wait(10) wait(10)
pressed = remote.buttons.pressed() pressed = remote.buttons.pressed()
# Set speed according to the choosen gear. # Set speed according to the choosen gear.
if gear is not gear_old: if gear is not gear_old:
remote.light.on(Color[gear_color[gear-1]]) remote.light.on(Color[gear_color[gear - 1]])
speed = (100/gear_total)*gear speed = (100 / gear_total) * gear
gear_old = gear gear_old = gear
# Choose the drive speed based on the left controls. # Choose the drive speed based on the left controls.
@@ -106,7 +107,7 @@ while True:
# Apply the selected speed. # Apply the selected speed.
driving_1.dc(drive_speed) driving_1.dc(drive_speed)
driving_2.dc(drive_speed) driving_2.dc(drive_speed)
# Show battery status by hub LED. # Show battery status by hub LED.
# Get current voltage and gradually up or down the value. # Get current voltage and gradually up or down the value.
voltage_current = hub.battery.voltage() voltage_current = hub.battery.voltage()
@@ -71,7 +71,7 @@ while True:
crane_top_speed = 100 crane_top_speed = 100
elif Button.RIGHT in pressed: elif Button.RIGHT in pressed:
crane_top_speed = -100 crane_top_speed = -100
if Button.CENTER in pressed: if Button.CENTER in pressed:
if engine_speed is engine_speed_set or engine_speed is -engine_speed_set: if engine_speed is engine_speed_set or engine_speed is -engine_speed_set:
engine_speed = 0 engine_speed = 0
@@ -79,7 +79,7 @@ while True:
else: else:
engine_speed = engine_speed_set engine_speed = engine_speed_set
while Button.CENTER in pressed: while Button.CENTER in pressed:
# Button debounce # Button debounce
wait(10) wait(10)
pressed = remote.buttons.pressed() pressed = remote.buttons.pressed()
@@ -96,7 +96,7 @@ while True:
if engine_speed_measured < 100: if engine_speed_measured < 100:
if engine_fail_counter > 0: if engine_fail_counter > 0:
engine_fail_counter = engine_fail_counter-1 engine_fail_counter = engine_fail_counter - 1
else: else:
engine_speed = -engine_speed engine_speed = -engine_speed
engine_fail_counter = engine_fail_counter_set engine_fail_counter = engine_fail_counter_set
@@ -47,20 +47,21 @@ right_end = steering.run_until_stalled(200, then=Stop.HOLD)
# We are now at the right. Reset this angle to be half the difference. # We are now at the right. Reset this angle to be half the difference.
# That puts zero in the middle. # That puts zero in the middle.
steering.reset_angle((right_end - left_end)/2) steering.reset_angle((right_end - left_end) / 2)
steering.run_target(speed=200, target_angle=0, wait=False) steering.run_target(speed=200, target_angle=0, wait=False)
# Set steering angle # Set steering angle
steering_angle = (((right_end - left_end)/2)-5) steering_angle = ((right_end - left_end) / 2) - 5
# Set variable for gear # Set variable for gear
gear_total = 3 # Total number of gears. # Total number of gears.
gear_old = None # Empty variable to set later on (keep gear_total = 3
# empty!). # Empty variable to set later on (keep empty!).
gear = 1 # Gear at start (must be higher than 0 and gear_old = None
# lower or eaqual to gear_total). # Gear at start (must be higher than 0 and lower or eaqual to gear_total).
gear_color = ["BLUE", "WHITE", "RED"] # Number of colors should at least be gear = 1
# equal to gear_total. # Number of colors should at least be equal to gear_total.
gear_color = ["BLUE", "WHITE", "RED"]
# Battery variables # Battery variables
voltage_current = hub.battery.voltage() voltage_current = hub.battery.voltage()
@@ -83,7 +84,7 @@ while True:
if gear_old > 1: if gear_old > 1:
gear -= 1 gear -= 1
while Button.LEFT in pressed: while Button.LEFT in pressed:
# Button debounce # Button debounce
wait(10) wait(10)
pressed = remote.buttons.pressed() pressed = remote.buttons.pressed()
@@ -92,14 +93,14 @@ while True:
if gear_old < gear_total: if gear_old < gear_total:
gear += 1 gear += 1
while Button.RIGHT in pressed: while Button.RIGHT in pressed:
# Button debounce # Button debounce
wait(10) wait(10)
pressed = remote.buttons.pressed() pressed = remote.buttons.pressed()
# Set speed according to the choosen gear. # Set speed according to the choosen gear.
if gear is not gear_old: if gear is not gear_old:
remote.light.on(Color[gear_color[gear-1]]) remote.light.on(Color[gear_color[gear - 1]])
speed = (100/gear_total)*gear speed = (100 / gear_total) * gear
gear_old = gear gear_old = gear
# Choose the drive speed based on the left controls. # Choose the drive speed based on the left controls.
@@ -111,7 +112,7 @@ while True:
# Apply the selected speed. # Apply the selected speed.
driving.dc(drive_speed) driving.dc(drive_speed)
# Show battery status by hub LED. # Show battery status by hub LED.
# Get current voltage and gradually up or down the value. # Get current voltage and gradually up or down the value.
voltage_current = hub.battery.voltage() voltage_current = hub.battery.voltage()
+14 -14
View File
@@ -43,7 +43,7 @@ driving = Motor(Port.A, Direction.CLOCKWISE)
# Connect to the remote. # Connect to the remote.
remote = Remote() remote = Remote()
#Find the gearing endpoints but keep trying if value is below threshold of 200. # Find the gearing endpoints but keep trying if value is below threshold of 200.
gear_angle = 0 gear_angle = 0
while gear_angle < 200: while gear_angle < 200:
# Find the steering endpoint on the left and right. # Find the steering endpoint on the left and right.
@@ -52,8 +52,8 @@ while gear_angle < 200:
right_end_gearbox = gearbox.run_until_stalled(200, then=Stop.HOLD) right_end_gearbox = gearbox.run_until_stalled(200, then=Stop.HOLD)
# Set gearing angle # Set gearing angle
gear_angle = (((right_end_gearbox - left_end_gearbox)/2)-5) gear_angle = ((right_end_gearbox - left_end_gearbox) / 2) - 5
print('Gear angle measured:',gear_angle) print("Gear angle measured:", gear_angle)
# Find the steering endpoint on the left and right. # Find the steering endpoint on the left and right.
# The middle is in between. # The middle is in between.
@@ -62,21 +62,21 @@ right_end_steering = steering.run_until_stalled(200, then=Stop.HOLD)
# Set gearing angle # Set gearing angle
# Real angle of gear mechanism is 270 degrees (135 both sides from center). # Real angle of gear mechanism is 270 degrees (135 both sides from center).
gear_angle = 270/2 gear_angle = 270 / 2
gear_angle_1 = gear_angle gear_angle_1 = gear_angle
gear_angle_2 = gear_angle-(((gear_angle+gear_angle)/3)*1) gear_angle_2 = gear_angle - (((gear_angle + gear_angle) / 3) * 1)
gear_angle_3 = gear_angle-(((gear_angle+gear_angle)/3)*2) gear_angle_3 = gear_angle - (((gear_angle + gear_angle) / 3) * 2)
gear_angle_tipper = -gear_angle gear_angle_tipper = -gear_angle
print('Gear angle real:',gear_angle) print("Gear angle real:", gear_angle)
# Set steering angle # Set steering angle
steer_angle = (((right_end_steering - left_end_steering)/2)-5) steer_angle = ((right_end_steering - left_end_steering) / 2) - 5
print('steer angle:',steer_angle) print("steer angle:", steer_angle)
# We are now at the right. Reset this angle to be half the difference. # We are now at the right. Reset this angle to be half the difference.
# That puts zero in the middle. # That puts zero in the middle.
gearbox.reset_angle((right_end_gearbox - left_end_gearbox)/2) gearbox.reset_angle((right_end_gearbox - left_end_gearbox) / 2)
gearbox.run_target(1400, gear_angle, Stop.HOLD, False) gearbox.run_target(1400, gear_angle, Stop.HOLD, False)
steering.reset_angle((right_end_steering - left_end_steering)/2) steering.reset_angle((right_end_steering - left_end_steering) / 2)
steering.run_target(speed=200, target_angle=0, wait=False) steering.run_target(speed=200, target_angle=0, wait=False)
# Set variable for gear # Set variable for gear
@@ -98,7 +98,7 @@ while True:
else: else:
gear = 1 gear = 1
while Button.RIGHT in pressed: while Button.RIGHT in pressed:
# Button debounce # Button debounce
wait(10) wait(10)
pressed = remote.buttons.pressed() pressed = remote.buttons.pressed()
@@ -113,7 +113,7 @@ while True:
else: else:
gear = 3 gear = 3
while Button.LEFT in pressed: while Button.LEFT in pressed:
# Button debounce # Button debounce
wait(10) wait(10)
pressed = remote.buttons.pressed() pressed = remote.buttons.pressed()
@@ -140,7 +140,7 @@ while True:
if gear_old is 1: if gear_old is 1:
wait(500) wait(500)
gear_old = 4 gear_old = 4
# Wait before going on so changing gear won't happen while driving. # Wait before going on so changing gear won't happen while driving.
wait(250) wait(250)
# Choose the steering angle based on the right controls. # Choose the steering angle based on the right controls.
+15 -14
View File
@@ -38,20 +38,21 @@ right_end = steering.run_until_stalled(200, then=Stop.HOLD)
# We are now at the right. Reset this angle to be half the difference. # We are now at the right. Reset this angle to be half the difference.
# That puts zero in the middle. # That puts zero in the middle.
steering.reset_angle((right_end - left_end)/2) steering.reset_angle((right_end - left_end) / 2)
steering.run_target(speed=200, target_angle=0, wait=False) steering.run_target(speed=200, target_angle=0, wait=False)
# Set steering angle # Set steering angle
steering_angle = (((right_end - left_end)/2)-5) steering_angle = ((right_end - left_end) / 2) - 5
# Set variable for gear # Set variable for gear
gear_total = 3 # Total number of gears. # Total number of gears.
gear_old = None # Empty variable to set later on (keep gear_total = 3
# empty!). # Empty variable to set later on (keep empty!).
gear = 1 # Gear at start (must be higher than 0 and gear_old = None
# lower or eaqual to gear_total). # Gear at start (must be higher than 0 and lower or eaqual to gear_total).
gear_color = ["BLUE", "WHITE", "RED"] # Number of colors should at least be gear = 1
# equal to gear_total. # Number of colors should at least be equal to gear_total.
gear_color = ["BLUE", "WHITE", "RED"]
# Battery variables # Battery variables
voltage_current = hub.battery.voltage() voltage_current = hub.battery.voltage()
@@ -74,7 +75,7 @@ while True:
if gear_old > 1: if gear_old > 1:
gear -= 1 gear -= 1
while Button.LEFT in pressed: while Button.LEFT in pressed:
# Button debounce # Button debounce
wait(10) wait(10)
pressed = remote.buttons.pressed() pressed = remote.buttons.pressed()
@@ -83,14 +84,14 @@ while True:
if gear_old < gear_total: if gear_old < gear_total:
gear += 1 gear += 1
while Button.RIGHT in pressed: while Button.RIGHT in pressed:
# Button debounce # Button debounce
wait(10) wait(10)
pressed = remote.buttons.pressed() pressed = remote.buttons.pressed()
# Set speed according to the choosen gear. # Set speed according to the choosen gear.
if gear is not gear_old: if gear is not gear_old:
remote.light.on(Color[gear_color[gear-1]]) remote.light.on(Color[gear_color[gear - 1]])
speed = (100/gear_total)*gear speed = (100 / gear_total) * gear
gear_old = gear gear_old = gear
# Choose the drive speed based on the left controls. # Choose the drive speed based on the left controls.
@@ -102,7 +103,7 @@ while True:
# Apply the selected speed. # Apply the selected speed.
driving.dc(drive_speed) driving.dc(drive_speed)
# Show battery status by hub LED. # Show battery status by hub LED.
# Get current voltage and gradually up or down the value. # Get current voltage and gradually up or down the value.
voltage_current = hub.battery.voltage() voltage_current = hub.battery.voltage()
@@ -41,20 +41,21 @@ right_end = steering.run_until_stalled(200, then=Stop.HOLD)
# We are now at the right. Reset this angle to be half the difference. # We are now at the right. Reset this angle to be half the difference.
# That puts zero in the middle. # That puts zero in the middle.
steering.reset_angle((right_end - left_end)/2) steering.reset_angle((right_end - left_end) / 2)
steering.run_target(speed=200, target_angle=0, wait=False) steering.run_target(speed=200, target_angle=0, wait=False)
# Set steering angle # Set steering angle
steering_angle = (((right_end - left_end)/2)-5) steering_angle = ((right_end - left_end) / 2) - 5
# Set variable for gear # Set variable for gear
gear_total = 2 # Total number of gears. # Total number of gears.
gear_old = None # Empty variable to set later on (keep gear_total = 2
# empty!). # Empty variable to set later on (keep empty!).
gear = 1 # Gear at start (must be higher than 0 and gear_old = None
# lower or eaqual to gear_total). # Gear at start (must be higher than 0 and lower or eaqual to gear_total).
gear_color = ["BLUE", "RED"] # Number of colors should at least be gear = 1
# equal to gear_total. # Number of colors should at least be equal to gear_total.
gear_color = ["BLUE", "RED"]
# Battery variables # Battery variables
voltage_current = hub.battery.voltage() voltage_current = hub.battery.voltage()
@@ -77,7 +78,7 @@ while True:
if gear_old > 1: if gear_old > 1:
gear -= 1 gear -= 1
while Button.LEFT in pressed: while Button.LEFT in pressed:
# Button debounce # Button debounce
wait(10) wait(10)
pressed = remote.buttons.pressed() pressed = remote.buttons.pressed()
@@ -86,14 +87,14 @@ while True:
if gear_old < gear_total: if gear_old < gear_total:
gear += 1 gear += 1
while Button.RIGHT in pressed: while Button.RIGHT in pressed:
# Button debounce # Button debounce
wait(10) wait(10)
pressed = remote.buttons.pressed() pressed = remote.buttons.pressed()
# Set speed according to the choosen gear. # Set speed according to the choosen gear.
if gear is not gear_old: if gear is not gear_old:
remote.light.on(Color[gear_color[gear-1]]) remote.light.on(Color[gear_color[gear - 1]])
speed = (100/gear_total)*gear speed = (100 / gear_total) * gear
gear_old = gear gear_old = gear
# Choose the drive speed based on the left controls. # Choose the drive speed based on the left controls.
@@ -106,7 +107,7 @@ while True:
# Apply the selected speed. # Apply the selected speed.
driving_1.dc(drive_speed) driving_1.dc(drive_speed)
driving_2.dc(drive_speed) driving_2.dc(drive_speed)
# Show battery status by hub LED. # Show battery status by hub LED.
# Get current voltage and gradually up or down the value. # Get current voltage and gradually up or down the value.
voltage_current = hub.battery.voltage() voltage_current = hub.battery.voltage()
@@ -45,22 +45,23 @@ steering_correction = +3
# We are now at the right. Reset this angle to be half the difference. # We are now at the right. Reset this angle to be half the difference.
# That puts zero in the middle. # That puts zero in the middle.
steering.reset_angle(((right_end - left_end)/2)+steering_correction) steering.reset_angle(((right_end - left_end) / 2) + steering_correction)
steering.run_target(speed=200, target_angle=0, wait=False) steering.run_target(speed=200, target_angle=0, wait=False)
# Set steering angle # Set steering angle
steering_angle = (((right_end - left_end)/2)-5) steering_angle = ((right_end - left_end) / 2) - 5
steering_angle_left = -steering_angle-steering_correction steering_angle_left = -steering_angle - steering_correction
steering_angle_right = steering_angle+steering_correction steering_angle_right = steering_angle + steering_correction
# Set variable for gear # Set variable for gear
gear_total = 2 # Total number of gears. # Total number of gears.
gear_old = None # Empty variable to set later on (keep gear_total = 2
# empty!). # Empty variable to set later on (keep empty!).
gear = 1 # Gear at start (must be higher than 0 and gear_old = None
# lower or eaqual to gear_total). # Gear at start (must be higher than 0 and lower or eaqual to gear_total).
gear_color = ["BLUE", "RED"] # Number of colors should at least be gear = 1
# equal to gear_total. # Number of colors should at least be equal to gear_total.
gear_color = ["BLUE", "RED"]
# Battery variables # Battery variables
voltage_current = hub.battery.voltage() voltage_current = hub.battery.voltage()
@@ -83,7 +84,7 @@ while True:
if gear_old > 1: if gear_old > 1:
gear -= 1 gear -= 1
while Button.LEFT in pressed: while Button.LEFT in pressed:
# Button debounce # Button debounce
wait(10) wait(10)
pressed = remote.buttons.pressed() pressed = remote.buttons.pressed()
@@ -92,14 +93,14 @@ while True:
if gear_old < gear_total: if gear_old < gear_total:
gear += 1 gear += 1
while Button.RIGHT in pressed: while Button.RIGHT in pressed:
# Button debounce # Button debounce
wait(10) wait(10)
pressed = remote.buttons.pressed() pressed = remote.buttons.pressed()
# Set speed according to the choosen gear. # Set speed according to the choosen gear.
if gear is not gear_old: if gear is not gear_old:
remote.light.on(Color[gear_color[gear-1]]) remote.light.on(Color[gear_color[gear - 1]])
speed = (100/gear_total)*gear speed = (100 / gear_total) * gear
gear_old = gear gear_old = gear
# Choose the drive speed based on the left controls. # Choose the drive speed based on the left controls.
@@ -112,7 +113,7 @@ while True:
# Apply the selected speed. # Apply the selected speed.
driving_1.dc(drive_speed) driving_1.dc(drive_speed)
driving_2.dc(drive_speed) driving_2.dc(drive_speed)
# Show battery status by hub LED. # Show battery status by hub LED.
# Get current voltage and gradually up or down the value. # Get current voltage and gradually up or down the value.
voltage_current = hub.battery.voltage() voltage_current = hub.battery.voltage()
@@ -129,6 +130,3 @@ while True:
hub.light.on(Color.ORANGE) hub.light.on(Color.ORANGE)
else: else:
hub.light.on(Color.RED) hub.light.on(Color.RED)
# Wait.
wait(10)
@@ -41,20 +41,21 @@ right_end = steering.run_until_stalled(200, then=Stop.HOLD)
# We are now at the right. Reset this angle to be half the difference. # We are now at the right. Reset this angle to be half the difference.
# That puts zero in the middle. # That puts zero in the middle.
steering.reset_angle((right_end - left_end)/2) steering.reset_angle((right_end - left_end) / 2)
steering.run_target(speed=200, target_angle=0, wait=False) steering.run_target(speed=200, target_angle=0, wait=False)
# Set steering angle # Set steering angle
steering_angle = (((right_end - left_end)/2)-5) steering_angle = ((right_end - left_end) / 2) - 5
# Set variable for gear # Set variable for gear
gear_total = 2 # Total number of gears. # Total number of gears.
gear_old = None # Empty variable to set later on (keep gear_total = 2
# empty!). # Empty variable to set later on (keep empty!).
gear = 1 # Gear at start (must be higher than 0 and gear_old = None
# lower or eaqual to gear_total). # Gear at start (must be higher than 0 and lower or eaqual to gear_total).
gear_color = ["BLUE", "RED"] # Number of colors should at least be gear = 1
# equal to gear_total. # Number of colors should at least be equal to gear_total.
gear_color = ["BLUE", "RED"]
# Battery variables # Battery variables
voltage_current = hub.battery.voltage() voltage_current = hub.battery.voltage()
@@ -77,7 +78,7 @@ while True:
if gear_old > 1: if gear_old > 1:
gear -= 1 gear -= 1
while Button.LEFT in pressed: while Button.LEFT in pressed:
# Button debounce # Button debounce
wait(10) wait(10)
pressed = remote.buttons.pressed() pressed = remote.buttons.pressed()
@@ -86,14 +87,14 @@ while True:
if gear_old < gear_total: if gear_old < gear_total:
gear += 1 gear += 1
while Button.RIGHT in pressed: while Button.RIGHT in pressed:
# Button debounce # Button debounce
wait(10) wait(10)
pressed = remote.buttons.pressed() pressed = remote.buttons.pressed()
# Set speed according to the choosen gear. # Set speed according to the choosen gear.
if gear is not gear_old: if gear is not gear_old:
remote.light.on(Color[gear_color[gear-1]]) remote.light.on(Color[gear_color[gear - 1]])
speed = (100/gear_total)*gear speed = (100 / gear_total) * gear
gear_old = gear gear_old = gear
# Choose the drive speed based on the left controls. # Choose the drive speed based on the left controls.
@@ -106,7 +107,7 @@ while True:
# Apply the selected speed. # Apply the selected speed.
driving_1.dc(drive_speed) driving_1.dc(drive_speed)
driving_2.dc(drive_speed) driving_2.dc(drive_speed)
# Show battery status by hub LED. # Show battery status by hub LED.
# Get current voltage and gradually up or down the value. # Get current voltage and gradually up or down the value.
voltage_current = hub.battery.voltage() voltage_current = hub.battery.voltage()
@@ -42,20 +42,21 @@ right_end = steering.run_until_stalled(200, then=Stop.HOLD)
# We are now at the right. Reset this angle to be half the difference. # We are now at the right. Reset this angle to be half the difference.
# That puts zero in the middle. # That puts zero in the middle.
steering.reset_angle((right_end - left_end)/2) steering.reset_angle((right_end - left_end) / 2)
steering.run_target(speed=200, target_angle=0, wait=False) steering.run_target(speed=200, target_angle=0, wait=False)
# Set steering angle # Set steering angle
steering_angle = (((right_end - left_end)/2)-5) steering_angle = ((right_end - left_end) / 2) - 5
# Set variable for gear # Set variable for gear
gear_total = 2 # Total number of gears. # Total number of gears.
gear_old = None # Empty variable to set later on (keep gear_total = 2
# empty!). # Empty variable to set later on (keep empty!).
gear = 1 # Gear at start (must be higher than 0 and gear_old = None
# lower or eaqual to gear_total). # Gear at start (must be higher than 0 and lower or eaqual to gear_total).
gear_color = ["BLUE", "RED"] # Number of colors should at least be gear = 1
# equal to gear_total. # Number of colors should at least be equal to gear_total.
gear_color = ["BLUE", "RED"]
# Battery variables # Battery variables
voltage_current = hub.battery.voltage() voltage_current = hub.battery.voltage()
@@ -80,14 +81,14 @@ while True:
else: else:
gear = 1 gear = 1
while Button.CENTER in pressed: while Button.CENTER in pressed:
# Button debounce # Button debounce
wait(10) wait(10)
pressed = remote.buttons.pressed() pressed = remote.buttons.pressed()
# Set speed according to the choosen gear. # Set speed according to the choosen gear.
if gear is not gear_old: if gear is not gear_old:
remote.light.on(Color[gear_color[gear-1]]) remote.light.on(Color[gear_color[gear - 1]])
speed = (100/gear_total)*gear speed = (100 / gear_total) * gear
gear_old = gear gear_old = gear
# Choose the drive speed based on the left controls. # Choose the drive speed based on the left controls.
@@ -100,7 +101,7 @@ while True:
# Apply the selected speed. # Apply the selected speed.
driving_1.dc(drive_speed) driving_1.dc(drive_speed)
driving_2.dc(drive_speed) driving_2.dc(drive_speed)
# Choose the winch speed based on the red buttons. # Choose the winch speed based on the red buttons.
winch_speed = 0 winch_speed = 0
if Button.LEFT in pressed: if Button.LEFT in pressed:
@@ -110,7 +111,7 @@ while True:
# Apply the selected speed. # Apply the selected speed.
winch.dc(winch_speed) winch.dc(winch_speed)
# Show battery status by hub LED. # Show battery status by hub LED.
# Get current voltage and gradually up or down the value. # Get current voltage and gradually up or down the value.
voltage_current = hub.battery.voltage() voltage_current = hub.battery.voltage()