Skip to content
Snippets Groups Projects
Commit 570413c5 authored by Joseph Mirabel's avatar Joseph Mirabel Committed by Joseph Mirabel
Browse files

[Doc] Add developer doc to JointModelFreeFlyer::integrate_impl

parent 84b43247
No related branches found
No related tags found
No related merge requests found
......@@ -276,6 +276,8 @@ namespace se3
res.head<3>() = M1.translation();
QuaternionMap_t res_quat(res.tail<4>().data());
res_quat = M1.rotation();
// Norm of qs might be epsilon-different to 1, so M1.rotation might be epsilon-different to a rotation matrix.
// It is then safer to re-normalized after converting M1.rotation to quaternion.
firstOrderNormalize(res_quat);
return res;
......
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