← Back to Patent Explorer
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
📄 Original PDF 🌐 Google Patents 🔄 Sync Now

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:08
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

Assigned Categories & Tags

No categories assigned to this patent yet.

Assign Category Tag