US5194792A
Expired / Lapsed
US
⏱️ 0.0 years remaining
Tool center point setting method in a robot
Assignee: Fanuc Corp
•
Filing: 1990-03-30
•
Granted: 1993-03-16
•
Expires: 2010-03-30
Abstract
Abstract A tool center point setting method for a robot, capable of accurately and easily setting the tool center point without the need to remove a tool from the robot. After a tool (50) is mounted to a tool mounting surface (34), the tool center point (51) is set at the tool mounting surface center (35) by a robot control unit, and the robot is manually operated to position the tool center point at a reference point (61), this positioned state being taught. The robot control unit determines a matrix P1 based on the taught data. The tool center point is then set at a set point (36), and the robot is manually operated to position the set point at the reference point, the positioned state being taught. A matrix P2' is determined based on the taught data, and a transformation matrix TCP for conversion from a tool mounting surface coordinate system (200) to a tool coordinate system (300) is determined by equation TCP=P1 -1 ·P2'. Alternatively, a matrix P2 representing a state where the set point is positioned at the reference point, with the tool center point kept set at the tool mounting surface center, is determined, and the transformation matrix is determined by equation TCP=P1 -1 ·P2·X, using a matrix X representing the position and orientation of the set point in the tool mounting surface coordinate system.
Inventors
- 👤 Ryuichi Hara
Bibliographic Details
Application Number
—
Jurisdiction
US
Data Source
google_patents
Last Synchronized
2026-10-28 06:46
CPC Classifications
B; B25; B25J; B25J9/00; B25J9/16; B25J9/1679; B25J9/1692
Claims Analysis
Total Claims: 15
Claim 1
Independent Claim
207 words
A tool center point setting method for deriving a transformation matrix for coordinate conversion from a tool mounting surface coordinate system to a tool coordinate system in a robot having a control unit, comprising the steps of: (a) providing in a robot a set point whose position and direction relative to a center of a tool mounting surface are known; (b) providing a reference point in a robot installation space; (c) setting, in the control unit, a tool center point at the center of the tool mounting surface, positioning the tool center point at the reference point, and teaching, to the control unit, a first position and orientation of the tool center point when the tool center point is positioned at the reference point; (d) setting, in the control unit, the tool center point at the set point, positioning the set point at the reference point, and teaching, to the control unit, a second position and orientation of the tool center point when the set point is positioned at the reference point; and (e) deriving, in the control unit, the transformation matrix on the basis of an inverse matrix of a matrix representing the first position and orientation, and a matrix representing the second position and orientation.
Claim 2
Dependent Claim
207 words
A tool center point setting method for deriving a transformation matrix for coordinate conversion from a tool mounting surface coordinate system to a tool coordinate system in a robot having a control unit, comprising the steps of: (a) providing in a robot a set point whose position and direction relative to a center of a tool mounting surface are known; (b) providing a reference point in a robot installation space; (c) setting, in the control unit, a tool center point at the center of the tool mounting surface, positioning the tool center point at the reference point, and teaching, to the control unit, a first position and orientation of the tool center point when the tool center point is positioned at the reference point; (d) setting, in the control unit, the tool center point at the set point, positioning the set point at the reference point, and teaching, to the control unit, a second position and orientation of the tool center point when the set point is positioned at the reference point; and (e) deriving, in the control unit, the transformation matrix on the basis of an inverse matrix of a matrix representing the first position and orientation, and a matrix representing the second position and orientation.
Claim 3
Dependent Claim
54 words
A tool center point setting method according to claim 1, wherein said matrices representing the first position and orientation and the second position and orientation, respectively, are determined on the basis of joint angles of individual axes of the robot assumed at the time of teaching operations in said steps (c) and (d), respectively.
Claim 4
Dependent Claim
43 words
A tool center point setting method according to claim 1, wherein said set point is provided at a predetermined portion of the robot so that the set point is positionable at the reference point while a tool is kept mounted to the robot.
Claim 5
Dependent Claim
25 words
A tool center point setting method according to claim 1, wherein a coordinate position of the reference point in a reference coordinate system is unknown.
Claim 6
Dependent Claim
47 words
A tool center point setting method according to claim 1, wherein said setting of the tool center point at the center of the tool mounting surface in said step (c) is carried out by provisionally setting, in the control unit, the transformation matrix to a unit matrix.
Claim 7
Dependent Claim
57 words
A tool center point setting method according to claim 1, wherein said setting of the tool center point at the set point in step (d) is carried out by provisionally setting, in the control unit, the transformation matrix to a matrix representing a position and orientation of the set point in the tool mounting surface coordinate system.
Claim 8
Dependent Claim
22 words
A tool center point setting method according to claim 1, wherein said tool center point is a distal end of a tool.
Claim 9
Dependent Claim
231 words
A tool center point setting method for deriving a transformation matrix for coordinate conversion from a tool mounting surface coordinate system to a tool coordinate system in a robot having a control unit, comprising the steps of: (a) providing in a robot a set point whose position and direction relative to a center of a tool mounting surface are known; (b) providing a reference point in a robot installation space; (c) setting, in the control unit, a tool center point at the center of the tool mounting surface, positioning the tool center point at the reference point, and teaching, to the control unit, a first position and orientation of the tool center point when the tool center point is positioned at the reference point; (d) positioning the set point at the reference point while the tool center point kept set, in the control unit, at the center of the tool mounting surface, and teaching, to the control unit, a second position and orientation of the tool center point when the set point is positioned at the reference point; and (e) deriving, in the control unit, the transformation matrix on the basis of an inverse matrix of a matrix representing the first position and orientation, a matrix representing the second position and orientation, and a matrix representing a position and orientation of the set point in the tool mounting surface coordinate system.
Claim 10
Dependent Claim
231 words
A tool center point setting method for deriving a transformation matrix for coordinate conversion from a tool mounting surface coordinate system to a tool coordinate system in a robot having a control unit, comprising the steps of: (a) providing in a robot a set point whose position and direction relative to a center of a tool mounting surface are known; (b) providing a reference point in a robot installation space; (c) setting, in the control unit, a tool center point at the center of the tool mounting surface, positioning the tool center point at the reference point, and teaching, to the control unit, a first position and orientation of the tool center point when the tool center point is positioned at the reference point; (d) positioning the set point at the reference point while the tool center point kept set, in the control unit, at the center of the tool mounting surface, and teaching, to the control unit, a second position and orientation of the tool center point when the set point is positioned at the reference point; and (e) deriving, in the control unit, the transformation matrix on the basis of an inverse matrix of a matrix representing the first position and orientation, a matrix representing the second position and orientation, and a matrix representing a position and orientation of the set point in the tool mounting surface coordinate system.
Claim 11
Dependent Claim
54 words
A tool center point setting method according to claim 8, wherein said matrices representing the first position and orientation and the second position and orientation, respectively, are determined on the basis of joint angles of individual axes of the robot assumed at the time of teaching operations in said steps (c) and (d), respectively.
Claim 12
Dependent Claim
43 words
A tool center point setting method according to claim 8, wherein said set point is provided at a predetermined portion of a robot so that the set point is positionable at the reference point while a tool is kept mounted to the robot.
Claim 13
Dependent Claim
25 words
A tool center point setting method according to claim 8, wherein a coordinate position of the reference point in a reference coordinate system is unknown.
Claim 14
Dependent Claim
47 words
A tool center point setting method according to claim 8, wherein said setting of the tool center point at the center of the tool mount surface in said step (c) is carried out by provisionally setting, in the control unit, the transformation matrix to a unit matrix.
Claim 15
Dependent Claim
22 words
A tool center point setting method according to claim 8, wherein said tool center point is a distal end of a tool.
References Cited (Backward Citations)
US4623971A
Cited
US4590578A
Cited
US4771222A
Cited
US4816733A
Cited
US4598380A
Cited
US4706000A
Cited
US4894788A
Cited
US4969108A
Cited
US4972347A
Cited
US5014183A
Cited
USPTO Annuity & Maintenance Windows
| Annuity Stage | Window Opens | Payment Deadline | Surcharge Period Until | Estimated Fee | Status |
|---|---|---|---|---|---|
| 3.5 Years (Year 4) | 1996-03-15 | 1996-09-14 | 1997-03-16 | $2000.00 | Window Closed / Lapsed |
| 7.5 Years (Year 8) | 2000-03-15 | 2000-09-14 | 2001-03-16 | $3760.00 | Window Closed / Lapsed |
| 11.5 Years (Year 12) | 2004-03-15 | 2004-09-14 | 2005-03-16 | $7700.00 | Window Closed / Lapsed |