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
@@ -45,16 +45,17 @@ 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()
@@ -51,16 +51,17 @@ 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()
@@ -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.
@@ -67,10 +67,10 @@ 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.
+9 -8
View File
@@ -42,16 +42,17 @@ 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()
@@ -45,16 +45,17 @@ 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()
@@ -49,18 +49,19 @@ 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()
@@ -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)
@@ -45,16 +45,17 @@ 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()
@@ -46,16 +46,17 @@ 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()