Update

Control/Jetson/main.py

@@ -27,7 +27,7 @@ DO_ZERO = False
 DO_GPS_THERE = False
 DO_VISION_APPROACH = True
 DO_FORK_ALIGN = True
-DO_PICKUP_CARGO = True
+DO_PICKUP_CARGO = False
 DO_REVERSE_TURN = False
 DO_GPS_RETURN = False
 DO_DROPOFF_CARGO = False

Control/Jetson/vision_cargo_approach.py

@@ -128,8 +128,8 @@ class VisionSystem:
 
 class CargoApproachingSystem:
     def __init__(self) -> None:
-        self.ky = 2
-        self.kt = -0.5
+        self.ky = -3
+        self.kt = 0.5
 
     def calculate(self, ey, et):
         delta = self.ky * math.atan(ey) + self.kt * et