mola_relocalization
C++ library with algorithms for relocalization, global localization, or pose estimation given a large initial uncertainty
Links
README
mola_relocalization
C++ library with algorithms for relocalization, global localization, or pose estimation given a large initial uncertainty.
Note that particle filtering is implemented in its own repository under mrpt_navigation.
Example result for the mola::Relocalization_SE2
method (from a unit test, see the code for details):
Figure: (top-left) Reference map. (bottom-left) Query map (actually, a decimated version is used internally). (top-right) Visualization of a slice of the returned likelihood field over a SE(2) ROI. The “slice” is for orientation (phi) equal to 0 (close to the actual pose transformation between the two maps). (bottom-right) The same likelihood slice, in real (x,y) coordinates (meters). The clear peak reveals, approximately, the location of the sought SE(2) transformation between the maps. Further refining is possible using ICP using this as initial guess.
Build and install
Refer to the root MOLA repository.
Docs and examples
See this package page in the documentation.
License
This package is released under the GNU GPL v3 license. Other options available upon request.