§
Luxuse
Patent Intelligence
Sign In
← Back to Patent Explorer
US4967125A Expired / Lapsed US ⏱️ 0.0 years remaining

Tool posture control method for a robot

Assignee: Fanuc Corp
•
Filing: 1989-03-09
•
Granted: 1990-10-30
•
Expires: 2009-03-09
📄 Original PDF 🌐 Google Patents 🔄 Sync Now

Abstract

Abstract A tool posture control method for a robot is provided, which is capable of always controlling the posture of a tool as intended, between a starting point and an ending point of operation, in moving the tool from the starting point toward the ending point along a straight line or a circular arc. Based on positions and postures of the tool at a starting point and an ending point, previously given to the robot for instruction, and a tool position at an intermediate point, additionally given as required for instruction, a control device calculates (S2) a first angle formed between the tool and a datum plane, at the starting point, a second angle formed between the tool projected on the datum plane and a datum line set on the datum plane, at the startingt point, and the rotational position of the tool at the starting point around a tool axis, and then calculates (S3) the first angle, the second angle, and the rotational position around the tool axis, at the ending point. Thereafter, the control device interpolates (S4) the tool position, the first angle, the second angle, and the rotational position around the tool axis, between the starting and ending points, and distributes (S6) pulses to servo circuits for driving servomotors, in accordance with the result of the interpolation, thereby controlling the position and posture of the tool between the starting and ending points.

Inventors

  • 👤 Ryuichi Hara

Bibliographic Details

Application Number —
Jurisdiction US
Data Source google_patents
Last Synchronized 2026-11-02 06:36
CPC Classifications
B; B25; B25J; B25J9/00; B25J9/10; G; G05; G05B; G05B19/00; G05B19/02; G05B19/18; G05B19/41; G05B2219/00; G05B2219/30; G05B2219/50; G05B2219/50353

Claims Analysis

Total Claims: 8
Claim 1
Independent Claim 176 words
A tool posture control method for a robot comprising steps of: (a) instructing beforehand the robot for tool positions at a starting point and an ending point of operation and postures of said tool at said starting point and said ending point; (b) calculating, in accordance with the result of the instruction, a first angle formed between said tool and a datum plane; at said starting point, a second angle formed between said tool projected on said datum plane and a datum line set on said datum plane, at said starting point, and a rotational position of said tool at said starting point around a tool axis; (c) calculating said first angle, said second angle, and said rotational position around the tool axis, at said ending point, in accordance with said instruction result; (d) interpolating said tool position, said first angle, said second angle, and said rotational position around the tool axis, between said starting point and said ending point; and (e) controlling the posture of said tool in accordanced with the result of the interpolation.
Claim 2
Dependent Claim 176 words
A tool posture control method for a robot comprising steps of: (a) instructing beforehand the robot for tool positions at a starting point and an ending point of operation and postures of said tool at said starting point and said ending point; (b) calculating, in accordance with the result of the instruction, a first angle formed between said tool and a datum plane; at said starting point, a second angle formed between said tool projected on said datum plane and a datum line set on said datum plane, at said starting point, and a rotational position of said tool at said starting point around a tool axis; (c) calculating said first angle, said second angle, and said rotational position around the tool axis, at said ending point, in accordance with said instruction result; (d) interpolating said tool position, said first angle, said second angle, and said rotational position around the tool axis, between said starting point and said ending point; and (e) controlling the posture of said tool in accordanced with the result of the interpolation.
Claim 3
Dependent Claim 42 words
A tool posture control method for a robot according to a claim 1, wherein said datum plane is set so as to extend through said tool positions at said starting point and said ending point given for instruction in said step (a).
Claim 4
Dependent Claim 44 words
A tool posture control method for a robot according to claim 1, wherein said datum line is set so as to extend parallel to a predetermined coordinate axis of a coordinate system used in the instruction for the tool positions in said step (a).
Claim 5
Dependent Claim 37 words
A tool posture control method for a robot according to claim 1, wherein an instruction is given for a tool position at an intermediate point between said starting point and said ending point, in sait step (a).
Claim 6
Dependent Claim 37 words
A tool posture control method for a robot according to claim 3, wherein an instruction is given for a tool position at an intermediate point between said starting point and said ending point, in said stesp (a).
Claim 7
Dependent Claim 44 words
A tool posture control method for a robot according to claim 2, wherein said datum line is set so as to extend parallel to a predetermined coordinate axis of a coordinate system used in the instruction for the tool positions in said step (a).
Claim 8
Dependent Claim 37 words
A tool posture control method for a robot according to claim 2, wherein an instruction is given for a tool position at an intermediate point between said starting point and said ending point, in said step (a).

References Cited (Backward Citations)

US4521721A Cited
US4517653A Cited
US4771222A Cited
US4635206A Cited
US4922440A Cited
US4858140A Cited
US4868473A Cited
US4835710A Cited

USPTO Annuity & Maintenance Windows

Annuity Stage Window Opens Payment Deadline Surcharge Period Until Estimated Fee Status
3.5 Years (Year 4) 1993-10-29 1994-04-30 1994-10-30 $2000.00 Window Closed / Lapsed
7.5 Years (Year 8) 1997-10-29 1998-04-30 1998-10-30 $3760.00 Window Closed / Lapsed
11.5 Years (Year 12) 2001-10-29 2002-04-30 2002-10-30 $7700.00 Window Closed / Lapsed

Assigned Categories & Tags

No categories assigned to this patent yet.

Assign Category Tag