Simultaneous localization and mapping for a mobile robot
First Claim
1. A method comprising:
- receiving, at a computing device, sensor data from an autonomous mobile robot operating in a work environment;
updating, using the computing device, an occupancy map of the work environment with location occupancy probabilities based on the received sensor data;
determining, using the computing device, a localization quality of the autonomous mobile robot; and
when the localization quality does not satisfy a threshold localization quality, executing, using the computing device, a wall-following behavior that causes the autonomous mobile robot to maneuver toward a wall in the work environment and drive adjacent to the wall until the localization quality satisfies the threshold localization quality.
4 Assignments
0 Petitions
Accused Products
Abstract
A method of simultaneous localization and mapping includes initializing a robot pose and a particle model of a particle filter. The particle model includes particles, each having an associated map, robot pose, and weight. The method includes receiving sparse sensor data from a sensor system of the robot, synchronizing the received sensor data with a change in robot pose, accumulating the synchronized sensor data over time, and determining a robot localization quality. When the accumulated sensor data exceeds a threshold accumulation and the robot localization quality is greater than a threshold localization quality, the method includes updating particles with accumulated synchronized sensor data. The method includes determining a weight for each updated particle of the particle model and setting a robot pose belief to the robot pose of the particle having the highest weight when a mean weight of the particles is greater than a threshold particle weight.
-
Citations
29 Claims
-
1. A method comprising:
-
receiving, at a computing device, sensor data from an autonomous mobile robot operating in a work environment; updating, using the computing device, an occupancy map of the work environment with location occupancy probabilities based on the received sensor data; determining, using the computing device, a localization quality of the autonomous mobile robot; and when the localization quality does not satisfy a threshold localization quality, executing, using the computing device, a wall-following behavior that causes the autonomous mobile robot to maneuver toward a wall in the work environment and drive adjacent to the wall until the localization quality satisfies the threshold localization quality. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15)
-
-
16. A method comprising:
-
receiving, at a computing device, sensor data from an autonomous mobile robot operating in a work environment; updating, using the computing device, an occupancy map of the work environment with location occupancy probabilities based on the received sensor data; determining, using the computing device, a localization quality of the autonomous mobile robot; and when the localization quality does not satisfy a threshold localization quality; identifying, using the computing device, a mapped object on the occupancy map; and issuing a drive command from the computing device to a drive system of the autonomous mobile robot to maneuver the autonomous mobile robot toward the mapped object in the work environment to re-localize the autonomous mobile robot based on the sensor data. - View Dependent Claims (17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29)
-
Specification