[feat] Restore GPS management in SLAM lib
- GPS handling had been commented to process tag measurements
- This MR refactors the external sensors and integrate GPS measurements on this new basis
@nick.laurenson PTAL
Edited by Julia Sanchez
@nick.laurenson PTAL