CN110861090A - Torque feedforward control system and method - Google Patents

Torque feedforward control system and method Download PDF

Info

Publication number
CN110861090A
CN110861090A CN201911216982.7A CN201911216982A CN110861090A CN 110861090 A CN110861090 A CN 110861090A CN 201911216982 A CN201911216982 A CN 201911216982A CN 110861090 A CN110861090 A CN 110861090A
Authority
CN
China
Prior art keywords
joint
moment
feedforward
signal
controller
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201911216982.7A
Other languages
Chinese (zh)
Other versions
CN110861090B (en
Inventor
张锴
焦明杰
连志军
王平江
徐慧
陈曼林
洪亮
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Quanzhou China Robot Co Ltd
Quanzhou Huazhong University Of Science And Technology Institute Of Manufacturing
Original Assignee
Quanzhou China Robot Co Ltd
Quanzhou Huazhong University Of Science And Technology Institute Of Manufacturing
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Quanzhou China Robot Co Ltd, Quanzhou Huazhong University Of Science And Technology Institute Of Manufacturing filed Critical Quanzhou China Robot Co Ltd
Priority to CN201911216982.7A priority Critical patent/CN110861090B/en
Publication of CN110861090A publication Critical patent/CN110861090A/en
Application granted granted Critical
Publication of CN110861090B publication Critical patent/CN110861090B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/1633Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control

Abstract

The invention relates to a moment feedforward control system and a method, wherein the method comprises the following steps: the motion controller generates a joint command and transmits the joint command to the servo controller through the HAL equipment driving module, and the servo controller controls a servo motor to regulate and control the joint robot to perform repetitive motion according to the joint command; collecting joint expected corner signals and moment signals of the robot in the motion process by using a joint moment sensor, and transmitting the collected joint expected corner signals and moment signals to an HAL equipment driving module; the HAL equipment driving module processes the joint expected corner signal and the moment signal by using a feedforward compensation algorithm to obtain a moment feedforward quantity signal and transmits the moment feedforward quantity signal to the servo controller; and the servo controller regulates and controls the servo motor to operate according to the moment feedforward quantity signal and the joint instruction. Compared with the prior art, the invention realizes the high-speed movement of the robot, improves the control precision of the movement track of the robot and improves the dynamic response characteristic of the robot.

Description

Torque feedforward control system and method
Technical Field
The invention relates to the technical field of robots, in particular to a torque feedforward control system and method by using a joint torque sensor.
Background
With the continuous maturity of industrial robot technology, the continuous reduction of industrial robot price and the annual increase of labor cost, industrial robots are being accelerated to be integrated into the aspects of social production and life, and are playing more and more important roles. With the advance of intelligent manufacturing, the progress of industrial robot technology, the development of industry and the application of industry are put in outstanding positions, and industrial robots are widely applied to the fields of transportation, spraying, welding, assembly and the like, and develop towards higher speed, high precision and high intelligence, and provide more rigorous requirements for the control precision of the robots.
In a traditional robot control strategy, a PID (proportion integration differentiation) adjusting technology in a servo drive is utilized, but the control precision of the robot in a high-speed motion process cannot be ensured only through a control strategy of error feedback, various nonlinear factors in the motion control of the robot are ignored, and the position tracking precision and the response speed of a robot joint are difficult to ensure under the conditions of high speed or heavy load. It is necessary to solve these problems.
Disclosure of Invention
The present invention is directed to solving, at least to some extent, one of the above-mentioned problems in the prior art. Therefore, an object of the present invention is to provide a torque feedforward control system and method that improve control accuracy and improve the dynamic response characteristics of a robot.
The technical scheme for solving the technical problems is as follows: a torque feedforward control method, comprising the steps of:
step 1, a motion controller generates a joint command and transmits the joint command to a servo controller through an HAL equipment driving module, and the servo controller controls a servo motor to regulate and control a joint robot to perform repetitive motion according to the joint command;
step 2, collecting joint expected corner signals and moment signals of the robot in the movement process by using a joint moment sensor, and transmitting the collected joint expected corner signals and moment signals to an HAL equipment driving module;
step 3, the HAL equipment driving module processes the joint expected corner signal and the moment signal by using a feedforward compensation algorithm to obtain a moment feedforward quantity signal and transmits the moment feedforward quantity signal to the servo controller;
and 4, the servo controller regulates and controls the servo motor to operate according to the moment feedforward quantity signal and the joint instruction.
On the basis of the technical scheme, the invention can be further improved as follows.
Further, the motion controller performs trajectory planning and motion interpolation on the robot, and generates joint instructions according to the trajectory planning and transmits the joint instructions to the servo controller through the HAL equipment driving module.
Further, the servo controller comprises a position controller, a speed controller and a current controller;
the position controller receives a joint instruction, generates a regulation signal according to the joint instruction and transmits the regulation signal to the speed controller;
the speed controller processes the control signal to obtain a speed signal and transmits the speed signal to the current controller;
the current controller processes the speed signal, generates a current signal and transmits the current signal to the servo motor, and the servo motor operates according to the current signal; the current controller also receives the moment feedforward quantity signal, processes the moment feedforward quantity of the moment feedforward quantity signal and the current signal, generates a superposed current signal and transmits the superposed current signal to the servo motor, and the servo motor operates according to the superposed current signal.
The dynamic feedforward module is used for establishing a dynamic model and establishing a feedforward compensation algorithm according to the dynamic model; a feed forward compensation algorithm is introduced into the HAL device driver module.
Further, the feedforward compensation algorithm determines parameters of a dynamic model according to rod piece mass data, rod piece length data and inertia tensor data of the rod piece of the robot, and then determines a dynamic feedforward algorithm; the HAL equipment driving module acquires joint corner data, angular velocity data and angular acceleration data according to the joint expected corner signal and the moment signal, calculates by utilizing a feedforward compensation algorithm, and acquires the optimal moment for each joint of the robot to finish planning the track
Figure 100002_DEST_PATH_IMAGE001
(ii) a According to the optimum torque value
Figure 928467DEST_PATH_IMAGE002
And the torque feedforward amount of the joint torque signal
Figure 862925DEST_PATH_IMAGE003
Determining a torque feed forward quantity
Figure DEST_PATH_IMAGE004
In the above embodiment, the dynamic model specifically includes:
Figure 184185DEST_PATH_IMAGE005
Figure DEST_PATH_IMAGE006
Figure 539116DEST_PATH_IMAGE007
wherein
Figure DEST_PATH_IMAGE008
Figure 338444DEST_PATH_IMAGE009
Figure DEST_PATH_IMAGE010
Figure 674879DEST_PATH_IMAGE011
Figure DEST_PATH_IMAGE012
Figure 370303DEST_PATH_IMAGE013
Figure DEST_PATH_IMAGE014
Figure 657933DEST_PATH_IMAGE015
Figure DEST_PATH_IMAGE016
Wherein the content of the first and second substances,
Figure 526532DEST_PATH_IMAGE017
: j-th joint best moment;
Figure DEST_PATH_IMAGE018
: the ith joint feedback moment;
Figure 983052DEST_PATH_IMAGE019
: an inertia matrix;
Figure DEST_PATH_IMAGE020
: a homogeneous transformation matrix from a No. 0 coordinate system to a No. k coordinate system;
Figure 583798DEST_PATH_IMAGE021
: the desired rotation angle of the ith joint of the robot;
Figure DEST_PATH_IMAGE022
: the desired angular velocity of the ith joint of the robot;
Figure 640616DEST_PATH_IMAGE023
: the desired angular acceleration of the ith joint of the robot;
Figure DEST_PATH_IMAGE024
: the i-th joint inertia matrix is obtained,
Figure 31015DEST_PATH_IMAGE025
: the expression of the gravity vector in coordinate system No. 0,
Figure DEST_PATH_IMAGE026
: the expression of the centroid of the bar member j in the coordinate system of number j.
The invention has the beneficial effects that: the feedforward compensation calculation is utilized to improve the position tracking precision of the robot joint under the condition of high-speed movement and the nonlinear effect generated by dynamic coupling and structural flexibility; the motion controller, the HAL equipment driving module, the servo controller, the servo motor, the joint torque sensor and the dynamics feedforward module are coordinated to operate, a feedforward value can be modified in real time, the control precision of the motion track of the robot is improved under the condition that the robot moves at a high speed, and the dynamic response characteristic of the robot is improved.
Another technical solution of the present invention for solving the above technical problems is as follows: a torque feedforward control system comprises a motion controller, an HAL equipment driving module, a servo controller, a servo motor and a joint torque sensor;
the motion controller is used for generating a joint command and transmitting the joint command to the HAL equipment driving module;
the HAL equipment driving module transmits a joint instruction to a servo controller; the servo controller is also used for processing the joint expected rotation angle signal and the moment signal by utilizing a feedforward compensation algorithm to obtain a moment feedforward quantity signal and transmitting the moment feedforward quantity signal to the servo controller;
the servo controller is used for controlling the servo motor to control the joint robot to perform repetitive motion according to the joint instruction; and the servo motor is regulated and controlled to operate according to the moment feedforward quantity signal and the joint instruction.
The joint torque sensor is used for collecting joint expected corner signals and torque signals of the robot in the movement process and transmitting the joint expected corner signals and the torque signals to the HAL equipment driving module.
The invention has the beneficial effects that: the feedforward compensation calculation is utilized to improve the position tracking precision of the robot joint under the condition of high-speed movement and the nonlinear effect generated by dynamic coupling and structural flexibility; the motion controller, the HAL equipment driving module, the servo controller, the servo motor, the joint torque sensor and the dynamics feedforward module are coordinated to operate, a feedforward value can be modified in real time, the control precision of the motion track of the robot is improved under the condition that the robot moves at a high speed, and the dynamic response characteristic of the robot is improved.
Drawings
FIG. 1 is a flow chart of a torque feedforward control method of the present invention;
FIG. 2 is a block diagram of a torque feed forward control system of the present invention.
In the drawings, the components represented by the respective reference numerals are listed below:
1. a motion controller, 2, a HAL equipment driving module;
3. servo controller, 3.1, position controller, 3.2, speed controller, 3.3, current controller;
4. servo motor, 5, joint torque sensor, 6, dynamics feedforward module.
Detailed Description
The principles and features of this invention are described below in conjunction with the following drawings, which are set forth by way of illustration only and are not intended to limit the scope of the invention.
Example 1:
as shown in fig. 1, a torque feedforward control method includes the following steps:
step 1, a motion controller 1 generates a joint command and transmits the joint command to a servo controller 3 through an HAL equipment driving module 2, and the servo controller 3 controls a servo motor 4 to regulate and control a joint robot to perform repetitive motion according to the joint command;
step 2, collecting joint expected corner signals and moment signals of the robot in the movement process by using a joint moment sensor 5, and transmitting the collected joint expected corner signals and moment signals to the HAL equipment driving module 2;
step 3, the HAL equipment driving module 2 processes the joint expected corner signal and the moment signal by using a feedforward compensation algorithm to obtain a moment feedforward quantity signal and transmits the moment feedforward quantity signal to the servo controller 3;
and 4, the servo controller 3 regulates and controls the servo motor 4 to operate according to the moment feedforward quantity signal and the joint instruction.
According to the communication principle of the EtherCAT servo controller 3, an equipment driving module is constructed, the support of the EtherCAT servo controller 3 on speed and torque feedforward control is realized, the relation between PDO related to feedforward and joint speed and moment is verified, and a HAL equipment driving module 2 with an EtherCAT interface hardware board card is created; the method comprises the steps of realizing a comp file, finally compiling to generate a ko file, and dynamically loading the ko file into a kernel; the HAL file instantiates the designed HAL equipment driving module 2, makes pin connection of software and hardware, and adds the torque feedforward implementation function into a thread.
The moment feedforward quantity is output to the servo controller 3 through an EtherCAT real-time bus, and meanwhile, the feedback of joint moment signals is completed in the same servo period, so that the moment feedforward quantity is modified in real time according to the joint moment value.
The feedforward compensation calculation is utilized to improve the position tracking precision of the robot joint under the condition of high-speed movement and the nonlinear effect generated by dynamic coupling and structural flexibility; the motion controller 1, the HAL equipment driving module 2, the servo controller 3, the servo motor 4, the joint torque sensor 5 and the dynamics feedforward module 6 are coordinated to operate, a feedforward value can be modified in real time, the control precision of the motion track of the robot is improved under the high-speed motion of the robot, and the dynamic response characteristic of the robot is improved.
In the above embodiment, the motion controller 1 performs trajectory planning and motion interpolation on the robot, and the motion controller 1 generates joint commands according to the trajectory planning and transmits the joint commands to the servo controller 3 through the HAL device driving module 2.
The motion controller 1 performs track planning and motion interpolation on the robot, so that the feedforward value can be modified in real time conveniently, and the control precision of the motion track of the robot is improved.
In the above embodiment, the servo controller 3 includes a position controller 3.1, a speed controller 3.2 and a current controller 3.3;
the position controller 3.1 receives the joint instruction, generates a regulation and control signal according to the joint instruction and transmits the regulation and control signal to the speed controller 3.2;
the speed controller 3.2 processes the control signal to obtain a speed signal, and transmits the speed signal to the current controller 3.3;
the current controller 3.3 processes the speed signal, generates a current signal and transmits the current signal to the servo motor 4, and the servo motor 4 operates according to the current signal; the current controller 3.3 also receives the moment feedforward quantity signal, processes the moment feedforward quantity and the current signal of the moment feedforward quantity signal, generates a superposed current signal and transmits the superposed current signal to the servo motor 4, and the servo motor 4 operates according to the superposed current signal.
The dynamic feedforward module 6 is used for establishing a dynamic model and establishing a feedforward compensation algorithm according to the dynamic model; the feed forward compensation algorithm is introduced into the HAL device driver module 2.
In the above embodiment, the feedforward compensation algorithm determines parameters of a dynamic model according to the rod mass data, the rod length data, and the inertia tensor data of the rod of the robot, and further determines a dynamic feedforward algorithm; the HAL equipment driving module 2 acquires joint corner data, angular velocity data and angular acceleration data according to the expected joint corner signal and the torque signal, and before the useCalculating by a feedback compensation algorithm to obtain the optimal moment of each joint of the robot to finish the planned track
Figure 794571DEST_PATH_IMAGE001
(ii) a According to the optimum torque value
Figure 831797DEST_PATH_IMAGE002
And the torque feedforward amount of the joint torque signal
Figure 595485DEST_PATH_IMAGE027
Determining a torque feed forward quantity
Figure 9149DEST_PATH_IMAGE004
In the above embodiment, the dynamic model specifically includes:
Figure 892791DEST_PATH_IMAGE005
Figure 366498DEST_PATH_IMAGE006
Figure 584859DEST_PATH_IMAGE007
wherein
Figure DEST_PATH_IMAGE028
Figure 271055DEST_PATH_IMAGE029
Figure 274783DEST_PATH_IMAGE010
Figure 653812DEST_PATH_IMAGE011
Figure DEST_PATH_IMAGE030
Figure 392092DEST_PATH_IMAGE013
Figure 147558DEST_PATH_IMAGE014
Figure 5793DEST_PATH_IMAGE015
Figure 70570DEST_PATH_IMAGE016
Wherein the content of the first and second substances,
Figure 14255DEST_PATH_IMAGE017
: j-th joint best moment;
Figure 307833DEST_PATH_IMAGE018
: the ith joint feedback moment;
Figure 286153DEST_PATH_IMAGE019
: an inertia matrix;
Figure 23296DEST_PATH_IMAGE031
: a homogeneous transformation matrix from a No. 0 coordinate system to a No. k coordinate system;
Figure DEST_PATH_IMAGE032
: the desired rotation angle of the ith joint of the robot;
Figure 985436DEST_PATH_IMAGE033
: the desired angular velocity of the ith joint of the robot;
Figure DEST_PATH_IMAGE034
: the desired angular acceleration of the ith joint of the robot;
Figure 817126DEST_PATH_IMAGE024
: the ith jointThe matrix of the moments of inertia,
Figure 633641DEST_PATH_IMAGE025
: the expression of the gravity vector in coordinate system No. 0,
Figure 56532DEST_PATH_IMAGE026
: the expression of the centroid of the bar member j in the coordinate system of number j.
The feedforward compensation calculation constructed by the dynamic model improves the position tracking precision of the robot joint under the condition of high-speed motion and the nonlinear effect generated by dynamic coupling and structural flexibility.
Example 2:
as shown in fig. 2, a torque feedforward control system includes a motion controller 1, a HAL device driving module 2, and a joint torque sensor 5;
the motion controller 1 is used for generating joint instructions and transmitting the joint instructions to the HAL equipment driving module 2;
the HAL equipment driving module 2 transmits joint instructions to the servo controller 3; the servo controller is also used for processing the joint expected rotation angle signal and the moment signal by utilizing a feedforward compensation algorithm to obtain a moment feedforward quantity signal and transmitting the moment feedforward quantity signal to the servo controller 3;
the servo controller 3 is used for controlling the servo motor 4 to control the joint robot to perform repetitive motion according to the joint instruction; and the servo motor 4 is regulated and controlled to operate according to the moment feedforward quantity signal and the joint instruction.
The joint torque sensor 5 is used for acquiring joint expected rotation angle signals and torque signals of the robot in the movement process and transmitting the joint expected rotation angle signals and the torque signals to the HAL equipment driving module 2.
According to the communication principle of the EtherCAT servo controller 3, an equipment driving module is constructed, the support of the EtherCAT servo controller 3 on speed and torque feedforward control is realized, the relation between PDO related to feedforward and joint speed and moment is verified, and a HAL equipment driving module 2 with an EtherCAT interface hardware board card is created; the method comprises the steps of realizing a comp file, finally compiling to generate a ko file, and dynamically loading the ko file into a kernel; the HAL file instantiates the designed HAL equipment driving module 2, makes pin connection of software and hardware, and adds the torque feedforward implementation function into a thread.
The moment feedforward quantity is output to the servo controller 3 through an EtherCAT real-time bus, and meanwhile, the feedback of joint moment signals is completed in the same servo period, so that the moment feedforward quantity is modified in real time according to the joint moment value.
The feedforward compensation calculation is utilized to improve the position tracking precision of the robot joint under the condition of high-speed movement and the nonlinear effect generated by dynamic coupling and structural flexibility; the motion controller 1, the HAL equipment driving module 2, the servo controller 3, the servo motor 4, the joint torque sensor 5 and the dynamics feedforward module 6 are coordinated to operate, a feedforward value can be modified in real time, the control precision of the motion track of the robot is improved under the high-speed motion of the robot, and the dynamic response characteristic of the robot is improved.
In the above embodiment, the motion controller 1 performs trajectory planning and motion interpolation on the robot, and the motion controller 1 generates joint commands according to the trajectory planning and transmits the joint commands to the servo controller 3 through the HAL device driving module 2.
The motion controller 1 performs track planning and motion interpolation on the robot, so that the feedforward value can be modified in real time conveniently, and the control precision of the motion track of the robot is improved.
In the above embodiment, the servo controller 3 includes a position controller 3.1, a speed controller 3.2 and a current controller 3.3;
the position controller 3.1 receives the joint instruction, generates a regulation and control signal according to the joint instruction and transmits the regulation and control signal to the speed controller 3.2;
the speed controller 3.2 processes the control signal to obtain a speed signal, and transmits the speed signal to the current controller 3.3;
the current controller 3.3 processes the speed signal, generates a current signal and transmits the current signal to the servo motor 4, and the servo motor 4 operates according to the current signal; the current controller 3.3 also receives the moment feedforward quantity signal, processes the moment feedforward quantity and the current signal of the moment feedforward quantity signal, generates a superposed current signal and transmits the superposed current signal to the servo motor 4, and the servo motor 4 operates according to the superposed current signal.
The dynamic feedforward module 6 is used for establishing a dynamic model and establishing a feedforward compensation algorithm according to the dynamic model; the feed forward compensation algorithm is introduced into the HAL device driver module 2.
In the above embodiment, the feedforward compensation algorithm determines parameters of a dynamic model according to the rod mass data, the rod length data, and the inertia tensor data of the rod of the robot, and further determines a dynamic feedforward algorithm; the HAL equipment driving module 2 acquires joint corner data, angular velocity data and angular acceleration data according to the joint expected corner signal and the moment signal, calculates by utilizing a feedforward compensation algorithm, and acquires the optimal moment for each joint of the robot to finish planning the track
Figure 974809DEST_PATH_IMAGE001
(ii) a According to the optimum torque value
Figure 610190DEST_PATH_IMAGE002
And the torque feedforward amount of the joint torque signal
Figure 48256DEST_PATH_IMAGE027
Determining a torque feed forward quantity
Figure 579731DEST_PATH_IMAGE004
In the above embodiment, the dynamic model specifically includes:
Figure 719726DEST_PATH_IMAGE005
Figure 424376DEST_PATH_IMAGE006
Figure 966216DEST_PATH_IMAGE007
wherein
Figure 714598DEST_PATH_IMAGE028
Figure 607468DEST_PATH_IMAGE029
Figure 584651DEST_PATH_IMAGE010
Figure 246577DEST_PATH_IMAGE011
Figure 667325DEST_PATH_IMAGE030
Figure 985174DEST_PATH_IMAGE013
Figure 766048DEST_PATH_IMAGE014
Figure 282480DEST_PATH_IMAGE015
Figure 123397DEST_PATH_IMAGE016
Wherein the content of the first and second substances,
Figure 974547DEST_PATH_IMAGE017
: j-th joint best moment;
Figure 824692DEST_PATH_IMAGE018
: the ith joint feedback moment;
Figure 195630DEST_PATH_IMAGE019
: an inertia matrix;
Figure 207448DEST_PATH_IMAGE020
: a homogeneous transformation matrix from a No. 0 coordinate system to a No. k coordinate system;
Figure 781780DEST_PATH_IMAGE021
: the desired rotation angle of the ith joint of the robot;
Figure 170036DEST_PATH_IMAGE022
: the desired angular velocity of the ith joint of the robot;
Figure 598744DEST_PATH_IMAGE023
: the desired angular acceleration of the ith joint of the robot;
Figure 781463DEST_PATH_IMAGE024
: the i-th joint inertia matrix is obtained,
Figure 357938DEST_PATH_IMAGE025
: the expression of the gravity vector in coordinate system No. 0,
Figure 533573DEST_PATH_IMAGE026
: the expression of the centroid of the bar member j in the coordinate system of number j.
The feedforward compensation calculation constructed by the dynamic model improves the position tracking precision of the robot joint under the condition of high-speed motion and the nonlinear effect generated by dynamic coupling and structural flexibility.
The above description is only for the purpose of illustrating the preferred embodiments of the present invention and is not to be construed as limiting the invention, and any modifications, equivalents, improvements and the like that fall within the spirit and principle of the present invention are intended to be included therein.

Claims (8)

1. A torque feedforward control method, comprising the steps of:
step 1, a motion controller (1) generates a joint command and transmits the joint command to a servo controller (3) through an HAL equipment driving module (2), and the servo controller (3) controls a servo motor (4) to regulate and control a joint robot to perform repetitive motion according to the joint command;
step 2, collecting joint expected corner signals and moment signals of the robot in the movement process by using a joint moment sensor (5), and transmitting the collected joint expected corner signals and moment signals to an HAL equipment driving module (2);
step 3, the HAL equipment driving module (2) processes the joint expected rotation angle signal and the moment signal by using a feedforward compensation algorithm to obtain a moment feedforward quantity signal and transmits the moment feedforward quantity signal to the servo controller (3);
and 4, the servo controller (3) regulates and controls the servo motor (4) to operate according to the moment feedforward quantity signal and the joint instruction.
2. A torque feedforward control method as claimed in claim 1, characterized in that the motion controller (1) performs trajectory planning and motion interpolation on the robot, and the motion controller (1) generates joint commands according to the trajectory planning and transmits the joint commands to the servo controller (3) through the HAL device driver module (2).
3. A torque feedforward control method according to claim 2, characterized in that the servo controller (3) comprises a position controller (3.1), a speed controller (3.2) and a current controller (3.3);
the position controller (3.1) receives the joint instruction, generates a regulation and control signal according to the joint instruction and transmits the regulation and control signal to the speed controller (3.2);
the speed controller (3.2) processes the control signal to obtain a speed signal, and transmits the speed signal to the current controller (3.3);
the current controller (3.3) processes the speed signal, generates a current signal and transmits the current signal to the servo motor (4), and the servo motor (4) operates according to the current signal; the current controller (3.3) also receives a moment feedforward quantity signal, processes the moment feedforward quantity and the current signal of the moment feedforward quantity signal, generates a superposed current signal and transmits the superposed current signal to the servo motor (4), and the servo motor (4) operates according to the superposed current signal.
4. The torque feedforward control method according to claim 1, further comprising a dynamic feedforward module (6), wherein the dynamic feedforward module (6) establishes a dynamic model, and constructs a feedforward compensation algorithm according to the dynamic model; the feed forward compensation algorithm is introduced into the HAL device driver module (2).
5. A moment feedforward control method according to claim 4, wherein the feedforward compensation algorithm determines parameters of a dynamic model according to rod mass data, rod length data and inertia tensor data of a rod of the robot, and further determines a dynamic feedforward algorithm; the HAL equipment driving module (2) acquires joint corner data, angular velocity data and angular acceleration data according to the joint expected corner signal and the moment signal, and calculates by using a feedforward compensation algorithm to acquire the optimal moment of each joint of the robot to finish the planned track
Figure DEST_PATH_IMAGE001
(ii) a According to the optimum torque value
Figure 132141DEST_PATH_IMAGE001
And the torque feedforward amount of the joint torque signal
Figure 689024DEST_PATH_IMAGE002
Determining a torque feed forward quantity
Figure DEST_PATH_IMAGE003
6. A torque feedforward control method as claimed in claim 4 or 5, characterized in that the dynamic model is in particular:
Figure 565844DEST_PATH_IMAGE004
Figure 968007DEST_PATH_IMAGE005
Figure 230361DEST_PATH_IMAGE006
wherein
Figure 692566DEST_PATH_IMAGE007
Figure 24059DEST_PATH_IMAGE008
Figure 495492DEST_PATH_IMAGE009
Figure 612352DEST_PATH_IMAGE010
Figure 42197DEST_PATH_IMAGE011
Figure 752664DEST_PATH_IMAGE012
Figure 637574DEST_PATH_IMAGE013
Figure 484307DEST_PATH_IMAGE014
Figure 412949DEST_PATH_IMAGE015
Wherein the content of the first and second substances,
Figure 345133DEST_PATH_IMAGE016
: j-th joint best moment;
Figure 532270DEST_PATH_IMAGE017
: the ith joint feedback moment;
Figure 295826DEST_PATH_IMAGE018
: an inertia matrix;
Figure 270736DEST_PATH_IMAGE019
: a homogeneous transformation matrix from a No. 0 coordinate system to a No. k coordinate system;
Figure 80429DEST_PATH_IMAGE020
: the desired rotation angle of the ith joint of the robot;
Figure 431776DEST_PATH_IMAGE021
: the desired angular velocity of the ith joint of the robot;
Figure 862888DEST_PATH_IMAGE022
: the desired angular acceleration of the ith joint of the robot;
Figure 8699DEST_PATH_IMAGE023
: the i-th joint inertia matrix is obtained,
Figure 712212DEST_PATH_IMAGE024
: the expression of the gravity vector in coordinate system No. 0,
Figure 991884DEST_PATH_IMAGE025
: the expression of the centroid of the bar member j in the coordinate system of number j.
7. A moment feedforward control system is characterized by comprising a motion controller (1), an HAL equipment driving module (2), a servo controller (3), a servo motor (4) and a joint moment sensor (5);
the motion controller (1) is used for generating joint instructions and transmitting the joint instructions to the HAL equipment driving module (2);
the HAL equipment driving module (2) transmits joint instructions to a servo controller (3); the servo controller is also used for processing the joint expected rotation angle signal and the moment signal by utilizing a feedforward compensation algorithm to obtain a moment feedforward quantity signal and transmitting the moment feedforward quantity signal to the servo controller (3);
the servo controller (3) is used for controlling the servo motor (4) to control the joint robot to perform repetitive motion according to the joint instruction; and the servo motor (4) is regulated and controlled to operate according to the moment feedforward quantity signal and the joint instruction.
8. The joint torque sensor (5) is used for collecting joint expected rotation angle signals and torque signals of the robot in the movement process and transmitting the joint expected rotation angle signals and the torque signals to the HAL equipment driving module (2).
CN201911216982.7A 2019-12-03 2019-12-03 Torque feedforward control system and method Active CN110861090B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911216982.7A CN110861090B (en) 2019-12-03 2019-12-03 Torque feedforward control system and method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911216982.7A CN110861090B (en) 2019-12-03 2019-12-03 Torque feedforward control system and method

Publications (2)

Publication Number Publication Date
CN110861090A true CN110861090A (en) 2020-03-06
CN110861090B CN110861090B (en) 2021-04-06

Family

ID=69657148

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911216982.7A Active CN110861090B (en) 2019-12-03 2019-12-03 Torque feedforward control system and method

Country Status (1)

Country Link
CN (1) CN110861090B (en)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111872942A (en) * 2020-08-07 2020-11-03 成都福莫斯智能系统集成服务有限公司 Torque feedforward method of multi-axis robot
CN113103211A (en) * 2021-02-09 2021-07-13 清华大学 Feedforward control method and device for parallel processing robot
CN113561170A (en) * 2020-04-29 2021-10-29 北京配天技术有限公司 Robot torque compensation method, robot, device and storage medium
CN113848939A (en) * 2021-10-14 2021-12-28 河南嘉晨智能控制股份有限公司 Method for improving acceleration and deceleration dynamic performance of industrial vehicle
CN114167719A (en) * 2021-11-30 2022-03-11 广东亿嘉和科技有限公司 Real-time control system of robot

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009072913A (en) * 2003-07-29 2009-04-09 Panasonic Corp Control method for robot
CN105676896A (en) * 2016-01-06 2016-06-15 西安交通大学 Feed-forward control method for robot servo system
CN107662209A (en) * 2017-09-21 2018-02-06 上海新时达机器人有限公司 A kind of control method and robot
CN108393892A (en) * 2018-03-05 2018-08-14 厦门大学 A kind of robot feedforward torque compensation method
CN108714896A (en) * 2018-05-28 2018-10-30 华南理工大学 A kind of robot flexibility torque feed forward control method based on kinetics of deformable bodies model
CN109760048A (en) * 2018-12-28 2019-05-17 深圳市越疆科技有限公司 A kind of method of servo-controlling of robot, device and robot

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009072913A (en) * 2003-07-29 2009-04-09 Panasonic Corp Control method for robot
CN105676896A (en) * 2016-01-06 2016-06-15 西安交通大学 Feed-forward control method for robot servo system
CN107662209A (en) * 2017-09-21 2018-02-06 上海新时达机器人有限公司 A kind of control method and robot
CN108393892A (en) * 2018-03-05 2018-08-14 厦门大学 A kind of robot feedforward torque compensation method
CN108714896A (en) * 2018-05-28 2018-10-30 华南理工大学 A kind of robot flexibility torque feed forward control method based on kinetics of deformable bodies model
CN109760048A (en) * 2018-12-28 2019-05-17 深圳市越疆科技有限公司 A kind of method of servo-controlling of robot, device and robot

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113561170A (en) * 2020-04-29 2021-10-29 北京配天技术有限公司 Robot torque compensation method, robot, device and storage medium
CN111872942A (en) * 2020-08-07 2020-11-03 成都福莫斯智能系统集成服务有限公司 Torque feedforward method of multi-axis robot
CN111872942B (en) * 2020-08-07 2023-06-20 四川福莫斯工业技术有限公司 Torque feedforward method of multi-axis robot
CN113103211A (en) * 2021-02-09 2021-07-13 清华大学 Feedforward control method and device for parallel processing robot
CN113103211B (en) * 2021-02-09 2022-06-14 清华大学 Feedforward control method and device for parallel processing robot
CN113848939A (en) * 2021-10-14 2021-12-28 河南嘉晨智能控制股份有限公司 Method for improving acceleration and deceleration dynamic performance of industrial vehicle
CN114167719A (en) * 2021-11-30 2022-03-11 广东亿嘉和科技有限公司 Real-time control system of robot

Also Published As

Publication number Publication date
CN110861090B (en) 2021-04-06

Similar Documents

Publication Publication Date Title
CN110861090B (en) Torque feedforward control system and method
CN109159151B (en) Mechanical arm space trajectory tracking dynamic compensation method and system
CN105773623B (en) SCARA robotic tracking control methods based on the study of forecasting type Indirect iteration
CN104731107B (en) A kind of electronic 6-dof motion platform high-precision control system and control method
CN111546315B (en) Robot flexible teaching and reproducing method based on human-computer cooperation
CN111258267B (en) Man-machine cooperation carrying system and hybrid vision control method thereof
CN108453732B (en) Self-adaptive dynamic force/position hybrid control method for closed robot of control system
CN112757306A (en) Inverse solution multi-solution selection and time optimal trajectory planning algorithm for mechanical arm
CN111687827B (en) Control method and control system for coordinating and operating weak rigid member by two robots
Tsakiris et al. Extending visual servoing techniques to nonholonomic mobile robots
CN109648564B (en) Control method of multi-degree-of-freedom flexible joint mechanical arm system based on hierarchical MPC (Multi-degree-of-freedom)
CN101318329A (en) Robot control apparatus
CN115990888A (en) Mechanical arm control method with dead zone and time-varying constraint function
Liu et al. An improved hybrid error control path tracking intelligent algorithm for omnidirectional AGV on ROS
CN108724195B (en) Coupling feedforward control method for robot
CN114290147A (en) Automobile hub polishing system and method based on cooperation of duplex robot
Tsakiris et al. Applying visual servoing techniques to control nonholonomic mobile robots
CN110900613A (en) Non-stop control method and system for mobile robot
CN108227493A (en) A kind of robot trace tracking method
CN116810792A (en) Fuse and booster double-robot assembly flexible control method based on neural network
CN114840947A (en) Three-degree-of-freedom mechanical arm dynamic model with constraint
Handler et al. Multidimensional path tracking with global least squares solution
CN112571411B (en) Dual-purpose mechanical arm for intelligent production line of television
CN114895556A (en) Wheel type robot track tracking control method and computer readable medium
Szádeczky-Kardoss et al. On-line trajectory time-scaling to reduce tracking error

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
EE01 Entry into force of recordation of patent licensing contract

Application publication date: 20200306

Assignee: Fujian ruibu Intelligent Equipment Co.,Ltd.

Assignor: QUANZHOU-HUST INTELLIGENT MANUFACTURING FUTURE

Contract record no.: X2024350000041

Denomination of invention: A torque feedforward control system and method

Granted publication date: 20210406

License type: Common License

Record date: 20240402