[feat] Add pose graph optimization with ext poses
-
This can be used with external INS (IMU + GNSS) or another SLAM trajectory
-
Here is a video to show the process and the result.
-
This MR contains a big refact about odom frame handling and trajectory rigid motion
Edited by Julia Sanchez