This commit is contained in:
NikolajDanger
2022-10-24 14:34:46 +02:00
parent f822019bd1
commit 4e41d872ce

View File

@ -91,7 +91,7 @@ def main():
)[1][0][0] )[1][0][0]
angle = np.rad2deg(np.arctan(position[0]/position[2])) angle = np.rad2deg(np.arctan(position[0]/position[2]))
drive_distance = np.sqrt(position[0]**2 + position[2]**2) - 20 drive_distance = np.sqrt(position[0]**2 + position[2]**2) - 10
if angle < 0: if angle < 0:
noah.go_diff(POWER, POWER, 0, 1) noah.go_diff(POWER, POWER, 0, 1)
time.sleep((abs(angle) * TURN_T)/1000) time.sleep((abs(angle) * TURN_T)/1000)