Mapping, planning and exploration with Pose SLAM. ([2018])