From c632c1cc164c67cbafa73366cf9a3409666fbb6c Mon Sep 17 00:00:00 2001
From: Edvin <edj7467@gmail.com>
Date: Thu, 8 May 2025 11:40:26 +0200
Subject: Added goal communication

---
 main.py | 9 +++++++--
 1 file changed, 7 insertions(+), 2 deletions(-)

(limited to 'main.py')

diff --git a/main.py b/main.py
index d1a05a7..06b27cd 100755
--- a/main.py
+++ b/main.py
@@ -164,8 +164,13 @@ if bto.find("Connected") != -1:
                 sleep(0.45)
                 NANO.write(b"Stop\n")
             elif bto == "420":
-                print("reset")
-                desDir = 0
+                NANO.write(b"Goal\n")
+                print(NANO.readline())
+                GPIO.output(LED, True)
+                goal_read = False
+                while goal_read == False:
+                    goal_read = GPIO.input(PT)
+                GPIO.output(LED, False)
             elif bto == "0":
                 NANO.write(b"Stop\n")
                 forward = False
-- 
cgit v1.2.3