NikolajDanger/Roboteksperimentarium
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

✨

Browse Source
This commit is contained in:
NikolajDanger
2022-09-14 14:47:09 +02:00
parent 9c522cd566
commit 2cc7c7b05c
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
careful_forward.py
View File

@ -12,12 +12,12 @@ def careful_forward(drive_time, arlo):
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 all(x > 300 for x in [forward_dist, right_dist, left_dist]): if all(x > 500 for x in [forward_dist, right_dist, left_dist]):
print("not blocked") print("not blocked")
arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 1, 1) arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 1, 1)
else: else:
print("blocked") print("blocked")
if right_dist > 300: if right_dist > 500:
arlo.go_diff(POWER, POWER, 1, 0) arlo.go_diff(POWER, POWER, 1, 0)
else: else:
arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 0, 1) arlo.go_diff(POWER, POWER + RIGHT_WHEEL_OFFSET, 0, 1)