Format document
This commit is contained in:
@@ -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()
|
||||||
@@ -92,8 +93,8 @@ while True:
|
|||||||
|
|
||||||
# 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.
|
||||||
|
|||||||
@@ -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()
|
||||||
@@ -98,8 +99,8 @@ while True:
|
|||||||
|
|
||||||
# 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.
|
||||||
|
|||||||
@@ -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
|
||||||
|
|||||||
@@ -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()
|
||||||
@@ -89,8 +90,8 @@ while True:
|
|||||||
|
|
||||||
# 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.
|
||||||
|
|||||||
@@ -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()
|
||||||
@@ -92,8 +93,8 @@ while True:
|
|||||||
|
|
||||||
# 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.
|
||||||
|
|||||||
+14
-16
@@ -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()
|
||||||
@@ -98,8 +99,8 @@ while True:
|
|||||||
|
|
||||||
# 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.
|
||||||
@@ -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()
|
||||||
@@ -92,8 +93,8 @@ while True:
|
|||||||
|
|
||||||
# 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.
|
||||||
|
|||||||
@@ -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()
|
||||||
@@ -86,8 +87,8 @@ while True:
|
|||||||
|
|
||||||
# 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.
|
||||||
|
|||||||
Reference in New Issue
Block a user