FastSLAM 2.0: least-squares approach