SLAM algorithm for range-based measurements using spline surfaces - View it on GitHub