US4873476A
Expired / Lapsed
US
⏱️ 0.0 years remaining
Robot control apparatus for controlling a manipulator through a robot arm having a plurality of axes
Assignee: Fanuc Corp
•
Filing: 1987-03-14
•
Granted: 1989-10-10
•
Expires: 2007-03-14
Abstract
Abstract A robot control apparatus has servo CPUs (c 1 , c 2 ) provided in control loops of respective servomotors (e 1 , e 2 ) for driving and controlling loads about plural drive axes (θ 1 , θ 2 ) of a robot arm. Since these servo CPUs execute drive torque calculations necessary for servomotor control, the cost of the control apparatus can be reduced. Also provided is a shared RAM (b) capable of being accessed commonly by the servo CPUs. Information about other axes stored in the RAM is read out and, when current loop processing is not being carried out, non-linear torque calculations necessary for servo-control are performed. As a result, current loop processing is not impeded and servomotor control can be carried out in a highly precise manner.
Inventors
- 👤 Mitsuo Kurakake
- 👤 Keiji Sakamoto
- 👤 Takashi Iwamoto
Bibliographic Details
Application Number
—
Jurisdiction
US
Data Source
google_patents
Last Synchronized
2026-10-26 18:46
CPC Classifications
G; G05; G05B; G05B19/00; G05B19/02; G05B19/18; G05B19/414; G05B19/4141; G05B19/19; G05B19/21; G05B19/23; G05B19/231; G05B19/237; G05B2219/00; G05B2219/30; G05B2219/33; G05B2219/33337; G05B2219/34; G05B2219/34076; G05B2219/39; G05B2219/39178; G05B2219/41; G05B2219/41426
Claims Analysis
Total Claims: 7
Claim 1
Independent Claim
182 words
A robot control apparatus for controlling the attitude of a manipulator through the intermediary of a robot arm having a plurality of axes, comprising: servomotors of respective plural axes for driving said robot arm; a plurality of arithmetic means, one for each of said servomotors, for calculating drive torques of respective servomotor control systems; a bus line interconnecting said arithmetic means so that one of said arithmetic means can access information from the rest of said arithmetic means relating to other axes necessary for drive torque calculation; memory means for holding information relating to each of the axes necessary for calculation of an equation of motion of said manipulator, said memory means being commonly accessible from each of said arithmetic means; and data input means for inputting, to prescribed ones of the arithmetic means, the weight of a hand at a distal end of said robot arm and the weight of a workpiece gripped by said hand, the robot arm having the plurality of axes being an arm of a horizontal articulated-type robot, each arm of which rotates in a horizontal plane.
Claim 2
Dependent Claim
182 words
A robot control apparatus for controlling the attitude of a manipulator through the intermediary of a robot arm having a plurality of axes, comprising: servomotors of respective plural axes for driving said robot arm; a plurality of arithmetic means, one for each of said servomotors, for calculating drive torques of respective servomotor control systems; a bus line interconnecting said arithmetic means so that one of said arithmetic means can access information from the rest of said arithmetic means relating to other axes necessary for drive torque calculation; memory means for holding information relating to each of the axes necessary for calculation of an equation of motion of said manipulator, said memory means being commonly accessible from each of said arithmetic means; and data input means for inputting, to prescribed ones of the arithmetic means, the weight of a hand at a distal end of said robot arm and the weight of a workpiece gripped by said hand, the robot arm having the plurality of axes being an arm of a horizontal articulated-type robot, each arm of which rotates in a horizontal plane.
Claim 3
Dependent Claim
34 words
A robot control apparatus according to claim 1, wherein said arithmetic means includes, for every axis of the robot arm, a servo microprocessor for performing feed-forward compensation of the servo-control systems of the servomotors.
Claim 4
Dependent Claim
174 words
A robot control apparatus for controlling the attitude of a manipulator through the intermediary of a robot arm having a plurality of axes, comprising: servomotors of respective plural axes for driving said robot arm; main processor means for providing position commands for each of said servomotors; a plurality of arithmetic means, one for each of said servomotors, for calculating drive torques of respective servomotor based on current loop control or, when current loop control is not being performed, based on load data for each of the axes; a bus line interconnecting said arithmetic means so that said arithmetic means can access information from each other for calculating the drive torques; and data input means for inputting to prescribed ones of said arithmetic means the weight of a hand at a distal end of said robot arm and the weight of a workpiece to be manipulated by the hand, the robot arm having the plurality of axes being an arm of a horizontal articulated type robot, each arm of which rotates in a horizontal plane.
Claim 5
Dependent Claim
174 words
A robot control apparatus for controlling the attitude of a manipulator through the intermediary of a robot arm having a plurality of axes, comprising: servomotors of respective plural axes for driving said robot arm; main processor means for providing position commands for each of said servomotors; a plurality of arithmetic means, one for each of said servomotors, for calculating drive torques of respective servomotor based on current loop control or, when current loop control is not being performed, based on load data for each of the axes; a bus line interconnecting said arithmetic means so that said arithmetic means can access information from each other for calculating the drive torques; and data input means for inputting to prescribed ones of said arithmetic means the weight of a hand at a distal end of said robot arm and the weight of a workpiece to be manipulated by the hand, the robot arm having the plurality of axes being an arm of a horizontal articulated type robot, each arm of which rotates in a horizontal plane.
Claim 6
Dependent Claim
39 words
A robot control apparatus according to claim 3, further comprising memory means for storing the load data necessary for calculating an equation of motion of the manipulator, said memory means being commonly accessible from each of said arithmetic means.
Claim 7
Dependent Claim
30 words
A robot control apparatus according to claim 3, wherein said arithmetic means includes, for every axis of the robot arm, a servo microprocessor for performing feed-forward compensation of the servomotors.
References Cited (Backward Citations)
US4218172A
Cited
US4530062A
Cited
US4409650A
Cited
US4549276A
Cited
US4507738A
Cited
US4467436A
Cited
US4514814A
Cited
US4633414A
Cited
US4594670A
Cited
USPTO Annuity & Maintenance Windows
| Annuity Stage | Window Opens | Payment Deadline | Surcharge Period Until | Estimated Fee | Status |
|---|---|---|---|---|---|
| 3.5 Years (Year 4) | 1992-10-09 | 1993-04-10 | 1993-10-10 | $2000.00 | Window Closed / Lapsed |
| 7.5 Years (Year 8) | 1996-10-09 | 1997-04-10 | 1997-10-10 | $3760.00 | Window Closed / Lapsed |
| 11.5 Years (Year 12) | 2000-10-09 | 2001-04-10 | 2001-10-10 | $7700.00 | Window Closed / Lapsed |