Skip to content
GitLab
Menu
Projects
Groups
Snippets
Help
Help
Support
Community forum
Keyboard shortcuts
?
Submit feedback
Contribute to GitLab
Sign in / Register
Toggle navigation
Menu
Open sidebar
Guilhem Saurel
pinocchio
Commits
b6c3684b
Commit
b6c3684b
authored
Sep 21, 2016
by
Joseph Mirabel
Committed by
Joseph Mirabel
Sep 21, 2016
Browse files
[Doc] Add doc for firstOrderNormalize
parent
ded514db
Changes
1
Hide whitespace changes
Inline
Side-by-side
src/math/quaternion.hpp
View file @
b6c3684b
...
...
@@ -65,7 +65,13 @@ namespace se3
/// of the normalization function.
///
/// Only additions and multiplications are required. Neither square root nor
/// division are used (except a division by 2).
/// division are used (except a division by 2). Let \f$ \delta = ||q||^2 - 1 \f$.
/// Using the following limited development:
/// \f[ \frac{1}{||q||} = (1 + \delta)^{-\frac{1}{2}} = 1 - \frac{\delta}{2} + \mathcal{O}(\delta^2) \f]
///
/// The output is
/// \f[ q_{out} = q \times \frac{3 - ||q_{in}||^2}{2} \f]
///
/// The output quaternion is guaranted to statisfy the following:
/// \f[ | ||q_{out}|| - 1 | \le \frac{M}{2} ||q_{in}|| ( ||q_{in}||^2 - 1 )^2 \f]
/// where \f$ M = \frac{3}{4} (1 - \epsilon)^{-\frac{5}{2}} \f$
...
...
Write
Preview
Supports
Markdown
0%
Try again
or
attach a new file
.
Attach a file
Cancel
You are about to add
0
people
to the discussion. Proceed with caution.
Finish editing this message first!
Cancel
Please
register
or
sign in
to comment