Updated SLAM