✨
This commit is contained in:
4
rally.py
4
rally.py
@@ -52,12 +52,12 @@ def careful_forward(drive_time, arlo, careful_range = 600):
|
|||||||
forward_dist = arlo.read_front_ping_sensor()
|
forward_dist = arlo.read_front_ping_sensor()
|
||||||
right_dist = arlo.read_right_ping_sensor()
|
right_dist = arlo.read_right_ping_sensor()
|
||||||
left_dist = arlo.read_left_ping_sensor()
|
left_dist = arlo.read_left_ping_sensor()
|
||||||
if forward_dist > careful_range and all(x > 400 for x in [right_dist, left_dist]):
|
if forward_dist > careful_range and all(x > 250 for x in [right_dist, left_dist]):
|
||||||
turning = None
|
turning = None
|
||||||
arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 1, 1)
|
arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 1, 1)
|
||||||
else:
|
else:
|
||||||
hit_something = True
|
hit_something = True
|
||||||
if turning == "R" or (forward_dist > careful_range and right_dist > 400 and turning is None):
|
if turning == "R" or (forward_dist > careful_range and right_dist > 250 and turning is None):
|
||||||
arlo.go_diff(POWER, POWER, 1, 0)
|
arlo.go_diff(POWER, POWER, 1, 0)
|
||||||
turning = "R"
|
turning = "R"
|
||||||
else:
|
else:
|
||||||
|
|||||||
Reference in New Issue
Block a user