[feat][PV][refact] ReLoad trajectory from a file
Add a feature that reload trajectory from a file in PV wrapping.
Poses and covariances in Logstates will be reset by the data from the file which have the same timestamps. If there is no information about covariance in the file, the covariances are set by default value.
After reload the trajectory, the trajectory in PV wrapping is updated.
This feature could be used after a pose graph optimization for turning back to the map before optimization. So that one can re-optimize the pose graph.
An example of reloading a trajectory:
Before reloading a trajectory:
After reloading a trajectory:
Edited by Tong Fu