Skip to content
Snippets Groups Projects
Commit dae47f89 authored by Médéric Fourmy's avatar Médéric Fourmy
Browse files

Fix consistency in ProcessorOdom3d constructor

parent 203518d3
No related branches found
No related tags found
No related merge requests found
Pipeline #5889 passed
...@@ -13,7 +13,11 @@ ProcessorOdom3d::ProcessorOdom3d(ParamsProcessorOdom3dPtr _params) : ...@@ -13,7 +13,11 @@ ProcessorOdom3d::ProcessorOdom3d(ParamsProcessorOdom3dPtr _params) :
min_disp_var_ (0.1), // around 10cm error min_disp_var_ (0.1), // around 10cm error
min_rot_var_ (0.1) // around 6 degrees error min_rot_var_ (0.1) // around 6 degrees error
{ {
// // Set constant parts of Jacobians
jacobian_delta_preint_.setIdentity(6,6);
jacobian_delta_.setIdentity(6,6);
jacobian_calib_.setZero(6,0);
unmeasured_perturbation_cov_ = pow(params_odom_3d_->unmeasured_perturbation_std, 2.0) * Eigen::Matrix6d::Identity();
} }
ProcessorOdom3d::~ProcessorOdom3d() ProcessorOdom3d::~ProcessorOdom3d()
......
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