US5994864A
Expired / Lapsed
US
⏱️ 0.0 years remaining
Robot controller
Assignee: Yaskawa Electric Corp
•
Filing: 1996-09-10
•
Granted: 1999-11-30
•
Expires: 2016-09-10
Abstract
Abstract A control apparatus and compliance control apparatus of a robot which performs operations while switching between a position control and a compliance control. When a transition from the position control to the compliance control is made, an integration operation of a speed control system is stopped. Thereafter, an integration value of the speed control system is stored in a memory, and, at the same time, the integration value is added to a torque reference. Alternately, a gravity compensation value is added to the torque reference, the gravity compensation value being computed based on a joint angle of a robot arm and a link mass and a position of a center of gravity of the robot. When the control returns from the compliance control to the position control, a present position is dealt with an instruction position. The compliance control apparatus includes a device (102) for controlling a torque of a servo motor to drive a joint portion; a device (106) for measuring a joint angle; a device (108) for computing a very small displacement between coordinates based on the measurement information; a device (102) for converting a limitation value (107) of either a force or a torque set in a working coordinate system by giving the foregoing very small displacement correspondence relation to the foregoing computation means (108); and devices (104, 105, 106) for limiting the torque.
Inventors
- 👤 Yasuyuki Inoue
- 👤 Hideo Nagata
Bibliographic Details
Application Number
—
Jurisdiction
US
Data Source
google_patents
Last Synchronized
2026-11-04 15:53
CPC Classifications
B; B25; B25J; B25J13/00; B25J9/00; B25J9/16; B25J9/1628; B25J9/1633; G; G05; G05B; G05B2219/00; G05B2219/30; G05B2219/42; G05B2219/42123
Claims Analysis
Total Claims: 30
Claim 1
Independent Claim
150 words
A control apparatus for a robot comprising: a position feedback control loop; a speed feedback control loop; and means for switching between a position control and a compliance control during an operation of the robot; wherein said means for switching is performed by limiting an output value of a speed control loop, which is a torque reference value; and when a transition from the position control to the compliance control is made, an integration operation of the speed control loop is stopped, an integration value of the speed control loop is subsequently stored in a memory and, at the same time, one of the integration value of the speed control loop is added to a torque reference, and a gravity compensation value computed based on a joint angle of a robot arm, a link mass of the robot and a center of gravity thereof is added to the torque reference.
Claim 2
Dependent Claim
150 words
A control apparatus for a robot comprising: a position feedback control loop; a speed feedback control loop; and means for switching between a position control and a compliance control during an operation of the robot; wherein said means for switching is performed by limiting an output value of a speed control loop, which is a torque reference value; and when a transition from the position control to the compliance control is made, an integration operation of the speed control loop is stopped, an integration value of the speed control loop is subsequently stored in a memory and, at the same time, one of the integration value of the speed control loop is added to a torque reference, and a gravity compensation value computed based on a joint angle of a robot arm, a link mass of the robot and a center of gravity thereof is added to the torque reference.
Claim 3
Dependent Claim
35 words
The control apparatus of a robot according to claim 1, wherein in case of an operation of the robot to hold a workpiece, a mass of the workpiece is added to said gravity compensation value.
Claim 4
Dependent Claim
47 words
A control apparatus of a robot comprising: means for switching between a position control and a compliance control during an operation of the robot; wherein when a switch is made to thc position control from the compliance control, a present position is handled as a position reference.
Claim 5
Dependent Claim
47 words
A control apparatus of a robot comprising: means for switching between a position control and a compliance control during an operation of the robot; wherein when a switch is made to thc position control from the compliance control, a present position is handled as a position reference.
Claim 6
Dependent Claim
97 words
The control apparatus which comprises means for switching between the position control and the compliance control during the operation of the robot according to claim 2, wherein when a switch is made from the compliance control to the position control, one of a gravity compensation value computed based on an actual joint angle of a robot arm, a link mass of the robot and a position of a center of gravity thereof, and an integration value of the speed control loop stored in said memory is set as a new integration value of said speed control loop.
Claim 7
Dependent Claim
39 words
The control apparatus of a robot according to claim 3, wherein the switching between said position control and said compliance control is performed by limiting an output value of the speed control loop, which is a torque reference value.
Claim 8
Dependent Claim
127 words
A compliance control apparatus of a robot comprising: means for controlling a torque of a servo motor which drives a joint portion of the robot; means for measuring a joint angle of said joint portion; means for computing a static torque relation changed by a posture of the robot between coordinate systems, based on information of said joint angle obtained by said measuring; means for converting a limitation value of one of a force vector and the torque in a working coordinate system to a joint torque limitation value by using said static torque relation changed by a posture of the robot; and means for limiting an output torque of the servo motor which drives a joint portion of the robot using said joint torque limitation value.
Claim 9
Dependent Claim
127 words
A compliance control apparatus of a robot comprising: means for controlling a torque of a servo motor which drives a joint portion of the robot; means for measuring a joint angle of said joint portion; means for computing a static torque relation changed by a posture of the robot between coordinate systems, based on information of said joint angle obtained by said measuring; means for converting a limitation value of one of a force vector and the torque in a working coordinate system to a joint torque limitation value by using said static torque relation changed by a posture of the robot; and means for limiting an output torque of the servo motor which drives a joint portion of the robot using said joint torque limitation value.
Claim 10
Dependent Claim
60 words
The compliance control apparatus of a robot according to claim 6, wherein by using a reference value of said joint angle of a control system of a servo motor which drives the joint portion of the robot, said static torque relation changed by a posture of the robot between a working coordinate system and a joint coordinate system is obtained.
Claim 11
Dependent Claim
99 words
A compliance control apparatus of a robot which comprises a control system of a servo motor to drive a joint portion of the robot having a position control loop and a speed control loop, comprising: means which is capable of varying position and speed control gains; means for limiting an integration value at an integrator in said speed control loop; means for obtaining a rotation acceleration of said servo motor either by detecting or by computing; and feedback control means for multiplying the acceleration of said servo motor by a constant at a rear stage of a speed controller.
Claim 12
Dependent Claim
99 words
A compliance control apparatus of a robot which comprises a control system of a servo motor to drive a joint portion of the robot having a position control loop and a speed control loop, comprising: means which is capable of varying position and speed control gains; means for limiting an integration value at an integrator in said speed control loop; means for obtaining a rotation acceleration of said servo motor either by detecting or by computing; and feedback control means for multiplying the acceleration of said servo motor by a constant at a rear stage of a speed controller.
Claim 13
Dependent Claim
113 words
A compliance control apparatus of a robot which comprises a control system of a servo motor to drive a joint portion of the robot having a position control loop and a speed control loop, comprising: means for limiting an integration value at an integrator in said speed control loop; a torque limiter which limits a torque reference that is a result obtained by adding the output of said integrator and a proportional control; means for obtaining a rotation acceleration of said motor by at least one of detecting and computing; and feedback control means for multiplying an acceleration of said servo motor by a constant at a rear stage of said torque limiter.
Claim 14
Dependent Claim
113 words
A compliance control apparatus of a robot which comprises a control system of a servo motor to drive a joint portion of the robot having a position control loop and a speed control loop, comprising: means for limiting an integration value at an integrator in said speed control loop; a torque limiter which limits a torque reference that is a result obtained by adding the output of said integrator and a proportional control; means for obtaining a rotation acceleration of said motor by at least one of detecting and computing; and feedback control means for multiplying an acceleration of said servo motor by a constant at a rear stage of said torque limiter.
Claim 15
Dependent Claim
45 words
The compliance control apparatus of a robot according to claim 8, further comprising: means for compensating a torque reference which is a result obtained by adding an output of a speed controller and an integration control for either a gravity torque or a friction torque.
Claim 16
Dependent Claim
45 words
The compliance control apparatus of a robot according to claim 9, further comprising: means for compensating a torque reference which is a result obtained by adding an output of a speed controller and an integration control for either a gravity torque or a friction torque.
Claim 17
Dependent Claim
69 words
A compliance control apparatus of a robot which comprises a control system of a servo motor of the robot having a position control loop and a speed control loop, comprising: means for comparing a difference between a target angle of a position and a present angle of a servo motor with a setting value; and means for stopping, a movement of said servo motor based on a comparing result.
Claim 18
Dependent Claim
69 words
A compliance control apparatus of a robot which comprises a control system of a servo motor of the robot having a position control loop and a speed control loop, comprising: means for comparing a difference between a target angle of a position and a present angle of a servo motor with a setting value; and means for stopping, a movement of said servo motor based on a comparing result.
Claim 19
Dependent Claim
85 words
A compliance control apparatus of a robot which comprises a control system of a servo motor of the robot having a position control loop and a speed control loop, comprising: means for comparing a difference between a target angle of a position and a present angle of a servo motor with a predetermined fixed angular deviation quantity threshold, and means for outputting a comparing result from the compliance control apparatus of a robot to a peripheral equipment of the compliance control apparatus of a robot.
Claim 20
Dependent Claim
85 words
A compliance control apparatus of a robot which comprises a control system of a servo motor of the robot having a position control loop and a speed control loop, comprising: means for comparing a difference between a target angle of a position and a present angle of a servo motor with a predetermined fixed angular deviation quantity threshold, and means for outputting a comparing result from the compliance control apparatus of a robot to a peripheral equipment of the compliance control apparatus of a robot.
Claim 21
Dependent Claim
94 words
A compliance control apparatus of a robot which comprises a control system of a servo motor of the robot having a plurality of position control loops and speed control loops, comprising: means for comparing a difference between a target value in a working coordinate system and a present value in a working coordinate system obtained from a present value of said servo motor with a predetermined fixed positional deviation quantity threshold and a predetermined fixed posture deviation quantity threshold; and means for stopping a movement of said servo motor based on a comparing result.
Claim 22
Dependent Claim
94 words
A compliance control apparatus of a robot which comprises a control system of a servo motor of the robot having a plurality of position control loops and speed control loops, comprising: means for comparing a difference between a target value in a working coordinate system and a present value in a working coordinate system obtained from a present value of said servo motor with a predetermined fixed positional deviation quantity threshold and a predetermined fixed posture deviation quantity threshold; and means for stopping a movement of said servo motor based on a comparing result.
Claim 23
Dependent Claim
106 words
A compliance control apparatus of a robot which comprises a control system of a servo motor of the robot having a plurality of position control loops and speed control loops, comprising: means for comparing a difference between a target value in a working coordinate system and a present value in a working coordinate system obtained from a present value of said servo motor with a predetermined fixed positional deviation quantity threshold and a predetermined fixed posture deviation quantity threshold; and means for outputting a comparing result from the compliance control apparatus of a robot to a peripheral equipment of the compliance control apparatus of a robot.
Claim 24
Dependent Claim
106 words
A compliance control apparatus of a robot which comprises a control system of a servo motor of the robot having a plurality of position control loops and speed control loops, comprising: means for comparing a difference between a target value in a working coordinate system and a present value in a working coordinate system obtained from a present value of said servo motor with a predetermined fixed positional deviation quantity threshold and a predetermined fixed posture deviation quantity threshold; and means for outputting a comparing result from the compliance control apparatus of a robot to a peripheral equipment of the compliance control apparatus of a robot.
Claim 25
Dependent Claim
88 words
A compliance control apparatus of a robot which comprises a control system of a servo motor to drive a joint portion of the robot, having a position control loop and a speed control loop, comprising: means for changing a position control gain and a speed control gain; and means for lowering said position control gain and said speed control gain based on reference information concerning a position, a speed and a direction, sensor information of an encoder attached to a robot, and a computation result using said information.
Claim 26
Dependent Claim
88 words
A compliance control apparatus of a robot which comprises a control system of a servo motor to drive a joint portion of the robot, having a position control loop and a speed control loop, comprising: means for changing a position control gain and a speed control gain; and means for lowering said position control gain and said speed control gain based on reference information concerning a position, a speed and a direction, sensor information of an encoder attached to a robot, and a computation result using said information.
Claim 27
Dependent Claim
94 words
A compliance control apparatus of a robot which comprises a control system of a servo motor to drive a joint portion of the robot having a position control loop and a speed control loop, comprising: means for limiting a torque reference that is an addition result of outputs of a proportional control and an integrator; and means for changing the means for limiting said torque reference based on instruction information concerning a position, a speed and a direction, sensor information of an encoder attached to a robot, and a computing result using said information.
Claim 28
Dependent Claim
94 words
A compliance control apparatus of a robot which comprises a control system of a servo motor to drive a joint portion of the robot having a position control loop and a speed control loop, comprising: means for limiting a torque reference that is an addition result of outputs of a proportional control and an integrator; and means for changing the means for limiting said torque reference based on instruction information concerning a position, a speed and a direction, sensor information of an encoder attached to a robot, and a computing result using said information.
Claim 29
Dependent Claim
41 words
The compliance control apparatus or a robot according to claim 16, further comprising: means for compensating at least one of a gravity torque and a friction torque after adding a proportional control and an integration control in said speed control loop.
Claim 30
Dependent Claim
41 words
The compliance control apparatus of a robot according to claim 17, further comprising: means for compensating at least one of a gravity torque and a friction torque after adding a proportional control and an integration control in said speed control loop.
References Cited (Backward Citations)
US4985668A
Cited
US5241250A
Cited
USPTO Annuity & Maintenance Windows
| Annuity Stage | Window Opens | Payment Deadline | Surcharge Period Until | Estimated Fee | Status |
|---|---|---|---|---|---|
| 3.5 Years (Year 4) | 2002-11-29 | 2003-05-31 | 2003-11-30 | $2000.00 | Window Closed / Lapsed |
| 7.5 Years (Year 8) | 2006-11-29 | 2007-05-31 | 2007-11-30 | $3760.00 | Window Closed / Lapsed |
| 11.5 Years (Year 12) | 2010-11-29 | 2011-05-31 | 2011-11-30 | $7700.00 | Window Closed / Lapsed |