US Patent 9927814 System and method for localization of robots

A method for localization of robots in a territory of interest includes: providing a mobile robot comprising a processor configured to compute an estimated pose of the mobile robot in a map of a territory of interest using a particle filter comprising a particle; updating, by the processor, a pose in the map of the particle; deciding, by the processor, whether to retain the particle for the next cycle of the particle filter or to eliminate the particle for the next cycle of the particle filter; and sampling the particle filter, by the processor, so as to achieve localization of robots in a territory of interest.