Localization and Mapping Using Physical Features

• US 20170239813A1
• Filed: 03/07/2017
• Published: 08/24/2017
• Est. Priority Date: 03/18/2015
• Status: Active Grant

• Current Assignee: iRobot Corporation
• Original Assignee: iRobot Corporation
• Inventors: Vicenti, Jasper
• Granted Patent: US 10,500,722 B2
• Time in Patent Office: Days
• CPC Class Codes: A47L 2201/00 Robotic cleaning machines, i.e. with automatic control of the travelling movement or the cleaning operation
• CPC Class Codes: A47L 2201/04 Automatic control of the travelling movement; Automatic obstacle detection
• CPC Class Codes: B25J 9/163 learning, adaptive, model based, rule based expert control
• CPC Class Codes: B25J 9/1664 characterised by motion, path, trajectory planning
• CPC Class Codes: B25J 9/1666 Avoiding collision or forbidden zones
• CPC Class Codes: G05D 1/0219 ensuring the processing of the whole working surface
• CPC Class Codes: G05D 1/0227 using mechanical sensing means, e.g. for sensing treated area
• CPC Class Codes: G05D 1/0238 using obstacle or wall sensors G05D1/0246 and G05D1/0289 take precedence; lidar systems designed for anti-collision purposes G01S17/93
• CPC Class Codes: G05D 1/0272 comprising means for registering the travel distance, e.g. revolutions of wheels measuring distance traversed on the ground by vehicles, e.g. using odometers G01C22/00
• CPC Class Codes: G05D 1/0274 using mapping information stored in a memory device navigation using map-matching G01C21/30
• CPC Class Codes: G05D 1/246 using environment maps, e.g. simultaneous localisation and mapping [SLAM]
• CPC Class Codes: G05D 1/628 following the obstacle profile, e.g. a wall or undulated terrain
• CPC Class Codes: Y10S 901/01 Mobile robot

Abstract

A method includes maneuvering a robot in (i) a following mode in which the robot is controlled to travel along a path segment adjacent an obstacle, while recording data indicative of the path segment, and (ii) in a coverage mode in which the robot is controlled to traverse an area. The method includes generating data indicative of a layout of the area, updating data indicative of a calculated robot pose based at least on odometry, and calculating a pose confidence level. The method includes, in response to the confidence level being below a confidence limit, maneuvering the robot to a suspected location of the path segment, based on the calculated robot pose and the data indicative of the layout and, in response to detecting the path segment within a distance from the suspected location, updating the data indicative of the calculated pose and/or the layout.

Claims

1-16. -16. (canceled)

17. A method of navigating an autonomous cleaning robot within an area, the method comprising:

maneuvering the robot about the area to clean the area while generating data indicative of a robot pose relative to a physical layout of the area or data indicative of a physical layout of the area, the physical layout of the area defined by one or more edges;

in response to a robot pose confidence level being below a predetermined confidence limit, selecting a path segment from among a plurality of path segments adjacent the one or more edges and selecting a trajectory of the robot to approach a suspected location of the path segment;

maneuvering the robot along the selected trajectory toward the suspected location of the path segment; and

in response to detecting the path segment within a distance from the suspected location of the path segment, updating the data indicative of the robot pose or the data indicative of the physical layout of the area.

18. The method of claim 17, further comprising storing data indicative of locations of the plurality of path segments while the robot is maneuvered about the area.

19. The method of claim 18, wherein the path segment is selected based on a duration of time elapsed between storing the data and the confidence level being less than a predetermined confidence limit.

20. The method of claim 17, wherein the path segment is selected based on a shortest of distances between a current location of the robot and each of the plurality of path segments.

21. The method of claim 17, wherein updating the data indicative of the robot pose or the data indicative of the physical layout of the area comprises re-localizing data indicative of locations of two or more of the plurality of path segments to the data indicative of the physical layout of the area.

22. The method of claim 17, further comprising collecting data from a sensor on the robot while maneuvering the robot about the area and while updating the data indicative of the robot pose or the data indicative of the physical layout of the area based on the collected data.

23. The method of claim 22, wherein the sensor comprises an odometer, a radiation transceiver, a bump sensor, a pressure sensor, or a proximity sensor.

24. The method of claim 17, further comprising, after maneuvering the robot to the suspected location of the path segment, maneuvering the robot in a following mode to follow an edge of the one or more edges, the edge being proximate the suspected location of the path segment,

wherein updating the data indicative of the robot pose or the data indicative of the physical layout of the area comprises:

determining whether a path of the robot along the edge matches the path segment, and

upon determining a match, updating the data indicative of the robot pose or the data indicative of the physical layout of the area.

25. The method of claim 24, wherein determining whether the path of the robot along the edge matches the path segment comprises comparing lengths, starting poses, ending poses, straight distances traveled, or curvatures of the path of the robot and the path segment.

26. The method of claim 17, wherein detecting the path segment within the distance from the suspected location of the path segment comprises detecting an edge proximate the path segment.

27. The method of claim 26, wherein detecting the edge comprises physically contacting an obstacle.

28. The method of claim 17, wherein generating the data indicative of the physical layout of the area comprises analyzing image data from a camera on the robot.

29. The method of claim 17, wherein:

maneuvering the robot about the area to clean the area comprises maneuvering the robot about the area in a coverage mode, and

the method further comprises, after updating the data indicative of the robot pose or the data indicative of the physical layout of the area, again maneuvering the robot about the area in the coverage mode to clean the area.

30. The method of claim 29, wherein:

the robot is maneuvered along the selected trajectory from an initial location toward the suspected location of the path segment, and

the method further comprises, after updating the data indicative of the robot pose or the data indicative of the physical layout of the area, maneuvering the robot to the initial location of the robot before again maneuvering the robot about the area in the coverage mode to clean the area.

31. The method of claim 17, wherein:

maneuvering the robot about the area to clean the area comprises maneuvering the robot about the area in a coverage mode, and

the method further comprises, in response to detecting an edge while maneuvering the robot in the coverage mode, initiating a following mode to follow the edge.

32. The method of claim 17, wherein the plurality of path segments includes a path segment along a corner defined by walls.

33. The method of claim 17, wherein selecting the trajectory comprises selecting an approach angle to maneuver to the suspected location of the path segment.

34. The method of claim 17, wherein selecting the trajectory comprises selecting an approach path from an initial location of the robot to the suspected location of the path segment.

35. A method of navigating an autonomous cleaning robot within an area, the method comprising:

maneuvering the robot in a following mode in which the robot is controlled to travel along a plurality of path segments adjacent one or more edges defining the area;

maneuvering the robot in a coverage mode in which the robot is controlled to traverse a first portion of the area while performing a function;

after the robot traverses the first portion of the area in the coverage mode,

maneuvering the robot from a location in the area toward a location of a path segment of the plurality of path segments, and,

upon detecting the one or more edges, maneuvering the robot in the following mode in which the robot is controlled to travel adjacent to the one or more edges such that the robot travels along at least the path segment; and

after the robot travels along at least the path segment, redirecting the robot toward the location in the area and then maneuvering the robot in the coverage mode to traverse a second portion of the area while performing the function.