From 82d58a4ec50a8bee76cbe300ef9a4db4fa9df1be Mon Sep 17 00:00:00 2001 From: Edvin Date: Mon, 12 May 2025 13:41:55 +0200 Subject: Fixed status messages and added direction --- main.py | 7 ++++++- 1 file changed, 6 insertions(+), 1 deletion(-) (limited to 'main.py') diff --git a/main.py b/main.py index 3f5f5c3..ae57298 100755 --- a/main.py +++ b/main.py @@ -162,6 +162,7 @@ if bto.find("Connected") != -1: NANO.write(b"Stop\n") sleep(0.1) NANO.write(b"Right\n") + NANO.write(f"Current status {xstatus} {ystatus} {dirstatus}\n".encode()) sleep(0.9) NANO.write(b"Stop\n") @@ -177,6 +178,7 @@ if bto.find("Connected") != -1: NANO.write(b"Stop\n") sleep(0.1) NANO.write(b"Left\n") + NANO.write(f"Current status {xstatus} {ystatus} {dirstatus}\n".encode()) sleep(0.9) NANO.write(b"Stop\n") @@ -192,6 +194,7 @@ if bto.find("Connected") != -1: NANO.write(b"Stop\n") sleep(0.1) NANO.write(b"Right\n") + NANO.write(f"Current status {xstatus} {ystatus} {dirstatus}\n".encode()) sleep(0.5) NANO.write(b"Stop\n") @@ -207,6 +210,7 @@ if bto.find("Connected") != -1: NANO.write(b"Stop\n") sleep(0.1) NANO.write(b"Left\n") + NANO.write(f"Current status {xstatus} {ystatus} {dirstatus}\n".encode()) sleep(0.5) NANO.write(b"Stop\n") @@ -283,8 +287,9 @@ if bto.find("Connected") != -1: xstatus = str(x).zfill(4) ystatus = str(y).zfill(4) + dirstatus = str(curDir).zfill(3) if iteration > delay: - NANO.write(f"Current status {xstatus} {ystatus}\n".encode()) + NANO.write(f"Current status {xstatus} {ystatus} {dirstatus}\n".encode()) iteration += 1 print("Terminating LIDAR process") -- cgit v1.2.3