def projectaxes(frame, camera): #axis_factor = camera.axis_factor c0 = np.float32([[0, 0, 0]]) a1 = np.float32([[3, 0, 0]]) #* axis_factor # x a2 = np.float32([[0, 3, 0]]) #* axis_factor # y a3 = np.float32([[0, 0, 3]]) #* axis_factor # z ap1, j = cv2.projectPoints(a1, camera.rotation, camera.translation, camera.intrinsics, np.float64([0, 0, 0, 0])) ap2, j = cv2.projectPoints(a2, camera.rotation, camera.translation, camera.intrinsics, np.float64([0, 0, 0, 0])) ap3, j = cv2.projectPoints(a3, camera.rotation, camera.translation, camera.intrinsics, np.float64([0, 0, 0, 0])) cp0, j = cv2.projectPoints(c0, camera.rotation, camera.translation, camera.intrinsics, np.float64([0, 0, 0, 0])) drawaxis(frame, tuple(cp0.ravel().astype(int)), tuple(ap1.ravel().astype(int)), tuple(ap2.ravel().astype(int)), tuple(ap3.ravel().astype(int)))
def projectaxes(frame, camera): #axis_factor = camera.axis_factor c0 = np.float32([[0, 0, 0]]) a1 = np.float32([[3, 0, 0]]) #* axis_factor # x a2 = np.float32([[0, 3, 0]]) #* axis_factor # y a3 = np.float32([[0, 0, 3]]) #* axis_factor # z ap1, j = cv2.projectPoints( a1, camera.rotation, camera.translation, camera.intrinsics, np.float64([0, 0, 0, 0]) ) ap2, j = cv2.projectPoints( a2, camera.rotation, camera.translation, camera.intrinsics, np.float64([0, 0, 0, 0]) ) ap3, j = cv2.projectPoints( a3, camera.rotation, camera.translation, camera.intrinsics, np.float64([0, 0, 0, 0]) ) cp0, j = cv2.projectPoints( c0, camera.rotation, camera.translation, camera.intrinsics, np.float64([0, 0, 0, 0]) ) drawaxis( frame, tuple(cp0.ravel().astype(int)), tuple(ap1.ravel().astype(int)), tuple(ap2.ravel().astype(int)), tuple(ap3.ravel().astype(int)) )
def projectgroundplane(frame, camera): for p in camera.plane: p1, j = cv2.projectPoints(p, camera.rotation, camera.translation, camera.intrinsics, np.float64([0, 0, 0, 0])) drawgroundplane(frame, tuple(p1.ravel().astype(int)))
def projectgroundplane(frame, camera): for p in camera.plane: p1, j = cv2.projectPoints( p, camera.rotation, camera.translation, camera.intrinsics, np.float64([0, 0, 0, 0]) ) drawgroundplane(frame, tuple(p1.ravel().astype(int)))