Method and apparatus for simultaneous localization and mapping of mobile robot environment
First Claim
1. A mobile device tracking system for a mobile device in its physical environment comprising:
- a spatial sensor mounted on the mobile device and configured to scan the physical environment and generate spatial data indicating distances to boundaries and objects from a current position of the mobile device;
a map generator mounted on the mobile device and configured to generate and update a map from the spatial data, the map including the current position of the mobile device; and
a delocalization detector configured to generate a current estimate by estimating the current position within said map by generating position particles indicating at least one of position and orientation of the mobile device within its physical environment, the delocalization detector being further configured to generate and iteratively maintain a data set of said position particles to track a changing position of the mobile device within its physical environment, the delocalization detector including;
i. a particle weight assignor that assigns a weight to each position particle, the particle weight being a relative measure of the likelihood that the position particle accurately represents the current position with respect to other particles;
ii. an erroneous particle generator that introduces erroneous particles having weights that are uniformly low with respect to the weights of the position particles; and
iii. a particle weight comparator that compares the weights of the erroneous particles and the weights of the position particles and determines that the mobile device has become delocalized when a substantial number of erroneous particles have weights that are no longer uniformly low with respect to the weights of the position particles.
2 Assignments
0 Petitions
Accused Products
Abstract
Techniques that optimize performance of simultaneous localization and mapping (SLAM) processes for mobile devices, typically a mobile robot. In one embodiment, erroneous particles are introduced to the particle filtering process of localization. Monitoring the weights of the erroneous particles relative to the particles maintained for SLAM provides a verification that the robot is localized and detection that it is no longer localized. In another embodiment, cell-based grid mapping of a mobile robot'"'"'s environment also monitors cells for changes in their probability of occupancy. Cells with a changing occupancy probability are marked as dynamic and updating of such cells to the map is suspended or modified until their individual occupancy probabilities have stabilized. In another embodiment, mapping is suspended when it is determined that the device is acquiring data regarding its physical environment in such a way that use of the data for mapping will incorporate distortions into the map, as for example when the robotic device is tilted.
19 Citations
18 Claims
-
1. A mobile device tracking system for a mobile device in its physical environment comprising:
-
a spatial sensor mounted on the mobile device and configured to scan the physical environment and generate spatial data indicating distances to boundaries and objects from a current position of the mobile device; a map generator mounted on the mobile device and configured to generate and update a map from the spatial data, the map including the current position of the mobile device; and a delocalization detector configured to generate a current estimate by estimating the current position within said map by generating position particles indicating at least one of position and orientation of the mobile device within its physical environment, the delocalization detector being further configured to generate and iteratively maintain a data set of said position particles to track a changing position of the mobile device within its physical environment, the delocalization detector including; i. a particle weight assignor that assigns a weight to each position particle, the particle weight being a relative measure of the likelihood that the position particle accurately represents the current position with respect to other particles; ii. an erroneous particle generator that introduces erroneous particles having weights that are uniformly low with respect to the weights of the position particles; and iii. a particle weight comparator that compares the weights of the erroneous particles and the weights of the position particles and determines that the mobile device has become delocalized when a substantial number of erroneous particles have weights that are no longer uniformly low with respect to the weights of the position particles. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9)
-
-
10. A method for controlling movement of a mobile device, the method comprising:
-
tracking, with a sensor, movement of the mobile device; generating, with a map generator, a map of the mobile device'"'"'s physical environment, said generating occurring with one of concurrently with and prior to tracking the current position of the mobile device; updating, with the map generator, said map with one of concurrently with and prior to tracking the mobile current position; estimating, with a delocalization detector, the mobile current position within said map by generating position particles, each of said position particles representing one of a potential position and orientation of the mobile device within its physical environment, wherein a data set of said position particles is generated and maintained iteratively to track changing position of the mobile device within its physical environment, said estimating including; i. assigning a weight to each position particle, the particle weight being a relative measure of the likelihood of the position particle accurately representing the current mobile position with respect to other position particles; and ii. introducing erroneous particles having weights that are uniformly low with respect to the weights of the position particles; and iii. comparing the weights of the erroneous particles and the weights of the position particles to determine that the mobile device has become delocalized when a substantial number of erroneous particles have weights that are no longer uniformly low with respect to the weights of the position and controlling movement of the mobile device in accordance with the steps of tracking, updating, and estimating. - View Dependent Claims (11, 12, 13, 14, 15, 16, 17, 18)
-
Specification