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

Merge branch 'devel' into '184-work-on-const-non-const-in-wolf-base-classes'

# Conflicts:
#   src/processor/processor_odom_3D.cpp
parents 0da54d2b e83c49af
No related branches found
No related tags found
1 merge request!301Resolve "Work on const / non-const in wolf base classes"
Pipeline #4315 passed
...@@ -56,7 +56,7 @@ void ProcessorOdom3D::computeCurrentDelta(const Eigen::VectorXs& _data, ...@@ -56,7 +56,7 @@ void ProcessorOdom3D::computeCurrentDelta(const Eigen::VectorXs& _data,
// rotation in quaternion form // rotation in quaternion form
_delta = _data; _delta = _data;
disp = _data.head<3>().norm(); disp = _data.head<3>().norm();
rot = 2.0 * acos(_data(3)); rot = 2.0 * acos(_data(6)); // '6' is the real part of the quaternion
} }
/* Jacobians of d = data2delta(data, dt) /* Jacobians of d = data2delta(data, dt)
* with: d = [Dp Dq] * with: d = [Dp Dq]
......
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