IP Library Granted Patent US 9,126,338
Granted Patent B2
US 9,126,338 · App. 13/886,432 · Granted Sep 8, 2015

Robot system and method for driving the same

View Patent ↗
Loading inventors, assignments & file history…
Monitor This Case
Get email alerts when status or documents change.
Order Certified Copies
Most orders are placed with the USPTO same day — all within 24 business hours.
Order via The Patent Place →
Pre-filled with this patent's details
Quick Facts
Patent No.
US 9,126,338
App. No.
13/886,432
Granted
Sep 8, 2015
Kind
B2
Abstract

Provided is a method of driving a system for a robot including obtaining scan data which includes information about at least one of a coordinate and a direction of the robot, estimating a plurality of location changes of the robot by matching a plurality of consecutive scan data pairs of the obtained scan data, generating a path of the robot by connecting the estimated location changes, estimating a position of a corrected instantaneous center of rotation (ICR), and correcting the plurality of consecutive scan data pairs based on the corrected ICR.

Claims (46)

1. A method of driving a robot, the method comprising:

obtaining scan data which includes information about at least one of a coordinate and a direction of the robot;

estimating a plurality of location changes of the robot by matching a plurality of consecutive scan data pairs of the obtained scan data;

generating a path of the robot by connecting the estimated location changes;

generating a plurality of extension lines, each comprising an instantaneous center of rotation (ICR) from a rotation axis of the robot at each position on the generated path;

estimating the position of a corrected ICR at a point of the closest distance from the plurality of extension lines;

generating a corrected circle having the center at the position of the corrected ICR; and

correcting the plurality of consecutive scan data pairs so that the robot may rotate with respect to the corrected circle.

2. The method of claim 1 , wherein a previous location of the corrected plurality of consecutive scan data pairs is used for estimating a next location change of the robot.

3. The method of claim 1 , wherein in the estimating the plurality of location changes, a relative location change of one scan data is estimated based on another earlier scan data with respect to time among the consecutive scan data pairs.

4. The method of claim 1 , wherein the generating the path of the robot comprises:

setting a reference point of the robot at a predetermined time; and

generating the path of the robot by connecting the estimated location changes with respect to the reference point.

5. The method of claim 1 , wherein the correcting the plurality of consecutive scan data pairs further comprises changing the ICR of the robot at each position on the path to the corrected ICR.

6. The method of claim 1 , wherein the correcting the plurality of consecutive scan data further comprises changing a position of the plurality of consecutive scan data pairs.

7. The method of claim 1 , wherein the correcting the plurality of consecutive scan data pairs further comprises changing a direction of the plurality of consecutive scan data pairs.

8. The method of claim 1 , wherein the correcting the plurality of consecutive scan data pairs further comprises changing a position and a direction of the scan data pairs.

9. The method of claim 1 , before the estimating the plurality of location changes, further comprising:

sensing a travel direction of the robot by using a gyro sensor;

detecting a travel distance of the robot by using en encoder; and

correcting a location and a direction of the robot by using the travel direction and the travel distance.

10. The method of claim 9 , wherein the scan data is obtained, from a space where the robot moves, using a signal emitted from and received by the robot after the signal is reflected from an object around the robot.

11. The method of claim 9 further comprising setting a starting point during the matching of the plurality of consecutive scan data pairs based on data of the corrected location and direction of the robot.

12. The method of claim 9 , wherein the plurality of location changes is estimated from data of the corrected location and direction and the plurality of consecutive scan data pairs.

13. A robot comprising:

a distance measurement calculator configured to obtain scan data including information about at least one of a coordinate and a direction of the robot;

a location change estimator configured to estimate a plurality of location changes of the robot by matching a plurality of consecutive scan data pairs of the obtained scan data;

a path generator configured to generate a path of the robot by connecting the estimated location changes;

a corrected instantaneous center of rotation (ICR) estimator configured to generate a plurality of extension lines, each comprising an instantaneous center of rotation (ICR) from a rotation axis of the robot at each position on the generated path and configured to estimate the position of a corrected ICR at a point of the closest distance from the plurality of extension lines; and

a primary correction processor configured to generate a corrected circle having the center at the position of the corrected ICR and configured to correct the plurality of consecutive scan data pairs so that the robot may rotate with respect to the corrected circle.

14. The robot of claim 13 , wherein the corrected plurality of consecutive scan data pairs output from the primary correction processor is an input for the location change estimator.

15. The robot of claim 13 , wherein the location change estimator is configured to estimate a relative location change of one scan data based on another earlier scan data with respect to time among the consecutive scan data pairs.

16. The robot of claim 13 , wherein the path generator is configured to set a reference point of the robot at a predetermined time and configured to generate the path of the robot by connecting the estimated location changes with respect to the reference point.

17. The robot of claim 13 , wherein the correction processor is configured to change at least one of a position and a direction of the plurality of consecutive scan data pairs.

18. The robot of claim 13 , further comprising:

a gyro sensor configured to sense a travel direction of the robot;

an encoder configured to detect a travel distance of the robot; and

a secondary correction processor configured to correct a location and a direction of the robot based on the travel direction and the travel distance and configured to output the corrected location and direction of the robot to the location change estimator.

19. A non-transitory computer-readable recording medium having recorded thereon a program for executing a method of driving a robot, the method comprising:

obtaining scan data which includes information about at least one of a coordinate and a direction of the robot;

estimating a plurality of location changes of the robot by matching a plurality of consecutive scan data pairs of the obtained scan data;

generating a path of the robot by connecting the estimated location changes;

generating a plurality of extension lines, each comprising an instantaneous center of rotation (ICR) from a rotation axis of the robot at each position on the generated path;

estimating the position of a corrected ICR at a point of the closest distance from the plurality of extension lines;

generating a corrected circle having the center at the position of the corrected IRC; and

correcting the plurality of consecutive scan data pairs so that the robot may rotate with respect to the corrected circle.

Assignments (6)
ASSIGNMENT OF ASSIGNOR'S INTEREST Recorded Dec 6, 2023
From: HANWHA CO., LTD.
To: HANWHA ROBOTICS CORPORATION
Reel/Frame 065779/0594 →
ASSIGNMENT OF ASSIGNOR'S INTEREST Recorded Nov 4, 2020
From: HANWHA PRECISION MACHINERY CO., LTD.
To: HANWHA CO., LTD.
Reel/Frame 054273/0475 →
ASSIGNMENT OF ASSIGNOR'S INTEREST Recorded Apr 10, 2019
From: HANWHA AEROSPACE CO., LTD.
To: HANWHA PRECISION MACHINERY CO., LTD.
Reel/Frame 048853/0048 →
CHANGE OF NAME Recorded Mar 1, 2019
From: HANWHA TECHWIN CO., LTD.
To: HANWHA AEROSPACE CO., LTD.
Reel/Frame 048478/0831 →
CHANGE OF NAME Recorded Jul 24, 2015
From: SAMSUNG TECHWIN CO., LTD.
To: HANWHA TECHWIN CO., LTD.
Reel/Frame 036254/0911 →
ASSIGNMENT OF ASSIGNOR'S INTEREST Recorded May 3, 2013
From: LEE, JIN-HAN; KIM, YANG-HYUN; KIM, KI-SUNG
To: SAMSUNG TECHWIN CO., LTD.
Reel/Frame 030344/0408 →