✨

drive_between_arucos.py

@@ -76,7 +76,7 @@ def main():
     ]
     print(position)
 
-    angle = np.rad2deg(np.arctan(position[1]/position[0]))
+    angle = np.rad2deg(np.arctan(position[0]/position[1]))
     drive_distance = np.sqrt(position[0]**2 + position[1]**2)
     if angle < 0:
         arlo.go_diff(POWER, POWER, 0, 1)