A FastSLAM Algorithm Based on Nonlinear Adaptive Square Root Unscented Kalman Filter

Figure 1

Schematic diagram of SLAM problem.