Skip to content
Snippets Groups Projects
Commit 6f3f12cc authored by Mederic Fourmy's avatar Mederic Fourmy
Browse files

We can't put a Quaterniond operator randomly here

parent 5be31508
No related branches found
No related tags found
No related merge requests found
......@@ -637,15 +637,6 @@ bool ProcessorTrackerLandmarkObject::matchingRANSAC(const std::vector<Eigen::Iso
return true;
}
std::ostream &operator<<(std::ostream &flux, Quaterniond quat)
{
flux << quat.x() << " ";
flux << quat.y() << " ";
flux << quat.z() << " ";
flux << quat.w() << " ";
return flux;
}
bool ProcessorTrackerLandmarkObject::isInliers(Eigen::Isometry3d cl_M_ol, Eigen::Isometry3d ci_M_oi, Eigen::Isometry3d cl_M_ci)
{
......@@ -667,7 +658,7 @@ bool ProcessorTrackerLandmarkObject::isInliers(Eigen::Isometry3d cl_M_ol, Eigen:
quat_feat_identity.coeffs() = R2q(wRf_i).coeffs().transpose();
Vector3d pos_feat_identity = identity.translation();
std::cout << "\n\n\n\n\n" << quat_feat << " " << quat_feat_identity << std::endl;
std::cout << "\n\n\n\n\n" << quat_feat.coeffs().transpose() << " " << quat_feat_identity.coeffs().transpose() << std::endl;
std::cout << pos_feat << "\n" << pos_feat_identity << "\n\n\n\n\n" << std::endl;
// Error between identity and ol_M_oi
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment