diff --git a/src/processor/processor_tracker_landmark_object.cpp b/src/processor/processor_tracker_landmark_object.cpp index ed34d3404fe567ba9c1030b86bb46bec26a335a8..8ce39e39a5a6aa50c1b74533e739a7c6484f81f4 100644 --- a/src/processor/processor_tracker_landmark_object.cpp +++ b/src/processor/processor_tracker_landmark_object.cpp @@ -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