camera digital object identifier domestic robot image registration imperial college london iteration kalman filter laser rangefinder monte carlo localization monte carlo method particle filter robot sebastian thrun sensor sonar university of groningen