2D linear SLAM solver