ROBOT MANAGEMENT SYSTEMS FOR DETERMINING DOCKING STATION POSE INCLUDING MOBILE ROBOTS AND METHODS USING SAME

• US 20160143500A1
• Filed: 11/20/2015
• Published: 05/26/2016
• Est. Priority Date: 10/05/2012
• Status: Active Grant

• Current Assignee: iRobot Corporation
• Original Assignee: iRobot Corporation
• Inventors: Gutmann, Jens-Steffen, Fong, Philip, Meltzer, Jason, Karapetyan, Vazgen, Munich, Mario E.
• Granted Patent: US 9,468,349 B2
• Time in Patent Office: Days
• US Class Current: 1/1
• CPC Class Codes: A47L 2201/02 Docking stations; Docking operations
• CPC Class Codes: A47L 2201/04 Automatic control of the travelling movement; Automatic obstacle detection
• CPC Class Codes: A47L 9/2873 Docking units or charging stations for autonomous or robotic vacuum cleaners A47L2201/02
• CPC Class Codes: A47L 9/2894 Details related to signal transmission in suction cleaners
• CPC Class Codes: A47L 9/30 Arrangement of illuminating devices
• CPC Class Codes: B25J 11/0085 Cleaning
• CPC Class Codes: B25J 13/006 by means of a wireless system for controlling one or several manipulators
• CPC Class Codes: B25J 19/005 using batteries, e.g. as a back-up power source
• CPC Class Codes: B25J 5/00 Manipulators mounted on wheels or on carriages B25J1/00 takes precedence; programme-controlled manipulators B25J9/00 ; vehicle aspects B60, B62, e.g. remote-controlled steering for motor vehicles B62D1/24; control of position of vehicles G05D1/00
• 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: B25J 9/1697 Vision controlled systems
• CPC Class Codes: G05D 1/0225 involving docking at a fixed facility, e.g. base station or loading bay parking aids B62D15/027
• CPC Class Codes: G05D 1/0234 using optical markers or beacons optical beacons per se G01S1/70
• CPC Class Codes: G05D 1/0274 using mapping information stored in a memory device navigation using map-matching G01C21/30
• CPC Class Codes: H02J 7/0045 concerning the insertion or the connection of the batteries
• CPC Class Codes: Y10S 901/01 Mobile robot

Abstract

A mobile robot system is provided that includes a docking station having at least two pose-defining fiducial markers. The pose-defining fiducial markers have a predetermined spatial relationship with respect to one another and/or to a reference point on the docking station such that a docking path to the base station can be determined from one or more observations of the at least two pose-defining fiducial markers. A mobile robot in the system includes a pose sensor assembly. A controller is located on the chassis and is configured to analyze an output signal from the pose sensor assembly. The controller is configured to determine a docking station pose, to locate the docking station pose on a map of a surface traversed by the mobile robot and to path plan a docking trajectory.

Claims

1. A mobile robot system comprising:

a docking station configured to connect to a power supply, including;

at least two pose-defining fiducial markers positioned on opposing sides of a midline of the docking station, the at least two pose-defining fiducial markers having a predetermined spatial relationship with respect to one another and/or to a reference point on the docking station such that a docking path to the base station can be determined from one or more observations of the at least two pose-defining fiducial markers; and

one or more charging contacts;

a mobile cleaning robot including;

a chassis,

a motorized drive system connected to the chassis and having motorized tracks configured to move the mobile robot;

a floor cleaning system configured to clean a floor surface of the space as the robot transits through the space;

a wireless communication system having a wireless communication transmitter/receiver configured to communicate with a computer network to send and receive information from a remote user terminal, the remote user terminal being configured to communicate with and control the robot;

a mapping system configured to map a space and to determine a position of the robot relative to the space; and

a pose sensor assembly comprising a camera configured to output an output signal comprising image data;

a controller configured to analyze the image data from the pose sensor assembly, the controller having the predetermined spatial relationship of the at least two pose-defining fiducial markers stored in a controller memory,

wherein the controller is configured to determine a docking station pose that is based on the spatial relationship of the pose-defining fiducial markers and the signals from the pose sensor assembly, and to locate a docking station pose on a map of the surface traversed by the mobile robot, and

the controller is further configured to path plan a docking trajectory including a path having a terminal portion aligned with a docking lane of the docking station, based on a current robot position on the map of the surface and the docking station pose and to provide instructions to the motorized drive to move the mobile robot along the path of the docking trajectory and into the docking lane aligned with the docking station.

2. The system of claim 1, further comprising a database of image data comprising images of the docking station at a plurality of viewpoints, wherein the controller is configured to compare the image data from the pose sensor assembly with the database of image data, and to estimate a pose of the docking station responsive to a comparison of the image data from the pose sensor assembly with the database of image data.

3. The system of claim 2, the controller outputs a three-dimensional position and orientation of the robot with respect to the docking station based on the estimate of the pose of the docking system, and before making a maneuvering decision based on the estimate of the pose of the docking station, the robot determines whether the three-dimensional position and orientation is consistent with an expected three-dimensional space of positions and orientations.

4. The system of claim 3, wherein the database of image data is generated from a three-dimensional computer model of the docking station and the fiducial markers thereon.

5. The system of claim 1, wherein the controller is further configured to return to the docking station using a signal identifying the location of the docking station such that the robot turns at a location to align with detected signals and approach the docking station along the docking lane and path planning to the docking having a pose known to the robot controller.

6. The system of claim 1, wherein the controller is configured to path plan around obstacles that are disposed between the robot and the docking lane of the docking station by determining a path that avoids collisions with the obstacles and controlling the robot to move along the path that avoids collisions with obstacles.

7. The system of claim 1, wherein the controller is located on the chassis of the mobile robot.

8. The system of claim 1, wherein the controller determines the pose of the docking station by acquiring data including observations of the fiducial markers of the docking station from at least two positions of the robot and triangulating a location and angular orientation of the docking station in response to the data.

9. The system of claim 8, wherein the fiducial markers are LEDs that are configured indicate a beam direction to the pose sensor assembly.

10. The system of claim 9, wherein the LEDs have different light-emitting characteristics such that the pose sensor assembly is configured to identify an orientation of the LEDs responsive to the predetermined spatial relationship of the LEDs.

11. The system of claim 10, wherein the pose sensor assembly comprises a directional sensor.

12. The system of claim 11, wherein the directional sensor comprises twin photodiodes.

13. The system of claim 11, wherein the fiducial markers are collimated and/or baffled LED lights that generally emit light in a direction such that the pose sensor assembly is configured to plot a line of sight when the robot crosses the emitted light.

14. The system of claim 11, wherein the fiducial markers comprise a portion that transmits IR light and a portion that blocks IR light.

15. The system of claim 1, wherein the fiducial markers comprise a spatially recognizable visual pattern.