CN113977585A - Virtual force servo compliance control method - Google Patents

Virtual force servo compliance control method Download PDF

Info

Publication number
CN113977585A
CN113977585A CN202111412185.3A CN202111412185A CN113977585A CN 113977585 A CN113977585 A CN 113977585A CN 202111412185 A CN202111412185 A CN 202111412185A CN 113977585 A CN113977585 A CN 113977585A
Authority
CN
China
Prior art keywords
channel
force
acceleration
robot
virtual
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
CN202111412185.3A
Other languages
Chinese (zh)
Other versions
CN113977585B (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.)
Intelligent Mobile Robot Zhongshan Research Institute
China North Vehicle Research Institute
Original Assignee
Intelligent Mobile Robot Zhongshan Research Institute
China North Vehicle Research Institute
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 Intelligent Mobile Robot Zhongshan Research Institute, China North Vehicle Research Institute filed Critical Intelligent Mobile Robot Zhongshan Research Institute
Priority to CN202111412185.3A priority Critical patent/CN113977585B/en
Publication of CN113977585A publication Critical patent/CN113977585A/en
Application granted granted Critical
Publication of CN113977585B publication Critical patent/CN113977585B/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

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)

Abstract

The invention discloses a virtual force servo compliance control method, and belongs to the field of automatic control. The method enables the acceleration, speed and position control channels by combining swing track planning constraint and a support state on the basis of traditional force feedforward output, thereby improving the force control robustness of the robot in support and realizing accurate swing track tracking control. The method realizes hybrid control based on a multi-channel control method so as to improve the robustness of support contact force control, realize reliable tracking of expected force, improve the flexibility of mechanism control in the support, adjust the impedance rigidity of the controller through different flexibility requirements, and reduce the influence of different material quality on the force control reliability.

Description

Virtual force servo compliance control method
Technical Field
The invention relates to the field of automatic control, in particular to a virtual force servo compliance control method.
Background
The robot power servo control is a main technical means for realizing high dynamic and high precision, a foot-type bionic robot is taken as an example, the robot depends on force servo control to quickly adjust the position error in the supporting phase process, the required adjusting virtual force can be calculated based on kinematics or a simplified model through the control error of the robot body, but the feedforward tracking control performance of the expected force is reduced due to the problems of unreliability, slippage and the like existing in the supporting contact, the problems of high-frequency jitter or large noise and the like in the just-contacting process occur, and the reliability of tracking the expected force needs to be improved by adopting a virtual force compliance control algorithm.
Disclosure of Invention
In view of the technical problems, the invention provides a virtual force servo compliance control method, which realizes hybrid control by constructing a multi-channel control method so as to improve the robustness of support contact force control, realize reliable tracking of expected force, improve the compliance of mechanism control in support, adjust the impedance rigidity of a controller through different compliance requirements, and reduce the influence of different material surfaces on the reliability of force control.
The technical scheme adopted by the invention is as follows:
a virtual force servo compliance control method comprises the following steps:
step 1, generating an enabling signal G of a position, speed and force control channel based on the support contact condition, swing and other constraints of the tail end of the robot and the groundp、Gv、Ga、Gff
Step (ii) of2, calculating the virtual force f generated by the position channel controller by setting a position channel proportional coefficient and a damping coefficient by using the joint angle of the robot as feedback datapTo realize the impedance compliance control;
and 3, calculating the virtual force f generated by the speed channel controller by setting a speed channel proportional coefficient, a damping coefficient and a feedforward coefficient by using the angular velocity of the robot joint as feedback datavAnd velocity feedforward virtual force fvff
Step 4, adopting the motion acceleration of the tail end of the robot
Figure BDA0003374595190000023
Calculating the virtual force f generated by the acceleration channel controller by setting the acceleration channel proportionality coefficient, the damping coefficient and the feedforward coefficient as feedback dataaAnd acceleration feedforward virtual force faff
Step 5, control the enabling signal G of the channel based on the position, the speed and the forcep、Gv、Ga、GffMixing and superposing the virtual forces obtained in the steps 2, 3 and 4 to obtain a total virtual force fF
Step 6, mixing fFThe joint torque is converted by a virtual work principle, and an actuator torque control command tau is generated after the friction force and gravity feedforward are compensated, so that the joint impedance of the robot is flexibly controlled;
Figure BDA0003374595190000021
wherein g (q) is a gravity compensation term,
Figure BDA0003374595190000024
is a friction compensation term.
Further, the method for determining the enabling signals of the acceleration, velocity and position channels in step 1 is as follows:
when the swing track has a position planning result, the position channel enables the flag bit GpIs true;
when the swing track has the speed planning result, the speed channel enables the flag bit GvIs true;
when the tail end is in contact with the ground and supported and has an acceleration planning result, the acceleration channel enables the mark bit GaIs true;
when the tail end is in contact with the ground for supporting, the force feedforward channel mark bit GffIs true.
Further, the step 2 further comprises:
(1) firstly, constructing a mapping function of forward and inverse kinematics and Jacobian kinematics based on robot joint angle feedback:
Figure BDA0003374595190000022
where x is the position of the end of the robot,
Figure BDA0003374595190000031
is the terminal motion velocity, q is the robot joint angle,
Figure BDA0003374595190000038
is the robot joint angle, FK { } is the positive motion function, J is the jacobian matrix.
(2) X based on the current desired end positiondCalculating the virtual force f generated by the position channel controllerp
Figure BDA0003374595190000032
Wherein Kp,pAs a position channel proportionality coefficient, Kd,pIs the position channel damping coefficient.
Further, the step 3 further comprises:
(1) firstly, constructing a mapping function of forward and inverse kinematics and Jacobian kinematics based on angular velocity feedback of a robot joint:
Figure BDA0003374595190000033
wherein
Figure BDA0003374595190000034
Is the acceleration of the robot tip, which is obtained by differentiating the tip velocity,
Figure BDA0003374595190000035
is the robot joint angle and J is the jacobian matrix.
(2) Based on the current desired tip movement velocity
Figure BDA0003374595190000039
Calculating a virtual force f generated by a speed channel controllervAnd velocity feedforward virtual force fvff
Figure BDA0003374595190000036
Wherein Kp,vAs a velocity channel proportionality coefficient, Kd,vAs damping coefficient of velocity channel, Kff,vIs the velocity channel feedforward coefficient.
Further, the step 4 further comprises:
(1) firstly, calculating the current terminal supporting force f based on the virtual work principle and the Jacobian matrixest
fest=J-Tτm
Wherein tau ismThe resulting joint true torque is measured.
(2) Based on the current desired tip motion acceleration
Figure BDA0003374595190000037
Calculating the virtual force f generated by the acceleration channel controlleraAnd acceleration feedforward virtual force faff
Figure BDA0003374595190000041
Wherein Kp,aIs the acceleration channel proportionality coefficient, Kd,aAs damping coefficient of acceleration channel, Kff,aIs the feedforward coefficient of the acceleration channel, and m is the robot mass.
Further, in the step 5, the total virtual force f is calculated by using the following formulaF:
fF=fpGp+(fv+fvff)Gv+(fa+faff)Ga+FfGff
Wherein FfDesired feedforward force, G, to control system inputpBit flag for channel enable, GvBit flag for channel enable, GaBit flag for channel enable, GffThe force feedforward path is flagged.
Has the advantages that:
in the traditional force control method of the bionic robot, a feedback control rate is constructed by orienting to a simplified virtual rigid body, so that a corresponding virtual force is solved by combining the supporting condition of the feedback control rate, the virtual force is further mapped to a key actuator by adopting a virtual work theory, and finally pure moment control is carried out. The pure force control method is stable in an actual robot system due to uncontrollable contact, inaccurate actuator modeling and the like, noise and jitter exist during tracking of expected force, and damage can be caused to the actuator.
Drawings
FIG. 1 is a block diagram of a multi-channel robust controller;
fig. 2 is a flow chart of the calculation steps of the proposed method.
Detailed Description
The invention is described in further detail below with reference to figures 1 and 2.
A virtual force servo compliance control method is used for robust force tracking control requirements of bionic robot support force control, enables acceleration, speed and position control channels by combining swing track planning constraint and a support state on the basis of traditional force feedforward output, improves force control robustness of a robot in support, and realizes accurate swing track tracking control, and the method is shown in figures 1 and 2, and comprises the following specific processes:
step 1, generating an enabling signal G of a position, speed and force control channel based on the support contact condition, swing and other constraints of the tail end and the groundp、Gv、Ga、Gff
The bionic robot end effector needs to determine whether a moment feedforward control command is generated or not according to the current contact state of the robot and the ground, and enable signals of speed and position channels need to be further determined according to system control requirements, modes and constraints:
(1) a position channel: when the swing track has a position planning result, the channel enable flag bit GpIs true;
(2) a speed channel: when the swing track has the speed planning result, the channel enable flag GvIs true;
(3) acceleration channel: when the tail end is in contact with the ground and supported and has an acceleration planning result, the channel enables the mark position GaIs true;
(4) force feed-forward path: when the tail end is in contact with the ground for supporting, the force feedforward channel mark bit GffIs true;
step 2, designing position channel
(1) Firstly, constructing a mapping function of forward and inverse kinematics and Jacobian kinematics based on robot joint angle feedback:
Figure BDA0003374595190000051
where x is the position of the end of the robot,
Figure BDA0003374595190000052
is the terminal motion velocity, q is the robot joint angle,
Figure BDA0003374595190000053
is the robot joint angle, FK { } is the positive motion function, J is the jacobian matrix.
(2) X based on the current desired end positiondCalculating the virtual force f generated by the position channel controllerp
Figure BDA0003374595190000054
Wherein Kp,pAs a position channel proportionality coefficient, Kd,pIs the position channel damping coefficient.
Step 3, designing a speed channel
(1) Firstly, constructing a mapping function of forward and inverse kinematics and Jacobian kinematics based on angular velocity feedback of a robot joint:
Figure BDA0003374595190000061
wherein
Figure BDA0003374595190000062
Is the acceleration of the robot tip, which is obtained by differentiating the tip velocity,
Figure BDA0003374595190000063
is the robot joint angle and J is the jacobian matrix.
(2) Based on the current desired tip movement velocity
Figure BDA0003374595190000064
Calculating a virtual force f generated by a speed channel controllervAnd velocity feedforward virtual force fvff
Figure BDA0003374595190000065
Wherein Kp,vAs a velocity channel proportionality coefficient, Kd,vAs damping coefficient of velocity channel, Kff,vIs the velocity channel feedforward coefficient.
Step 4, designing an acceleration channel
(1) Firstly, calculating the current terminal supporting force f based on the virtual work principle and the Jacobian matrixest
fest=J-Tτm
Wherein tau ismThe resulting joint true torque is measured.
(2) Based on the current desired tip motion acceleration
Figure BDA0003374595190000066
Calculating the virtual force f generated by the acceleration channel controlleraAnd acceleration feedforward virtual force faff
Figure BDA0003374595190000067
Wherein Kp,aIs the acceleration channel proportionality coefficient, Kd,aAs damping coefficient of acceleration channel, Kff,aIs the feedforward coefficient of the acceleration channel, and m is the robot mass.
Step 5, mixing and superposing the virtual forces based on the control channel enabling signals to obtain total virtual force fF:
fF=fpGp+(fv+fvff)Gv+(fa+faff)Ga+FfGff
Wherein FfDesired feedforward force, G, to control system inputpBit flag for channel enable, GvBit flag for channel enable, GaBit flag for channel enable, GffThe force feedforward path is flagged.
Step 6, mixing fFConverting into joint torque by virtual work principle, and compensating friction force and gravity feedforwardThen, an actuator torque control command tau is generated, and the flexible control of the robot joint impedance is realized;
Figure BDA0003374595190000071
wherein g (q) is a gravity compensation term,
Figure BDA0003374595190000072
is a friction compensation term.
The method enables the acceleration, speed and position control channels by combining swing track planning constraint and a support state on the basis of traditional force feedforward output, thereby improving the force control robustness of the robot in support and realizing accurate swing track tracking control. The method realizes hybrid control based on a multi-channel control method so as to improve the robustness of support contact force control, realize reliable tracking of expected force, improve the flexibility of mechanism control in the support, adjust the impedance rigidity of the controller through different flexibility requirements, and reduce the influence of different material quality on the force control reliability.

Claims (6)

1. A virtual force servo compliance control method is characterized by comprising the following steps:
step 1, generating an enabling signal G of a position, speed and force control channel based on the support contact condition, swing and other constraints of the tail end of the robot and the groundp、Gv、Ga、Gff
Step 2, calculating the virtual force f generated by the position channel controller by setting a position channel proportional coefficient and a damping coefficient by using the joint angle of the robot as feedback datap
And 3, calculating the virtual force f generated by the speed channel controller by setting a speed channel proportional coefficient, a damping coefficient and a feedforward coefficient by using the angular velocity of the robot joint as feedback datavAnd velocity feedforward virtual force fvff
Step 4, adopting the motion acceleration of the tail end of the robot
Figure FDA0003374595180000012
Calculating the virtual force f generated by the acceleration channel controller by setting the acceleration channel proportionality coefficient, the damping coefficient and the feedforward coefficient as feedback dataaAnd acceleration feedforward virtual force faff
Step 5, control the enabling signal G of the channel based on the position, the speed and the forcep、Gv、Ga、GffMixing and superposing the virtual forces obtained in the steps 2, 3 and 4 to obtain a total virtual force fF
Step 6, mixing fFThe joint torque is converted by a virtual work principle, and an actuator torque control command tau is generated after the friction force and gravity feedforward are compensated, so that the joint impedance of the robot is flexibly controlled;
Figure FDA0003374595180000011
wherein g (q) is a gravity compensation term,
Figure FDA0003374595180000013
is a friction compensation term.
2. The virtual force servo compliance control method of claim 1, wherein the method of determining the enable signals for the acceleration, velocity and position channels in step 1 is as follows:
when the swing track has a position planning result, the position channel enables the flag bit GpIs true;
when the swing track has the speed planning result, the speed channel enables the flag bit GvIs true;
when the tail end is in contact with the ground and supported and has an acceleration planning result, the acceleration channel enables the mark bit GaIs true;
force feed forward when the tip is supported in contact with the groundChannel flag bit GffIs true.
3. The virtual force servo compliance control method of claim 2, wherein said step 2 further comprises:
(1) firstly, constructing a mapping function of forward and inverse kinematics and Jacobian kinematics based on robot joint angle feedback:
Figure FDA0003374595180000021
where x is the position of the end of the robot,
Figure FDA0003374595180000022
is the terminal motion velocity, q is the robot joint angle,
Figure FDA0003374595180000029
is the robot joint angle, FK { } is the positive motion function, J is Jacobian matrix;
(2) x based on the current desired end positiondCalculating the virtual force f generated by the position channel controllerp
Figure FDA0003374595180000023
Wherein Kp,pAs a position channel proportionality coefficient, Kd,pIs the position channel damping coefficient.
4. The virtual force servo compliance control method of claim 3, wherein said step 3 further comprises:
(1) firstly, constructing a mapping function of forward and inverse kinematics and Jacobian kinematics based on angular velocity feedback of a robot joint:
Figure FDA0003374595180000024
wherein
Figure FDA0003374595180000025
Is the acceleration of the robot tip, which is obtained by differentiating the tip velocity,
Figure FDA0003374595180000026
is the robot joint angle, J is the Jacobian matrix;
(2) based on the current desired tip movement velocity
Figure FDA0003374595180000027
Calculating a virtual force f generated by a speed channel controllervAnd velocity feedforward virtual force fvff
Figure FDA0003374595180000028
Wherein Kp,vAs a velocity channel proportionality coefficient, Kd,vAs damping coefficient of velocity channel, Kff,vIs the velocity channel feedforward coefficient.
5. The virtual force servo compliance control method of claim 4, wherein said step 4 further comprises:
(1) firstly, calculating the current terminal supporting force f based on the virtual work principle and the Jacobian matrixest
fest=J-Tτm
Wherein tau ismThe resulting joint true torque is measured.
(2) Based on the current desired tip motion acceleration
Figure FDA0003374595180000031
Calculating the virtual force f generated by the acceleration channel controlleraAnd acceleration feedforward virtual force faff
Figure FDA0003374595180000032
Wherein Kp,aIs the acceleration channel proportionality coefficient, Kd,aAs damping coefficient of acceleration channel, Kff,aIs the feedforward coefficient of the acceleration channel, and m is the robot mass.
6. The virtual force servo compliance control method of claim 5, wherein in said step 5, the total virtual force f is calculated by using the following formulaF:
fF=fpGp+(fv+fvff)Gv+(fa+faff)Ga+FfGff
Wherein FfDesired feedforward force, G, to control system inputpBit flag for channel enable, GvBit flag for channel enable, GaBit flag for channel enable, GffThe force feedforward path is flagged.
CN202111412185.3A 2021-11-25 2021-11-25 Virtual force servo compliant control method Active CN113977585B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111412185.3A CN113977585B (en) 2021-11-25 2021-11-25 Virtual force servo compliant control method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111412185.3A CN113977585B (en) 2021-11-25 2021-11-25 Virtual force servo compliant control method

Publications (2)

Publication Number Publication Date
CN113977585A true CN113977585A (en) 2022-01-28
CN113977585B CN113977585B (en) 2024-03-15

Family

ID=79731786

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111412185.3A Active CN113977585B (en) 2021-11-25 2021-11-25 Virtual force servo compliant control method

Country Status (1)

Country Link
CN (1) CN113977585B (en)

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20130019921A (en) * 2011-08-18 2013-02-27 현대자동차주식회사 Method and system for controlling walk of robot
KR20140085684A (en) * 2012-12-27 2014-07-08 현대자동차주식회사 Method and system for controlling walking of robot
CN108994837A (en) * 2018-08-20 2018-12-14 哈工大机器人(合肥)国际创新研究院 A kind of mechanical arm zero-g balance control method of Dynamics Compensation
CN109048901A (en) * 2018-08-17 2018-12-21 中国科学院自动化研究所 Traction teaching method for planning track and device based on virtual frictional force
CN110083982A (en) * 2019-05-17 2019-08-02 山东大学 More limb legged mobile robot distributed-power modeling methods
CN111546315A (en) * 2020-05-28 2020-08-18 济南大学 Robot flexible teaching and reproducing method based on human-computer cooperation
CN112207825A (en) * 2020-09-28 2021-01-12 杭州云深处科技有限公司 Control method and device for bionic jumping action of quadruped robot, electronic equipment and computer readable medium
CN113070881A (en) * 2021-04-02 2021-07-06 深圳市优必选科技股份有限公司 Robot motion control method and device and robot
CN113319857A (en) * 2021-08-03 2021-08-31 季华实验室 Mechanical arm force and position hybrid control method and device, electronic equipment and storage medium

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20130019921A (en) * 2011-08-18 2013-02-27 현대자동차주식회사 Method and system for controlling walk of robot
KR20140085684A (en) * 2012-12-27 2014-07-08 현대자동차주식회사 Method and system for controlling walking of robot
CN109048901A (en) * 2018-08-17 2018-12-21 中国科学院自动化研究所 Traction teaching method for planning track and device based on virtual frictional force
CN108994837A (en) * 2018-08-20 2018-12-14 哈工大机器人(合肥)国际创新研究院 A kind of mechanical arm zero-g balance control method of Dynamics Compensation
CN110083982A (en) * 2019-05-17 2019-08-02 山东大学 More limb legged mobile robot distributed-power modeling methods
CN111546315A (en) * 2020-05-28 2020-08-18 济南大学 Robot flexible teaching and reproducing method based on human-computer cooperation
CN112207825A (en) * 2020-09-28 2021-01-12 杭州云深处科技有限公司 Control method and device for bionic jumping action of quadruped robot, electronic equipment and computer readable medium
CN113070881A (en) * 2021-04-02 2021-07-06 深圳市优必选科技股份有限公司 Robot motion control method and device and robot
CN113319857A (en) * 2021-08-03 2021-08-31 季华实验室 Mechanical arm force and position hybrid control method and device, electronic equipment and storage medium

Also Published As

Publication number Publication date
CN113977585B (en) 2024-03-15

Similar Documents

Publication Publication Date Title
CN111152225B (en) Uncertain mechanical arm fixed time trajectory tracking control method with input saturation
CN108319144B (en) Robot trajectory tracking control method and system
CN112518753B (en) Industrial robot trajectory tracking system and method based on neural network iterative compensation
CN108527372B (en) Robot joint self-adaptive control method of variable-rigidity series elastic driver
CN101402199B (en) Hand-eye type robot movable target extracting method with low servo accuracy based on visual sensation
CN109445274B (en) Flexible space manipulator vibration control method and system
CN111687827B (en) Control method and control system for coordinating and operating weak rigid member by two robots
TWI733738B (en) Proportional integral derivative control method and system incorporating multiple actuators
CN105404150A (en) Flexible mechanical arm vibration active control method adopting piezoelectric ceramic sheet during soft measurement
CN114800522B (en) Hydraulic mechanical arm contact operation self-adaptive impedance control system without end force sensor
CN109623812B (en) Mechanical arm trajectory planning method considering spacecraft body attitude motion
CN113110027B (en) Anti-interference control method for position switching of rail-type bucket-wheel reclaimer
CN109782759A (en) A kind of Approximate Decoupling of wheeled mobile robot, quick Trajectory Tracking Control method
CN113419431B (en) Stratospheric airship trajectory tracking control method and system based on event triggering
CN108983595B (en) Automatic setting method for parameters of feedforward controller
CN113977585B (en) Virtual force servo compliant control method
CN101299148A (en) Three-axis accurate angular motion control method
CN117840994A (en) Self-adaptive sliding mode track tracking method for master-slave industrial mechanical arm system
CN110647161B (en) Under-actuated UUV horizontal plane trajectory tracking control method based on state prediction compensation
CN112847373A (en) Robot track synchronous control method and computer readable storage medium
CN116810792A (en) Fuse and booster double-robot assembly flexible control method based on neural network
CN117400237A (en) Track tracking and force compliance control method for rocket solid fuel shaping robot
CN112873208B (en) Anti-noise and dynamics constraint robot real-time motion planning method and device
CN114895556B (en) Wheeled robot track tracking control method and computer readable medium
CN113219841B (en) Nonlinear control method for underwater multi-joint hydraulic mechanical arm based on adaptive robustness

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