NikolajDanger/Roboteksperimentarium
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

✨

Browse Source
This commit is contained in:
NikolajDanger
2022-09-28 14:04:25 +02:00
parent f546e3f8f5
commit 95c011e4e7
1 changed files with 1 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

3
drive_between_arucos.py
View File

@ -51,10 +51,8 @@ def find_arucos(arlo):
position = cv2.aruco.estimatePoseSingleMarkers( position = cv2.aruco.estimatePoseSingleMarkers(
np.array([aruco]), 14.5, CAMERA_MATRIX, DIST_COEF np.array([aruco]), 14.5, CAMERA_MATRIX, DIST_COEF
)[1][0][0] )[1][0][0]
print(position)
position = np.array([position[2], position[0]]) position = np.array([position[2], position[0]])
position[0] += 22.5 position[0] += 22.5
print(position)
aruco_dict[id_] = position aruco_dict[id_] = position
if len(aruco_dict) >= 2: if len(aruco_dict) >= 2:
@ -70,6 +68,7 @@ def find_arucos(arlo):
def main(): def main():
arlo = Robot() arlo = Robot()
aruco_positions = find_arucos(arlo) aruco_positions = find_arucos(arlo)
print(aruco_positions)
position = [ position = [
np.average(aruco_positions[:,0]), np.average(aruco_positions[:,0]),