Simultaneous localization and mapping: part I
Consistency of the FastSLAM algorithm