Skip to content
Snippets Groups Projects
Commit ef161c35 authored by Jaime Tarrasó Martínez's avatar Jaime Tarrasó Martínez
Browse files

Remove couts

parent 1aa7d630
No related branches found
No related tags found
No related merge requests found
......@@ -76,7 +76,6 @@ inline ConstraintOdom3D::ConstraintOdom3D(FeatureBasePtr _ftr_current_ptr, Frame
_frame_past_ptr->getPPtr(), // past frame P
_frame_past_ptr->getOPtr()) // past frame Q
{
std::cout << "Created Odom3D constraint" << std::endl;
//
}
......@@ -122,8 +121,8 @@ inline Eigen::VectorXs wolf::ConstraintOdom3D::expectation() const
const Scalar * const frame_past_pos = frm_past->getPPtr()->getVector().data();
const Scalar * const frame_past_ori = frm_past->getOPtr()->getVector().data();
std::cout << "frame_current_pos: " << frm_current->getPPtr()->getVector().transpose() << std::endl;
std::cout << "frame_past_pos: " << frm_past->getPPtr()->getVector().transpose() << std::endl;
// std::cout << "frame_current_pos: " << frm_current->getPPtr()->getVector().transpose() << std::endl;
// std::cout << "frame_past_pos: " << frm_past->getPPtr()->getVector().transpose() << std::endl;
expectation(frame_current_pos,
frame_current_ori,
......
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