爆改Hector之当前位置 Alter Hector SLAM Current Pose

Current position of Hector SLAM is maintained under ./hector_slam/hector_mapping/include/hector_slam_lib/slam_main/HectorSlamProcessor.h:

Eigen::Vector3f lastMapUpdatePose;
Eigen::Vector3f lastScanMatchPose;

Function ‘update’ takes a pervious pose on the map and update it by a new position ‘newPoseEstimateWorld’.