更新 Vision/get_position_test.py

This commit is contained in:
cdeyw
2024-09-19 03:48:23 +00:00
parent 1596810d10
commit ba9f28406d

View File

@ -19,7 +19,7 @@ while True:
print('nx_ny_nz法向量', nx_ny_nz)
img = cv2.resize(img,(720, 540))
transformation_matrix = R_matrix(521.534, 0.705, 850.03, 0.0, 90.0, 0.0) # (x, y, z, u, v, w)
target_position, noraml_base = getPosition(xyz[0], xyz[1], xyz[2], nx_ny_nz[0], nx_ny_nz[1], nx_ny_nz[2], transformation_matrix)
target_position, noraml_base = getPosition(xyz[0], xyz[1], xyz[2], nx_ny_nz[0], nx_ny_nz[1], nx_ny_nz[2], transformation_matri,box)
print("target_position:", target_position)
print("noraml_base", noraml_base)
cv2.imshow('img', img)