Patent US5065337A successfully refreshed from Google Patents.
US5065337A
Expired / Lapsed
US
⏱️ 0.0 years remaining
Vertical revolute joint robot
Assignee: Fanuc Corp
•
Filing: 1989-08-31
•
Granted: 1991-11-12
•
Expires: 2009-08-31
Abstract
Abstract A vertical revolute joint robot having an offset wrist, which is capable of rapidly calculating respective joint angles on the basis of a target position and orientation of an end effector, and hence is excellent in operation accuracy. A robot arm consists of first to third links, and the joint axis (Y0) of a first joint (1), which couples a base fixedly disposed within an operation space to the first link, extends perpendicularly to the axis of the base, whereas the joint axis (Z1) of a second joint (2), which couples the first and second links to each other, extends along the axis of the first link. The third link is mounted with a wrist offset relative to the arm, and an end effector is mounted on the offset wrist. A computer provided in the robot calculates a fist joint angle (θ1) in accordance with an arithmetic equation, which is fulfilled between corresponding ones of transformation matrices employed for coordinate transformation among zeroth to sixth coordinate systems respectively set for first to sixth joints (1)-(6) and an end effector mounting face center, the equation being represented as a function of vector components indicative of the position of the origin of the sixth coordinate system with respect to the zeroth coordinate system and determinable from target position and orientation of the end effector, link lengths determined in dependence on the robot arrangement, and offset distances (d2-d4). The computer calculates other joint angles (θ2-θ6) in accordance with similar arithmetic equations.
Inventors
- 👤 Ryuichi Hara
Bibliographic Details
Application Number
—
Jurisdiction
US
Data Source
google_patents
Last Synchronized
2026-11-09 19:21
CPC Classifications
B; B25; B25J; B25J9/00; B25J9/06; B25J9/02; B25J9/04; G; G05; G05B; G05B19/00; G05B19/02; G05B19/18; G05B19/408; G05B19/4086
Claims Analysis
Total Claims: 9
Claim 1
Independent Claim
160 words
A vertical revolute joint robot including: a first link, a base, a first revolute joint coupling said first link to said base, a second link, a second revolute joint coupling said second link to said first link, and a third link a third revolute joint coupling said third link to said second link; an offset wrist, mounted to said arm, including a plurality of revolute joints where at least two axes of said revolute joints are parallel to each other; an end effector, having a target position and an orientation, mounted at an end of said offset wrist; and control means for calculating joint angles of the respective first, second, third and plurality of revolute joints based on the target position and the orientation of said end effector and previously calculated joint angles; said first and second revolute joints having joint axes which respectively extend perpendicular to an axis of said base and along an axis of said first link.
Claim 2
Dependent Claim
160 words
A vertical revolute joint robot including: a first link, a base, a first revolute joint coupling said first link to said base, a second link, a second revolute joint coupling said second link to said first link, and a third link a third revolute joint coupling said third link to said second link; an offset wrist, mounted to said arm, including a plurality of revolute joints where at least two axes of said revolute joints are parallel to each other; an end effector, having a target position and an orientation, mounted at an end of said offset wrist; and control means for calculating joint angles of the respective first, second, third and plurality of revolute joints based on the target position and the orientation of said end effector and previously calculated joint angles; said first and second revolute joints having joint axes which respectively extend perpendicular to an axis of said base and along an axis of said first link.
Claim 3
Dependent Claim
67 words
A vertical revolute joint robot according to claim 1, wherein each of said first, second, third and plurality of revolute joints has a coordinate system associated therewith and wherein said control means includes means for calculating a joint angle in accordance with a predetermined arithmetic equation which uses transformation matrices employed for coordinate transformation between adjacent ones of the coordinate systems respectively set for said revolute joints.
Claim 4
Dependent Claim
83 words
A vertical revolute joint robot according to claim 2, wherein said base has a fixed position and wherein said calculating means includes means for calculating an angle of said first revolute joint based on the target position and orientation of said end effector and -(sin θ.sub.1) P.sub.x +(cosin θ.sub.1) P.sub.y =0 where θ 1 equals the angle of said first revolute joint, P x and P y are position vectors of said end effector in relation to the fixed position of said base.
Claim 5
Dependent Claim
58 words
A vertical revolute joint robot according to claim 3, wherein said base has a first axial direction and said first link has a second axial direction, and wherein said first joint has a joint axis which extends perpendicularly to the first axial direction, and said second joint has a joint axis which extends in the second axial direction.
Claim 6
Dependent Claim
91 words
A vertical revolute joint robot, comprising: a base; a plurality of links; an end effector having a target position and an orientation; a plurality of revolute joints, coupling said base to a first one of said links, coupling said first one of said links to at least another one of said links, and coupling said end effector to said at least another one of said links; and calculating means for calculating joint angles of said plurality of revolute joints based on the target position and the orientation of said end effector.
Claim 7
Dependent Claim
91 words
A vertical revolute joint robot, comprising: a base; a plurality of links; an end effector having a target position and an orientation; a plurality of revolute joints, coupling said base to a first one of said links, coupling said first one of said links to at least another one of said links, and coupling said end effector to said at least another one of said links; and calculating means for calculating joint angles of said plurality of revolute joints based on the target position and the orientation of said end effector.
Claim 8
Dependent Claim
60 words
A vertical revolute joint robot according to claim 5, wherein said calculating means includes means for calculating the joint angles of said plurality of revolute joints based upon previously calculated joint angles of said plurality of revolute joints; and detector means for detecting a rotational position of said corresponding servomotor means for each of said first through sixth revolute joints.
Claim 9
Dependent Claim
49 words
A vertical revolute joint robot according to claim 5, further comprising: a plurality of servomotor means for rotatively driving a corresponding one of said plurality of revolute joints; and detecting means for detecting a rotational position of said corresponding servomotor means for each of said plurality of revolute joints.
References Cited (Backward Citations)
US4456961A
Cited
US4623971A
Cited
EP0158447A1
Cited
US4831547A
Cited
US4680519A
Cited
US4823279A
Cited
USPTO Annuity & Maintenance Windows
| Annuity Stage | Window Opens | Payment Deadline | Surcharge Period Until | Estimated Fee | Status |
|---|---|---|---|---|---|
| 3.5 Years (Year 4) | 1994-11-11 | 1995-05-13 | 1995-11-12 | $2000.00 | Window Closed / Lapsed |
| 7.5 Years (Year 8) | 1998-11-11 | 1999-05-13 | 1999-11-12 | $3760.00 | Window Closed / Lapsed |
| 11.5 Years (Year 12) | 2002-11-11 | 2003-05-13 | 2003-11-12 | $7700.00 | Window Closed / Lapsed |