# US 2023/0158669 A1 · Robot joint torque control system and load compensation method therefor

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 2023/0158669 A1
- Document ID: US20230158669A1
- Status: Published application
- Kind: A1
- Application number: 17/908,238
- Filed: 2020-05-09
- Published: 2023-05-25
- Earliest claimed: 2020-03-17
- Assignees: Beijing Institute of Technology
- Applicants: Beijing Institute of Technology
- Inventors: Zhangguo YU; Qiang HUANG; Yaliang LIU; Yuyu ZUO; Xuechao CHEN; Gao HUANG; Han YU
- Web page: https://patentgrep.com/patent/US20230158669A1

## CPC

- B25J 9/1633: {compliant, force, torque control, e.g. combined with position control}
- B25J 9/1638: {compensation for arm bending/inertia, pay load weight/inertia}
- B25J 13/085: {Force or torque sensors (B25J13/082, B25J13/084 take precedence)}
- G05B 19/4155: characterised by program execution, i.e. part program or machine function execution, e.g. selection of a program
- G05B 2219/39188: Torque compensation
- B25J: MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES ({manipulators specially adapted for use in surgery A61B34/70; manipulators used in cleaning hollow articles B08B9/04}; manipulators associated with rolling mills B21B39/20; manipulators associated with forging machines B21J13/10; {manipulators associated with picking-up and placing mechanisms B23P19/007}; means for holding wheels or parts thereof B60B30/00; {vehicles with ground-engaging propulsion means, e.g. walking members B62D57/02, B62D57/032; devices for picking-up and depositing articles or materials between conveyors B65G47/90, B65G47/91; manipulators with gripping or holding means for transferring packages B65H67/065}; cranes B66C; {manipulators used in the protection or supervision of pipe-line installations F17D5/00; walking equipment adapted for nuclear steam-generators F22B37/006}; manipulators specially adapted for, or associated with, nuclear reactors G21C; {apparatus used for handling wafers during manufacture or treatment of semiconductor H10P72/50})
- G05B: CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS (systems for controlling or regulating non-electric variables G05D; systems for regulating electric or magnetic variables G05F; control devices or systems insofar as characterised by mechanical features only G05G)

## Abstract

A robot joint torque control system and a load compensation method therefor are provided, which relate to the technical field of robot joint motion control. A mathematical model of the robot joint torque control system is established first. Equivalent transformation is performed on a system functional block diagram thereof, and then it can be seen that load parameters have a great influence on joint torque output. A load compensation controller is designed to effectively eliminate the influence of the load parameters on an output torque of the joint. The system is equivalent to an inertial element on the basis of the compensation, and then a PD controller parameter is adjusted to increase an open-loop gain of the system, so as to increase a system bandwidth and increase a response speed of the joint torque control system, thereby improving performance of the joint torque control system.

## Claims

### Claim 1

A load compensation method for a robot joint torque control system, comprising accumulating a current if whose joint-end velocity is compensated for by a load compensation controller and an original current loop input instruction ir, and then using the accumulated current as a current loop input instruction of a joint torque control system to effectively compensate for an influence of load parameters on an output torque of the joint torque control system;
wherein the load compensation controller is
G
f
(
s
)
=
nK
v
K
a
,
wherein n is a reduction ratio of a gear reducer, Kv is a velocity feedback coefficient of a servo motor, and Ka is a current loop control parameter;
an open-loop transfer function of the joint torque control system is:
G
⁡
(
s
)
=
T
p
E
T
=
nK
t
⁢
K
a
⁢
K
PD
Ls
+
R
+
K
a
⁢
K
t
=
nK
t
⁢
K
a
⁢
K
PD
R
+
K
a
⁢
K
t
s
ω
+
1
=
K
a
s
ω
+
1
wherein a corner frequency of an inertial element:
ω
=
R
+
K
a
⁢
K
t
L
,
an open-loop gain
K
o
=
K
PD
⁢
nK
t
⁢
K
a
R
+
K
a
⁢
K
t
,
KPD is a PD controller parameter, Kt is a torque coefficient of the servo motor, L is an inductance of the servo motor, and R is a resistance of the servo motor.

### Claim 2

(canceled)

### Claim 3

(canceled)

### Claim 4 (depends on 1)

The load compensation method for the robot joint torque control system according to claim 1, wherein when the PD controller parameter KPD is increased, the open-loop gain Ko of the system increases accordingly, and a cutoff frequency when the joint torque control system passes through a 0 db line increases; that is, a system bandwidth increases, thereby improving rapidity of the system.

### Claim 5 (depends on 1)

A joint torque control system according to claim 1, comprising a joint body and a control system, wherein the joint body comprises a servo motor, a gear reducer, a torque sensor, and an absolute encoder, wherein an output shaft of the servo motor is rigidly and fixedly connected to the gear reducer, the gear reducer is rigidly connected to a joint-end load by means of the torque sensor, and the absolute encoder is mounted at the joint-end load; the control system comprises a first comparator, a torque loop controller, a second comparator, and a current loop controller, wherein the first comparator, the torque loop controller, the second comparator, and the current loop controller are sequentially in signal connection.

### Claim 6 (depends on 5)

The joint torque control system according to claim 5, wherein the torque sensor is used for detecting an actual torque of a joint end; a current sensor is mounted inside the servo motor and used for detecting an actual output current of the servo motor; and the absolute encoder is used for detecting an actual position of the joint-end load.

### Claim 7 (depends on 6)

The joint torque control system according to claim 6, wherein in the control system, a given current and the actual output current of the servo motor are compared and subtracted, and pass through the second comparator to control current output of the servo motor and form an internal current loop; a given torque and the actual torque of the joint end are compared and subtracted, and then pass through the first comparator and the internal current loop to control joint torque output and form an external torque loop.

### Claim 8

(canceled)

### Claim 9

(canceled)

### Claim 10 (depends on 5)

The joint torque control system according to claim 5, wherein when the PD controller parameter KPD is increased, the open-loop gain Ko of the system increases accordingly, and a cutoff frequency when the joint torque control system passes through a 0 db line increases; that is, a system bandwidth increases, thereby improving rapidity of the system.
