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

Figure 4

The static state estimation of map features.

(a)

(b)