A flexible and scalable SLAM system with full 3D motion estimation
The unscented Kalman filter for nonlinear estimation