calculate disparity value for distance

asked 2015-10-11 06:35:36 -0600

hGen gravatar image

updated 2015-10-11 06:46:53 -0600

Hi everyone, I want to reverse the whole procsess of projecting a disparity value to 3D word space in order to get the exact disparity value belonging to a specific distance.

This is the code I use to calculate a 3d-coordinate:

cv::Mat_<float> coordinate(1,4);
dValue /= 16.0;

coordinate(0)=x;
coordinate(1)=y;
coordinate(2)=dValue;
coordinate(3)=1;

coordinate = cv::Mat(coordinate);

coordinate = Q * coordinate.t();
coordinate /= coordinate(3);
return coordinate;

Now I thought about writing the inverse calculation in Order to get the disparity value for a specific distance:

// coordinate in the world origin with a distance of 1.0 meter.
cv::Mat_<float> coordinate(1,4);
coordinate(0) = 0.0f;
coordinate(1) = 0.0f;
coordinate(2) = 1.0f;
coordinate(3) = 1.0f;

cv::Mat Q_inv = Q.inv(cv::DECOMP_SVD);
Q_inv.convertTo(Q_inv, CV_32FC1);

cv::Mat_<float> back = Q_inv * coordinate.t();
// just makes the value bigger and does not result in a correct value
// back(2) */ 16;

To my mind the calculation is mathematically correct. But the returned values do not match anything related to the disparity values:

disparityValue: 688  distance: 0.901838
calculated coordinate:
[1.5896965;
 1.3923311;
 119.25928;
 0.0015376776]

Does somebody know where the problem could be?

edit retag flag offensive close merge delete