Skip to content
Snippets Groups Projects
Commit c7a7581c authored by Joan Solà Ortega's avatar Joan Solà Ortega
Browse files

Little changes cosmetic

parent f26bc60c
No related branches found
No related tags found
No related merge requests found
...@@ -234,7 +234,7 @@ void ProcessorIMU::computeCurrentDelta(const Eigen::VectorXs& _data, ...@@ -234,7 +234,7 @@ void ProcessorIMU::computeCurrentDelta(const Eigen::VectorXs& _data,
assert(_data.size() == data_size_ && "Wrong data size!"); assert(_data.size() == data_size_ && "Wrong data size!");
using namespace Eigen; using namespace Eigen;
Matrix<Scalar, 9, 6> jac_data; Matrix<Scalar, 9, 6> jac_delta_data;
/* /*
* We have the following computing pipeline: * We have the following computing pipeline:
...@@ -255,13 +255,13 @@ void ProcessorIMU::computeCurrentDelta(const Eigen::VectorXs& _data, ...@@ -255,13 +255,13 @@ void ProcessorIMU::computeCurrentDelta(const Eigen::VectorXs& _data,
*/ */
// create delta // create delta
imu::body2delta(_data - _calib, _dt, _delta, jac_data); // Jacobians tested in imu_tools imu::body2delta(_data - _calib, _dt, _delta, jac_delta_data); // Jacobians tested in imu_tools
// compute delta_cov // compute delta_cov
_delta_cov = jac_data * _data_cov * jac_data.transpose(); _delta_cov = jac_delta_data * _data_cov * jac_delta_data.transpose();
// compute jacobian_calib // compute jacobian_calib
_jac_delta_calib = - jac_data; _jac_delta_calib = - jac_delta_data;
} }
......
...@@ -296,7 +296,7 @@ bool ProcessorMotion::keyFrameCallback(FrameBasePtr _new_keyframe, const Scalar& ...@@ -296,7 +296,7 @@ bool ProcessorMotion::keyFrameCallback(FrameBasePtr _new_keyframe, const Scalar&
// reintegrateBuffer(new_capture); // reintegrateBuffer(new_capture);
// create motion constraint and add it to the feature, and constrain to the other capture (origin) // create motion constraint and add it to the feature, and constrain to the other capture (origin)
emplaceConstraint(new_feature, keyframe_origin->getCaptureOf(getSensorPtr()) ); // XXX it was new_keyframe_origin emplaceConstraint(new_feature, keyframe_origin->getCaptureOf(getSensorPtr()) );
......
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