US11400600B2ActiveUtilityA1

Mobile robot and method of controlling the same

89
Assignee: LG ELECTRONICS INCPriority: Mar 27, 2019Filed: Mar 26, 2020Granted: Aug 2, 2022
Est. expiryMar 27, 2039(~12.7 yrs left)· nominal 20-yr term from priority
G06V 10/80G06V 10/751G06V 10/44G06V 20/10B25J 9/1697G06F 18/25G01S 7/4802B25J 9/161B25J 11/0085A47L 2201/04G01C 22/00B25J 9/1653B25J 19/022B25J 13/08G01S 17/58G01S 17/86B25J 9/1664B25J 9/163B25J 5/007B25J 19/04G01S 17/89A47L 9/2852B25J 19/023G01C 21/206B25J 9/1692G05D 1/0246G05D 1/0253G05D 1/0274
89
PatentIndex Score
3
Cited by
29
References
16
Claims

Abstract

A mobile robot includes a traveling unit configured to move a main body, a LiDAR sensor configured to acquire geometry information, a camera sensor configured to acquire an image of the outside of the main body, and a controller. The controller generates odometry information based on the geometry information acquired by the LiDAR sensor. The controller determines a current location of the mobile robot by performing feature matching between images acquired by the camera sensor based on the odometry information. The controller combines the information obtained by the camera sensor and the LiDAR sensor to accurately determine the current location of the mobile robot.

Claims

exact text as granted — not AI-modified
What is claimed is: 
     
       1. A mobile robot comprising:
 a traveling unit configured to move a main body; 
 a LiDAR sensor configured to acquire geometry information; 
 a camera sensor configured to acquire images of an outside of the main body; and 
 a controller configured to:
 generate odometry information based on the geometry information acquired by the LiDAR sensor; and 
 perform feature matching between images acquired by the camera sensor based on the odometry information to estimate a current location of the mobile robot and, wherein the controller comprises: 
 
 a LiDAR service module configured to:
 receive the geometry information acquired by the LiDAR sensor; and 
 determine an amount of location displacement using the geometry information and previous location information; and 
 
 a vision service module configured to:
 receive the amount of location displacement from the LiDAR service module; 
 receive an image from the camera sensor; 
 determine a location of a feature point by matching a first feature point extracted from the image based on the amount of location displacement and a second feature point extracted from a previous location; and 
 determine the current location of the mobile robot based on the determined location of the feature point, 
 and wherein the vision service module is configured to transmit node information comprising the determined current location to the LiDAR service module, and 
 
 the LiDAR service module is configured to:
 determine an additional amount of location displacement by which the mobile robot has moved during a time taken by the vision service module to determine the current location; and 
 include the additional amount of location displacement in the node information. 
 
 
     
     
       2. The mobile robot according to  claim 1 , further comprising:
 a traveling sensor configured to sense a traveling state based on movement of the main body, the traveling state including a distance traveled by the mobile robot, wherein 
 the controller is configured to:
 perform an iterative closest point (ICP) matching on the geometry information acquired by the LiDAR sensor; and 
 combine the traveling state sensed by the traveling sensor with a result of the ICP matching to generate the odometry information. 
 
 
     
     
       3. The mobile robot according to  claim 1 , further comprising a storage configured to store the node information comprising the determined current location. 
     
     
       4. The mobile robot according to  claim 3 , further comprising:
 a traveling sensor configured to sense a traveling state based on movement of the main body, the traveling state including a distance traveled by the mobile robot, wherein
 the controller further comprises a traveling service module configured to receive the traveling state sensed by the traveling sensor, 
 the traveling service module is configured to transmit the traveling state to the LiDAR service module, and 
 the LiDAR service module is configured to generate the odometry information by combining the traveling state sensed by the traveling sensor and an ICP result obtained by performing ICP on the geometry information acquired by the LiDAR sensor. 
 
 
     
     
       5. The mobile robot according to  claim 1 , wherein the controller is configured to:
 determine the current location of the mobile robot based on the geometry information acquired by the LiDAR sensor in an area having an illuminance less than a reference value; and 
 perform a loop closing to correct an error when the mobile robot enters an area having an illuminance equal to or greater than the reference value. 
 
     
     
       6. The mobile robot according to  claim 1 , wherein the controller is configured to generate a correlation between nodes by performing an iterative closest point (ICP) matching between a current node and an adjacent node based on the geometry information acquired by the LiDAR sensor, when feature matching between images acquired by the camera sensor fails. 
     
     
       7. A method of controlling a mobile robot, the method comprising:
 acquiring geometry information using a LiDAR sensor; 
 acquiring images of an outside of the main body using a camera sensor; 
 creating odometry information based on the geometry information acquired by the LiDAR sensor; 
 performing feature matching between images acquired by the camera sensor based on the odometry information; and 
 determining a current location of the mobile robot based on a result of the feature matching, wherein performing the feature matching comprises:
 a vision service module of the controller receiving an amount of location displacement from a LiDAR service module; 
 the vision service module receiving an image from the camera sensor; 
 the vision service module determining a location of a feature point by matching a first feature point extracted from the image based on the amount of location displacement and a second feature point extracted from the previous location; and 
 the vision service module transmitting node information comprising the determined current location to the LiDAR service module; 
 
 the LiDAR service module determining an additional amount of location displacement by which the mobile robot has moved during a time period in which the vision service module determines the current location of the mobile robot; and 
 the LiDAR service module including the additional amount of location displacement in the node information. 
 
     
     
       8. The method according to  claim 7 , further comprising determining an uncertainty in the current location based on geometry information acquired by the LiDAR sensor. 
     
     
       9. The method according to  claim 7 , further comprising:
 sensing a traveling state using a traveling sensor, the traveling state including a distance traveled by the mobile robot; and 
 matching the traveling state and the geometry information acquired by the LiDAR sensor based on an iterative closest point (ICP) algorithm. 
 
     
     
       10. The method according to  claim 9 , wherein generating the odometry information comprises combining the traveling state sensed by the traveling sensor and a result of the ICP algorithm. 
     
     
       11. The method according to  claim 7 , wherein generating the odometry information comprises:
 the LiDAR service module of a controller receiving the geometry data acquired by the LiDAR sensor; and 
 the LiDAR service module determining an amount of location displacement using the geometry data and previous location information. 
 
     
     
       12. The method according to  claim 7 , further comprising storing the node information comprising the calculated current location information in a storage. 
     
     
       13. The method according to  claim 7 , further comprising:
 sensing a traveling state using a traveling sensor, the traveling state including a distance traveled by the mobile robot, wherein 
 generating the odometry information comprises the LiDAR service module combining odometry information based on traveling state sensed by the traveling sensor and an ICP result obtained by performing ICP on the geometry information acquired by the LiDAR sensor. 
 
     
     
       14. The method according to  claim 13 , further comprising the traveling service module of the controller transmitting the travel state sensed by the traveling sensor to the LiDAR service module. 
     
     
       15. The method according to  claim 7 , further comprising:
 determining the current location based on the geometry information acquired by the LiDAR sensor in an area having an illuminance less than a reference value; and 
 performing a loop closing to correct an error when the main body of the mobile robot moves and enters an area having an illuminance equal to or greater than the reference value. 
 
     
     
       16. The method according to  claim 7 , further comprising, performing iterative closest point (ICP) matching between a current node and an adjacent node based on the geometry information acquired by the LiDAR sensor to generate a correlation between nodes, when feature matching between images input from the camera sensor fails.

Cited by (0)

No later patents cite this yet.

References (0)

No backward citations on record.