This commit is contained in:
NikolajDanger
2022-11-02 14:49:02 +01:00
parent bcf1ae2a5a
commit 60dbadabe1

View File

@ -99,7 +99,7 @@ def main():
np.array([arucos[landmark]]), 14.5, CAMERA_MATRIX, DIST_COEF
)[1][0][0]
angle = np.rad2deg(np.arctan(position[0]/position[2]))
angle = np.rad2deg(np.arctan(position[0]/position[2])) - 20
drive_distance = np.sqrt(position[0]**2 + position[2]**2) - 120
if angle < 0: