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:01:11 +02:00
parent eeafcc7f8b
commit 0cb11b5264
1 changed files with 3 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

6
drive_between_arucos.py
View File

@ -50,7 +50,9 @@ def find_arucos(arlo):
print(f"found box {id_}") print(f"found box {id_}")
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] )
print(position)
exit()
position = np.array([position[0], position[1]]) position = np.array([position[0], position[1]])
position[0] += 22.5 position[0] += 22.5
print(id_, position) print(id_, position)
@ -70,8 +72,6 @@ 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]),
np.average(aruco_positions[:,1]) np.average(aruco_positions[:,1])