Least Squares for Graph-Based SLAM