This commit is contained in:
NikolajDanger
2022-09-14 14:57:03 +02:00
parent 3ca0a59c5f
commit 26e2ab97a1

View File

@ -12,12 +12,12 @@ def careful_forward(drive_time, arlo):
forward_dist = arlo.read_front_ping_sensor()
right_dist = arlo.read_right_ping_sensor()
left_dist = arlo.read_left_ping_sensor()
if forward_dist > 500 and all(x > 250 for x in [right_dist, left_dist]):
if forward_dist > 600 and all(x > 200 for x in [right_dist, left_dist]):
print("not blocked")
arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 1, 1)
else:
print("blocked")
if right_dist > 250:
if right_dist > 200:
arlo.go_diff(POWER, POWER, 1, 0)
else:
arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 0, 1)