SLAM and Pose Graph Optimisation