Faster SE(3) and SE_2(3) exponential maps #1979
Open
+74
−82
Add this suggestion to a batch that can be applied as a single commit.
This suggestion is invalid because no changes were made to the code.
Suggestions cannot be applied while the pull request is closed.
Suggestions cannot be applied while viewing a subset of changes.
Only one suggestion per line can be applied in a batch.
Add this suggestion to a batch that can be applied as a single commit.
Applying suggestions on deleted lines is not supported.
You must change the existing code in this line in order to create a valid suggestion.
Outdated suggestions cannot be applied.
This suggestion has been applied or marked resolved.
Suggestions cannot be applied from pending reviews.
Suggestions cannot be applied on multi-line comments.
Suggestions cannot be applied while the pull request is queued to merge.
Suggestion cannot be applied right now. Please check back later.
DexpFunctor
was instantiated several times:SO3::Expmap
ExmapTranslation
, twice so inNavState
This PR
ExpmapTranslation
and inlines it in the 4 places it was used;Pose3
andNavstate
Expmaps
, we also now use the one instantiatedDexpFunctor
to compute the rotation;This PR saves a bunch of compute (many sines and cosines, and computation of skew W and W*W) and is more "transparent" about what is going on. In addition, the X=R^T saves even more on top of that.