From e7c40d60cd1208cee3e9813192deed3d7f8c431c Mon Sep 17 00:00:00 2001 From: Edvin Date: Mon, 12 May 2025 13:54:55 +0200 Subject: AGV will try to adjust always to get best rotation --- main.py | 8 ++++---- 1 file changed, 4 insertions(+), 4 deletions(-) (limited to 'main.py') diff --git a/main.py b/main.py index 47105d7..eb2b797 100755 --- a/main.py +++ b/main.py @@ -31,25 +31,25 @@ def calcCurDir(x, y, xo, yo): def adjustAngle(adiff, f, b): if f == True: print("Going forward") - if adiff < -10: + if adiff < 0: print("Adjusting to the right") NANO.write(b"Right\n") sleep(abs(adiff) / 90) NANO.write(b"Stop\n") - elif adiff > 10: + elif adiff > 0: print("Adjusting to the left") NANO.write(b"Left\n") sleep(abs(adiff) / 90) NANO.write(b"Stop\n") elif b == True: print("Going backward") - if adiff > 10: + if adiff > 0: adiff -= 180 print(f"Adjusting to the right {adiff}") NANO.write(b"Right\n") sleep(abs(adiff) / 90) NANO.write(b"Stop\n") - elif adiff < -10: + elif adiff < 0: adiff += 180 print(f"Adjusting to the left {adiff}") NANO.write(b"Left\n") -- cgit v1.2.3