diff --git a/src/constraint_odom_3D.h b/src/constraint_odom_3D.h index f99b86fe9ba6e7270c912188a5498970777cacbd..5d01e00b3a2191115bb6519f5c546acf2c7a4580 100644 --- a/src/constraint_odom_3D.h +++ b/src/constraint_odom_3D.h @@ -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,