# US 2015/0105964 A1 · Method and apparatus for simultaneous localization and mapping of mobile robot environment

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 2015/0105964 A1
- Document ID: US20150105964A1
- Status: Published application
- Kind: A1
- Application number: 14/543,508
- Filed: 2014-11-17
- Published: 2015-04-16
- Earliest claimed: 2009-08-31
- Assignees: Neato Robotics, Inc.
- Applicants: Neato Robotics, Inc.
- Inventors: Boris SOFMAN; Vladimir ERMAKOV; Mark EMMERICH; Steven ALEXANDER; Nathaniel David MONSON
- Web page: https://patentgrep.com/patent/US20150105964A1

## CPC

- G05D 1/0274: {using mapping information stored in a memory device (navigation using map-matching G01C21/30)}
- B25J 9/0003: {Home robots, i.e. small robots for domestic use}
- B25J 9/1602: {characterised by the control system, structure, architecture}
- B25J 11/0085: {Cleaning}
- G05D 1/024: {in combination with a laser (lasers per se H01S)}
- Y10S 901/01: Mobile robot
- Y10S 901/47: Optical
- G05D: SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- B25J: MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES ({manipulators specially adapted for use in surgery A61B34/70; manipulators used in cleaning hollow articles B08B9/04}; manipulators associated with rolling mills B21B39/20; manipulators associated with forging machines B21J13/10; {manipulators associated with picking-up and placing mechanisms B23P19/007}; means for holding wheels or parts thereof B60B30/00; {vehicles with ground-engaging propulsion means, e.g. walking members B62D57/02, B62D57/032; devices for picking-up and depositing articles or materials between conveyors B65G47/90, B65G47/91; manipulators with gripping or holding means for transferring packages B65H67/065}; cranes B66C; {manipulators used in the protection or supervision of pipe-line installations F17D5/00; walking equipment adapted for nuclear steam-generators F22B37/006}; manipulators specially adapted for, or associated with, nuclear reactors G21C; {apparatus used for handling wafers during manufacture or treatment of semiconductor H10P72/50})
- Y10S: TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS

## 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.

## Claims

### Claim 1

A mobile device tracking system comprising:
a. apparatus that generates a map of the device's physical environment, said generating occurring either concurrently with or prior to tracking the device's position, said generating apparatus updating said map either concurrently with or prior to tracking the device's position; and
b. a processing apparatus to determine the device's current location within said map by generating position and/or orientation particles, each of said position and/or orientation particles representing a potential position and/or orientation of the device within its physical environment, wherein a data set of said position and/or orientation particles may be generated and maintained iteratively to track changing position of the device within its physical environment,
c. the processing apparatus including:
i. apparatus that assigns a weight to each position and/or orientation particle, particle weight being a relative measure of the particle's likelihood of accurately representing the robot's position with respect to other position and/or orientation particles;
ii. apparatus that introduces erroneous particles whose potential positions are selected so that their assigned weights should be uniformly low with respect to the weights of the position and/or orientation particles; and
iii. apparatus that compares the weights of the erroneous particles and the weights of the position and/or orientation particles to determine whether 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/or orientation particles.

### Claim 2 (depends on 1)

A mobile device tracking system as claimed in claim 1, wherein the erroneous particles are selected so as to avoid introduction of additional error into the current estimate of the mobile device's position.

### Claim 3 (depends on 1)

A mobile device tracking system as claimed in claim 1, wherein the mobile device is a robot.

### Claim 4 (depends on 1)

A mobile device tracking system as claimed in claim 1, wherein the determination of whether the mobile device has become delocalized includes calculating and monitoring the averaged weight or the median weight of the erroneous particles over multiple iterations.

### Claim 5 (depends on 1)

A mobile device tracking system as claimed in claim 1, wherein the erroneous particles comprise erroneous position particles.

### Claim 6 (depends on 5)

A mobile device tracking system as claimed in claim 5, wherein the determination of whether the mobile device has become delocalized comprises determination of whether the mobile device's position in the physical environment is erroneous.

### Claim 7 (depends on 1)

A mobile device tracking system as claimed in claim 1, wherein the erroneous position particles comprise erroneous inclination particles.

### Claim 8 (depends on 7)

A mobile device tracking system as claimed in claim 7, wherein the determination of whether the mobile device has become delocalized comprises determination of whether the mobile device's inclination in the physical environment is erroneous.

### Claim 9 (depends on 8)

A mobile device tracking system as claimed in claim 8, wherein the determination of whether the mobile device's inclination in the physical environment is erroneous comprises determination of whether a tilt event has occurred.

### Claim 10

A method for controlling movement of a mobile device, the method comprising:
a. generating a map of the mobile device's physical environment, said generating occurring either concurrently with or prior to tracking the mobile device's position;
b. updating said map either concurrently with or prior to tracking the mobile device's position;
c. determining the mobile device's current location within said map by generating particles, each of said particles representing a potential position and/or orientation of the mobile device within its physical environment, wherein a data set of said particles may be generated and maintained iteratively to track changing position of the mobile device within its physical environment, said determining including:
i. assigning a weight to each particle, particle weight being a relative measure of the particle's likelihood of accurately representing the mobile device's position with respect to other particles; and
ii. introducing erroneous particles whose potential positions are selected so that their assigned weights should be uniformly low with respect to the weights of the particles representing a potential position and/or orientation of the mobile device; and
iii. comparing the weights of the erroneous particles and the weights of the particles representing a potential position and/or orientation of the mobile device to determine whether 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 particles representing a potential position and/or orientation of the mobile device.
d. The method further comprising controlling movement of the mobile device in accordance with (a) to (c).

### Claim 11 (depends on 10)

A method as claimed in claim 10, wherein the erroneous particles are selected so as to avoid introduction of additional error into the current estimate of the mobile device's position.

### Claim 12 (depends on 10)

A method as claimed in claim 10, wherein the mobile device is a robot.

### Claim 13 (depends on 10)

A method as claimed in claim 10, wherein the determination of whether the mobile device has become delocalized includes calculating and monitoring the averaged weight or the median weight of the erroneous particles over multiple iterations.

### Claim 14 (depends on 10)

A method as claimed in claim 10, wherein the erroneous particles comprise erroneous position particles.

### Claim 15 (depends on 14)

A method as claimed in claim 14, wherein the determination of whether the mobile device has become delocalized comprises determination of whether the mobile device's position in the physical environment is erroneous.

### Claim 16 (depends on 10)

A method as claimed in claim 10, wherein the erroneous position particles comprise erroneous inclination particles.

### Claim 17 (depends on 16)

A method as claimed in claim 16, wherein the determination of whether the mobile device has become delocalized comprises determination of whether the mobile device's inclination in the physical environment is erroneous.

### Claim 18 (depends on 17)

A method as claimed in claim 17, wherein the determination of whether the mobile device's inclination in the physical environment is erroneous comprises determination of whether a tilt event has occurred.
