Robot management systems for determining docking station pose including mobile robots and methods using same

Patent metadata

Field	Value
Publication number	US-9538892-B2
Application number	US-201314046941-A
Country	US
Kind code	B2
Filing date	Oct 5, 2013
Priority date	Oct 5, 2012
Publication date	Jan 10, 2017
Grant date	Jan 10, 2017

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.

First claim

That which is claimed is:

1. A mobile robot system comprising:
a docking station including at least two pose-defining fiducial markers, 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;
a mobile robot including:
a chassis,
a motorized drive connected to the chassis for moving the mobile robot to a docked position, and
a pose sensor assembly comprising a sensor configured to output a signal in response to the at least two pose-defining fiducial markers in a pose sensor field of view;

a controller configured to analyze the output signal 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 the docking station pose on a map of a surface traversed by the mobile robot, wherein the docking station pose comprises a position defined by location coordinates on the map and an angular orientation of the docking station on the map, and the docking station pose defines a docking lane on the map comprising outside edges and a central axis that is aligned with a central axis of the docking port, and the controller is configured to store the pose of the docking station on the map of the surface traversed by the mobile robot; and
the controller is further configured to path plan a docking trajectory including a curve having a terminal portion aligned with the central axis of the docking lane of the docking station, based on a current robot position on the map of the surface and the docking station pose including the outside edges and the central axis of the docking lane and to provide instructions to the motorized drive to move the mobile robot along the curve of the docking trajectory and into a docking lane within the outside edges and along the central axis of the docking lane of the docking station.

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

3. The system of claim 1 , further comprising a database of image data with respect to a plurality of viewpoints of the docking station, wherein the controller is configured to compare the output signal 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 output signal from the pose sensor assembly with the database of image data.

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 4 , wherein the controller is configured to path plan a docking trajectory by moving the robot toward the docking lane in response to a current position of the robot and the pose of the docking station.

6. The system of claim 5 , wherein the controller is configured to move the robot towards a charging port and/or receptacle of the docking station if the robot is sufficiently close to a predetermined position, and to monitor when the robot connects to the charging port and/or receptacle.

7. The system of claim 3 , wherein the controller is configured to path plan a docking trajectory by acquiring images of the docking station, determining the pose of the docking station with respect to the robot, including the position defined by location coordinates on the map and the angular orientation of the docking station, based on the images, and maneuvering the robot in response to the pose of the docking station with respect to the 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. A computer program product for determining a docking path, the computer program product comprising a non-transitory computer readable storage medium having computer readable code embodied in the medium, the computer code comprising:
computer readable code configured to
analyze an output signal from a pose sensor assembly on a mobile robot, wherein the output signal is responsive to an observation by the pose sensor assembly of at least two fiducial markers on a docking station,
determine a docking station pose that is based on a predetermined spatial relationship of the pose-defining fiducial markers and the signals from the pose sensor assembly,
locate a docking station pose on a map of a surface traversed by the mobile robot, wherein the docking station pose comprises a position defined by location coordinates on the map and an angular orientation of the docking station, the docking station pose defining a docking lane on the map comprising outside edges and a central axis that is aligned with a central axis of the docking port, and the controller is configured to store the pose of the docking station on the map of the surface traversed by the mobile robot; and
path plan a docking trajectory including a curve having a terminal portion aligned with the central axis of the docking lane of the docking station, based on a current robot position on the map of the surface and the docking station pose including the outside edges and the central axis of the docking lane and to provide instructions to the motorized drive to move the mobile robot along the curve of the docking trajectory and into a docking lane within the outside edges and along the central axis of the docking lane the docking station.

16. The computer program product of claim 15 , wherein the computer readable code is configured to receive a database of image data with respect to a plurality of viewpoints of the docking station, to compare the output signal from the pose sensor assembly with the database of image data, to estimate a pose of the docking station responsive to a comparison of the output signal from the pose sensor assembly with the database of image data, and to store the pose of the docking station on the map of the surface traversed by the mobile robot.

17. The computer program product of claim 16 , wherein the database of image data is genera

Assignees

• Irobot Corp

Inventors

• Fong Philip
• Meltzer Jason
• Gutmann Steffen
• Karapetyan Vazgen
• Munich Mario E

Classifications

• H02J7/751

  concerning the insertion or the connection of the batteries · CPC title

• A47L2201/04

  Automatic control of the travelling movement; Automatic obstacle detection · CPC title

• A47L9/2894

  Details related to signal transmission in suction cleaners · CPC title

• A47L9/2873 Primary

  Docking units or charging stations (for autonomous or robotic vacuum cleaners A47L2201/02) · CPC title

• B25J9/1666

  Avoiding collision or forbidden zones · CPC title