disparity_to_point_3d — Transform an image point and its disparity into a 3D point in a rectified stereo system.
Given an image point of the rectified camera 1, specified by its image coordinates (Row1,Col1), and its disparity in a rectified binocular stereo system, disparity_to_point_3d computes the corresponding three dimensional object point. Whereby the disparity value Disparity defines the column difference of the image coordinates of two corresponding features on an epipolar line according to the equation d = c2 - c1 . The rectified binocular camera system is specified by its internal camera parameters CamParamRect1 of the projective camera 1 and CamParamRect2 of the projective camera 2, and the external parameters RelPoseRect defining the pose of the rectified camera 2 in relation to the rectified camera 1. These camera parameters can be obtained from the operators calibrate_cameras and gen_binocular_rectification_map. The 3D point is returned in Cartesian coordinates (X,Y,Z) of the rectified camera system 1.
Rectified internal camera parameters of the projective camera 1.
Number of elements: CamParamRect1 == 8 || CamParamRect1 == 12
Rectified internal camera parameters of the projective camera 2.
Number of elements: CamParamRect2 == 8 || CamParamRect2 == 12
Pose of the rectified camera 2 in relation to the rectified camera 1.
Number of elements: 7
Row coordinate of a point in the rectified image 1.
Column coordinate of a point in the rectified image 1.
Disparity of the images of the world point.
X coordinate of the 3D point.
Y coordinate of the 3D point.
Z coordinate of the 3D point.
disparity_to_point_3d returns 2 (H_MSG_TRUE) if all parameter values are correct. If necessary, an exception is raised.
binocular_disparity, binocular_distance, intersect_lines_of_sight