From 9e5aabc05c41365bffeedc20fe50be26cb02bbbb Mon Sep 17 00:00:00 2001 From: Edvin Date: Wed, 7 May 2025 13:41:49 +0200 Subject: Improved LIDAR implementations --- main.py | 25 +++++++++++++------------ 1 file changed, 13 insertions(+), 12 deletions(-) (limited to 'main.py') diff --git a/main.py b/main.py index f87fcbf..0fe2dc8 100755 --- a/main.py +++ b/main.py @@ -200,18 +200,19 @@ if bto.find("Connected") != -1: sleep(1) GPIO.output(LED, False) - iteration += 1 - - if iteration == 10: - with open("distances.txt", "r") as f: - for line in f: - a, d = line.split() - a = int(a) - d = int(d) - - if (a < 20 or a > 340) and d < 20: - print("Something in front") - forward = False + with open("distances.txt", "r") as f: + for line in f: + a, d = line.split() + a = int(a) + d = int(d) + + if (a < 20 or a > 340) and d < 300: + forward = False + if backward == False: + NANO.write(b"Stop\n") + + if (a > 160 and a < 200): + print(f"{a}, {d}") if forward: NANO.write(b"Forward\n") -- cgit v1.2.3