Compute the pose from different features.
#include <visp/vpConfig.h>
#include <visp/vpHomogeneousMatrix.h>
#include <visp/vpPoint.h>
#include <visp/vpDisplay.h>
#include <visp/vpDisplayX.h>
#include <visp/vpImage.h>
#include <visp/vpCameraParameters.h>
#include <visp/vpPoseFeatures.h>
#include <visp/vpPose.h>
#include <iostream>
#include <vector>
#include <visp/vpPose.h>
#include <limits>
#ifdef VISP_HAVE_CPP11_COMPATIBILITY
public:
value += 1;
}
};
}
}
#endif
int main()
{
std::cout << "cMo used for the projection : " << std::endl;
double val = 0.25;
double val2 = 0.0;
0.0,0.0,1.0,0.0);
1.0,0.0,0.0,-0.25);
-1.0,0.0,0.0,-0.25);
#ifdef VISP_HAVE_CPP11_COMPATIBILITY
#endif
std::cout << "cMo used as initialisation of the pose computation : " << std::endl;
std::cout << "Resulting cMo : " << std::endl;
std::cout << "Resulting covariance (Diag): " << std::endl;
std::cout << covariance[0][0] << " "
<< covariance[1][1] << " "
<< covariance[2][2] << " "
<< covariance[3][3] << " "
<< covariance[4][4] << " "
<< covariance[5][5] << " " << std::endl;
int result = 0;
for(unsigned int i = 0 ; i < 6 ; i++){
std::cout << "Bad pose estimation" << std::endl;
result = -1;
break;
}
}
if (result == 0)
std::cout << "Pose well estimed" << std::endl;
return result;
}