Control system for contact force of manipulator, manipulator and robot

The control system for robotic arms, using an I-PD force controller and admittance controller with a disturbance observer, addresses dynamic response and stability issues by compensating for environmental uncertainties, thereby improving interference suppression.

CN115556088BActive Publication Date: 2024-12-06AUBO (BEIJING) ROBOTICS TECH CO LTD
View PDF 0 Cites 1 Cited by

Patent Information

Application Number
CN202211037524.9
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-08-26
Publication Date
2024-12-06
Estimated Expiration
2042-08-26

AI Technical Summary

Technical Problem

Existing contact force control methods for robot manipulators suffer from poor dynamic response performance and stability due to limitations in adaptive convergence speed and accuracy, as well as inadequate consideration of robot tracking errors and environmental stiffness changes.

Method used

A control system for robotic arms utilizing an I-PD force controller and admittance controller, integrated with a disturbance observer, to enhance dynamic response and interference suppression by matching their designs and compensating for environmental uncertainties.

Benefits of technology

Improves dynamic response performance and stability of contact force control while enhancing interference suppression capabilities in interactive systems.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115556088B_ABST
    Figure CN115556088B_ABST
Patent Text Reader

Abstract

The present invention provides a control system for the contact force of a mechanical arm, a mechanical arm and a robot, wherein the control system comprises: an I-PD force controller; an admittance controller, wherein the admittance controller is used to control the contact force of a mechanical arm according to an output signal F of the I-PD force controller; r Output the posture deviation E of the robot arm, and the I‑PD force controller and admittance controller are matched and designed; the interactive system is used to match the reference posture X r Output the actual position X of the robot arm, and when the robot arm contacts the environment, according to the environmental stiffness K e , the actual position X of the robot arm and the environment position X e Output the actual contact force F of the robot arm c , contact force F c The present invention uses an I-PD force controller based on the admittance control architecture, and improves the interference suppression capability of the interactive system while ensuring the dynamic response performance of the contact force through the matching design of the force controller and the admittance controller.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of data processing, and in particular to a control system of contact force of a robotic arm, a robotic arm and a robot. Background Art

[0002] At present, the commonly used solutions for force control technology of robot manipulators are: first, contact force control is achieved through adaptive correction of the robot's desired motion trajectory; second, contact force control is achieved through an admittance controller combined with an outer-loop force control loop in the form of a proportional-integral-differential (PID) circuit.

[0003] Due to the limitations of adaptive convergence speed and convergence accuracy, the dynamic response performance of the contact force control method of the desired trajectory of the adaptive robot is poor. The PID-type force controller and admittance controller were not designed to consider the impact of robot tracking error and environmental stiffness and dynamic position changes, resulting in the actual contact force response performance being difficult to meet expectations and poor system stability.

[0004] Therefore, how to improve the dynamic response performance and stability of the contact force control of the robot arm has become a technical problem that needs to be urgently solved by technical personnel in this field. Summary of the invention

[0005] In order to solve the above technical problems, the present invention provides a control system for the contact force of a robotic arm. The control system, based on the admittance control architecture, adopts an I-PD (Integration-Proportion Differentiation) force controller. Through the matching design of the force controller and the admittance controller, the dynamic response performance of the contact force is ensured while the interference suppression capability of the interactive system is improved.

[0006] The invention also provides a mechanical arm.

[0007] The invention also provides a robot.

[0008] The technical solution adopted by the present invention is as follows:

[0009] The first aspect of the present invention provides a control system for the contact force of a robot arm, comprising: an I-PD force controller, wherein the I-PD force controller is used to control the contact force F of the robot arm according to the desired contact force F of the robot arm. d and the actual contact force F c Generate output signal F r ; an admittance controller, wherein the I-PD force controller and the admittance controller are matched and designed, wherein the input end of the admittance controller is connected to the output end of the I-PD force controller, and the admittance controller is used to adjust the output signal F according to the output signal F rOutput the posture deviation E of the robot arm; an adder, wherein the first input end of the adder is connected to the output end of the admittance controller, and the adder is used to output the reference posture X of the robot arm according to the posture deviation E of the robot arm r An interactive system, wherein the input end of the interactive system is connected to the output end of the adder, and the interactive system is used to generate an interactive image according to the reference posture X. r Output the actual posture X of the robot arm, and detect the actual contact force F when the robot arm contacts the environment based on the actual posture X of the robot arm c , the actual contact force F c Feedback is fed into the input of the I-PD force controller.

[0010] The control system of the contact force of the robot arm proposed in the present invention also has the following additional technical features:

[0011] According to one embodiment of the present invention, the force controller and the admittance controller are matched and designed using the following formula:

[0012] in, ωn and ξ denote the resonant frequency and damping ratio of the second-order system, respectively. Tc represents the time constant of the first-order system, M, D, and K represent the mass / inertia, damping, and stiffness matrices of the desired second-order system of the admittance controller, respectively, and K i ,K p ,K d are the integral, proportional and differential coefficients of the I-PD force controller, K e represents the environmental stiffness, ωa represents the first matching coefficient, ξa Represents the second matching coefficient.

[0013] According to one embodiment of the present invention, the desired contact force tracking transfer function T(s) and the disturbance suppression transfer function S(s) of the control system are obtained by the following formula: Wherein, T(s) is the desired contact force tracking transfer function, S(s) is the disturbance suppression transfer function, s is the Laplace operator, ω n and ξ represent the resonant frequency and damping ratio of the second-order system, respectively. c represents the time constant of the first-order system, ω a represents the first matching coefficient, ξ a Represents the second matching coefficient.

[0014] According to one embodiment of the present invention, the adder outputs the reference pose X according to the following formula: r :X r =Xd,n +δX d -E; where X r is the reference pose, δX d is the desired posture correction, X d,n is the nominal expected posture, and E is the posture deviation.

[0015] According to one embodiment of the present invention, the interactive system is used to r Output the actual position X of the robot arm, and detect the actual contact force F generated based on the actual position X of the robot arm when the robot arm contacts the environment c , including: when the robot arm contacts the environment, the interactive system e , the actual position X of the robot arm and the environment position X e Output the actual contact force F of the robot arm c .

[0016] According to one embodiment of the present invention, the actual contact force F of the robot arm is output according to the following formula: c :F c =K e (XX e ), where F c is the actual contact force, K e is the environmental stiffness, X is the actual pose, X e For the environmental location.

[0017] According to one embodiment of the present invention, the control system of the contact force of the manipulator further includes: a disturbance observer (DOB), wherein a first input end of the disturbance observer is connected to an output end of the adder, and a second input end of the disturbance observer inputs the actual contact force F c , the disturbance observer is used to calculate the actual contact force F c and the reference pose X r The calculated desired posture correction δX d , and the desired posture correction δX d The third input terminal of the adder is input so that the adder can calculate the expected posture X according to the posture deviation E and the nominal expected posture X. d,n and the desired posture correction δX d Output reference pose X r .

[0018] According to one embodiment of the present invention, the filter of the disturbance observer is selected using the following formula: Among them, Q(s) is the filter, s is the Laplace operator, and a1, a2, a3 and b2 are the first to fourth coefficients.

[0019] According to one embodiment of the present invention, the first to fourth coefficients a1, a2, a3 and b2 are based on the actual model P(s) and the nominal model P(s) of the interactive system. n (s) Deviation setting.

[0020] A second aspect of the present invention provides a robot arm, including the robot arm contact force control system described in the first aspect of the present invention.

[0021] A third aspect of the present invention provides a robot, comprising the robotic arm described in the second aspect of the present invention.

[0022] Beneficial effects of the present invention:

[0023] Based on the admittance control architecture, the present invention refers to a disturbance observer and an I-PD force controller, adds a disturbance observer to the inner loop of the admittance controller to compensate for the influence of uncertain disturbances such as interactive environment changes and position tracking errors, and introduces an I-PD force controller to the outer loop of the admittance controller. Through the matching design of the force controller and the admittance controller, the interference suppression capability of the interactive system is improved while ensuring the dynamic response performance of the contact force. BRIEF DESCRIPTION OF THE DRAWINGS

[0024] Figure 1 is a block diagram of a control system for a contact force of a robot arm according to an embodiment of the present invention;

[0025] Figure 2 is a block diagram of a control system for contact force of a robot arm according to another embodiment of the present invention;

[0026] Figure 3 is a block diagram of the working principle of an interference observer according to an embodiment of the present invention;

[0027] Figure 4 yes Figure 3 Equivalent block diagram of . DETAILED DESCRIPTION

[0028] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0029] Figure 1 is a block diagram of a control system of a robot contact force according to an embodiment of the present invention, such as Figure 1As shown, the control system includes: an I-PD force controller 1, an admittance controller 2, an adder 3 and an interactive system 4.

[0030] Among them, the input signal of I-PD force controller 1 is the desired contact force F of the robot arm d and the actual contact force F c The I-PD force controller is used to determine the desired contact force F of the robot arm. d and the actual contact force F c Generate output signal F r The input end of the admittance controller 2 is connected to the output end of the I-PD force controller 1, and the admittance controller 2 is used according to the output signal F of the I-PD force controller r Output the posture deviation E of the manipulator, the I-PD force controller and the admittance controller are matched and designed; the first input end of the adder 3 is connected to the output end of the admittance controller 2, and the second input end of the adder 3 inputs the nominal desired posture X of the manipulator d,n , adder 3 is used to calculate the desired position X of the robot arm according to its nominal position d,n The deviation of the robot arm’s posture E is the output of the robot arm’s reference posture X r The input end of the interactive system 4 is connected to the output end of the adder 3, and the interactive system 4 is used according to the reference posture X r Output the actual position X of the robot arm, and when the robot arm contacts the environment, output the actual contact force F of the robot arm based on the actual position X of the robot arm c , contact force F c The input of the interactive system 4 is fed back.

[0031] Specifically, Figure 1 In the control system shown in the figure, X r =X d,n -E. A force controller is added to the outer loop of the admittance controller 2. Through the matching design of the I-PD force controller 1 and the admittance controller 2, the interference suppression capability of the interactive system is improved while ensuring the dynamic response of the contact force.

[0032] It is understandable that if Figure 1 As shown, the interactive system 4 of the embodiment of the present invention is composed of a motion control system and an adder. The motion control system can realize closed-loop control of the motion of the robot arm.

[0033] According to one embodiment of the present invention, Figure 2 As shown, the control system of the contact force of the above-mentioned robot arm may also include: a disturbance observer 5 (DOB, Disturbance Observer), the first input end of the disturbance observer 5 is connected to the output end of the adder 3, and the second input end of the disturbance observer 5 inputs the actual contact force F cThe disturbance observer 5 is used to calculate the actual contact force F c and the reference pose X r The calculated desired posture correction δX d , and the desired posture correction δX d The third input terminal of the adder 3 is input so that the adder 3 can calculate the expected posture X according to the posture deviation E and the nominal expected posture X. d,n and the desired posture correction δX d Output reference pose X r .

[0034] Specifically, Figure 2 As shown, a disturbance observer DOB is introduced into the inner loop of the admittance controller 2 to compensate for the influence of uncertain disturbance factors such as the robot arm posture tracking error and environmental changes.

[0035] The working principle of the control system of the present invention is described below in conjunction with specific embodiments.

[0036] The I-PD force controller 1 uses the integral of the force deviation signal and the proportional and differential of the desired contact force signal to form the following control ratio:

[0037]

[0038] Where K i ,K p ,K d are the integral, proportional and differential coefficients of the I-PD controller respectively.

[0039] After adding the force outer loop in the admittance controller 2, the output F of the I-PD force controller 1 of the outer loop r This is the input of the admittance controller 2. The goal of the admittance controller 2 is to make the robot exhibit the desired response characteristics. Usually the desired dynamic response characteristics are the response of the second-order mass-damper-spring system, so the admittance controller is as follows:

[0040]

[0041] Where M, D, K represent the mass / inertia, damping and stiffness matrices of the desired second-order system of the admittance controller, and E represents the desired position X of the manipulator. d and the reference pose X r Deviation, that is, E = X d -X r .

[0042] like Figure 2 As shown in the figure, the desired posture of the robot arm consists of two parts: one is the nominal desired posture X d,n , and the second is the desired posture correction δX calculated by the disturbance observer DOB d , that is, Xd =X d,n +δX d , then the adder can output the reference pose X according to the following formula r :

[0043] X r =X d,n +δX d -E (3);

[0044] Among them, X r is the reference pose, δX d is the desired posture correction, X d,n is the nominal desired pose, and E is the pose deviation.

[0045] In order to simplify the controller design, the reference pose X is used. r The deviation δX between the actual posture X represents the uncertainty of the posture tracking response. The posture tracking response of the motion control system in the interactive system 4 is as follows:

[0046] X=X r -δX (4).

[0047] At the same time, the environment is simplified to a pure stiffness system, and K e and X e Represent the environment stiffness and environment position respectively. When the robot arm contacts the environment, according to the environment stiffness K e , the actual position X of the robot arm and the environment position X e Output the actual contact force F of the robot arm c The interactive system can output the actual contact force F of the robot arm according to the following formula c :

[0048] F c =K e (XX e ) (5);

[0049] Among them, F c is the actual contact force, K e is the environmental stiffness, X is the actual pose, X e For the environmental location.

[0050] The working principle of the disturbance observer 5 proposed by the present invention is described below with reference to specific embodiments.

[0051] Figure 3 FIG. 1 is a block diagram showing the working principle of an interference observer according to an embodiment of the present invention. Figure 3 As shown, K e,n and X e,n represents the nominal value of the ambient stiffness and ambient position, G x(s) and G x,n (s) represents the actual transfer function and the nominal transfer function of the manipulator position closed-loop system, and Q(s) represents the low-pass filter of the disturbance observer 5. According to the nominal value of the environment position and the nominal transfer function of the position closed-loop system, the nominal desired position of the manipulator is given

[0052] In order to facilitate the design and performance analysis of the disturbance observer 5, Figure 3 The principle block diagram shown is equivalent to the standard disturbance observer block diagram shown in Figure 4. Figure 4 middle It represents the equivalent posture disturbance of the interactive system caused by the change of environment position and posture tracking error.

[0053] use and They represent the actual transfer function model and the nominal model of the interactive system 4 respectively. Let E(s) represent the Laplace transform of E, express The Laplace transform of the actual contact force F c The Laplace transform F c (s) shall be in the following form:

[0054]

[0055] in,

[0056] In order to simplify the expression, the transfer functions Q(s), P(s) and P are omitted in the above formula. n The Laplacian operator s in (s).

[0057] The key to the design of disturbance observer is the selection of filter Q(s). In order to ensure the stability of the system, it is necessary to select the actual model P(s) of the interactive system and the nominal model P(s). n The speed closed-loop response curves of the robot in all directions in the Cartesian space are measured, and the measured speed closed-loop response curves are fitted using the transfer function to obtain the nominal model G of the speed closed-loop response. v,n (s). Therefore, according to The nominal model of the interactive system can be obtained. The causal relationship can be realized. In one embodiment of the present invention, the filter Q(s) of the interference observer is selected using the following formula:

[0058]

[0059] Where Q(s) is a filter, s is a Laplace operator, and a1, a2, a3, and b2 are the first to fourth coefficients. In practice, the first to fourth coefficients a1, a2, a3, and b2 are calculated based on the actual model P(s) and the nominal model P of the interactive system. n (s) Deviation setting.

[0060] According to the above formula When Q = 1, F c (s)=-K e,n G x,n E(s); when Q=0, Therefore, through the correction of the desired trajectory of the robot arm by the disturbance observer 5, the influence of the posture tracking of the robot arm and the change of the environmental position and stiffness on the contact force of the interactive system is compensated.

[0061] In order to ensure the dynamic response of the contact force while improving the interference suppression capability of the interactive system, the present invention also requires matching design of the force controller 1 and the admittance controller 2 and parameter adjustment of the controllers. The following describes how to perform matching design and parameter adjustment in conjunction with specific embodiments.

[0062] In order to simplify the system performance analysis and controller parameter setting, the interactive system dynamic response based on the desired trajectory correction is simplified when designing the I-PD force controller 1 and the admittance controller 2, and the transfer function is used to analyze the dynamic response characteristics of the contact force. represents the lumped equivalent of the force interference of the interactive system 4 after the desired trajectory correction, that is, the interference force. Then, the dynamic response equation of the interactive system 4 based on the desired trajectory correction can be simplified as:

[0063]

[0064] Combining the above formulas (1), (2) and (8), we get:

[0065]

[0066] Among them, F d (s), Denote the expected contact force F d and aggregate interference The Laplace transform function of .

[0067] definition represents the desired contact force tracking transfer function, represents the disturbance force suppression transfer function. T(s) and S(s) are in the following form:

[0068]

[0069]

[0070] The control system targets the contact force F c Track the expected contact force F as closely as possible d , while suppressing interference forces The impact on the contact force response, that is, T(s) is as close to 1 as possible, and S(s) is as close to 0 as possible. The present invention adopts the zero-pole configuration method to design the transfer functions T(s) and S(s).

[0071] Firstly, by establishing the constraint relationship between the admittance controller parameters and the I-PD force controller parameters as shown in Equation (11), the desired contact force tracking transfer function T(s) of the system is decomposed into a second-order system and a first-order system in series as shown in Equation (12).

[0072]

[0073]

[0074] Among them, ω n and ξ represent the resonant frequency and damping ratio of the second-order system, respectively. c represents the time constant of the first-order system. Therefore, through ω n , ξ and T c The contact force tracking bandwidth can be changed by adjusting . At the same time, the interference suppression transfer function S(s) can be simplified as:

[0075]

[0076] It should be noted that when the outer loop controller is in the traditional contact force error PID (proportional-integral-differential) form, the interference suppression transfer function and the desired contact force tracking transfer function always satisfy the constraint relationship S(s)+T(s)=1. Therefore, when the tracking capability of the desired contact force is determined, the interference force suppression capability is fixed.

[0077] According to formula (13), the I-PD force controller proposed in this invention has obvious advantages over PID. Specifically, when ω is given n , ξ and T c When T(s) is determined, it is still possible to use the controller parameter K i ,K p ,K d Reasonable configuration, change S(s), improve the interference suppression ability. Let the I-PD controller parameter K i ,K p ,K d Satisfying the constraint relationship of formula (14), the interference suppression transfer function S(s) is simplified to the form shown in formula (15).

[0078]

[0079]

[0080] By referring to a ,ξ a} number and {ω n ,ξ,T} matching design adjusts the interference suppression ability of the system,ω a represents the first matching coefficient, ξ a Represents the second matching coefficient.

[0081] In summary, in one embodiment of the present invention, Figure 1 and Figure 2 For a control system, the force controller and admittance controller can be matched and designed using the following formula:

[0082]

[0083]

[0084] Among them, ω n and ξ represent the resonant frequency and damping ratio of the second-order system, respectively. c represents the time constant of the first-order system, M, D, and K represent the mass / inertia, damping, and stiffness matrices of the desired second-order system of the admittance controller, respectively, and K i ,K p ,K d are the integral, proportional and differential coefficients of the I-PD force controller, K e represents the environmental stiffness, ω a represents the first matching coefficient, ξ a Represents the second matching coefficient.

[0085] The desired contact force tracking transfer function T(s) and disturbance rejection transfer function S(s) of the control system are obtained by the following formula:

[0086]

[0087]

[0088] Where T(s) is the desired contact force tracking transfer function, S(s) is the disturbance rejection transfer function, s is the Laplace operator, ω n and ξ represent the resonant frequency and damping ratio of the second-order system, respectively. c represents the time constant of the first-order system, ω a represents the first matching coefficient, ξ a Represents the second matching coefficient.

[0089] From the above, it can be seen that the present invention analyzes the contact force control performance of the interactive system based on the transfer function, and can establish the relationship between the I-PD force controller, admittance controller parameters and the interactive system force tracking performance and interference force suppression capability, forming a set of controller design and parameter setting methods.

[0090] In summary, the control system of the contact force of the robotic arm according to the embodiment of the present invention, based on the admittance control architecture, refers to the disturbance observer and the I-PD force controller, adds the disturbance observer to the inner loop of the admittance controller to compensate for the influence of uncertain interferences such as changes in the interactive environment and position tracking errors, and introduces the I-PD force controller to the outer loop of the admittance controller. Through the matching design of the force controller and the admittance controller, the interference suppression capability of the interactive system is improved while ensuring the dynamic response performance of the contact force. In addition, the contact force control performance of the interactive system is analyzed based on the transfer function, and the relationship between the I-PD force controller, the admittance controller parameters and the force tracking performance and interference force suppression capability of the interactive system can be established, thereby forming a set of controller design and parameter setting solutions.

[0091] In addition, an embodiment of the present invention further provides a robot arm, including the above-mentioned robot arm contact force control system of the present invention.

[0092] According to the robotic arm of an embodiment of the present invention, through the control system of the contact force of the robotic arm, on the basis of the admittance control architecture, an interference observer and an I-PD force controller are referenced, an interference observer is added to the inner loop of the admittance controller to compensate for the influence of uncertain interferences such as changes in the interactive environment and position tracking errors, and an I-PD force controller is introduced in the outer loop of the admittance controller. Through the matching design of the force controller and the admittance controller, the interference suppression capability of the interactive system is improved while ensuring the dynamic response performance of the contact force.

[0093] An embodiment of the present invention further provides a robot, comprising the above-mentioned mechanical arm of the present invention.

[0094] According to the robot of the embodiment of the present invention, through the above-mentioned robotic arm, on the basis of the admittance control architecture, an interference observer and an I-PD force controller are referenced, an interference observer is added to the inner loop of the admittance controller to compensate for the influence of uncertain interferences such as changes in the interactive environment and position tracking errors, and an I-PD force controller is introduced in the outer loop of the admittance controller. Through the matching design of the force controller and the admittance controller, the interference suppression capability of the interactive system is improved while ensuring the dynamic response performance of the contact force.

[0095] In the description of the present invention, the terms "first" and "second" are used for descriptive purposes only and should not be understood as indicating or implying relative importance or implicitly indicating the number of the indicated technical features. Thus, a feature defined as "first" or "second" may explicitly or implicitly include one or more of the features. "Multiple" means two or more, unless otherwise explicitly and specifically defined.

[0096] In the description of this specification, the description with reference to the terms "one embodiment", "some embodiments", "example", "specific example", or "some examples" etc. means that the specific features, structures, materials or characteristics described in conjunction with the embodiment or example are included in at least one embodiment or example of the present invention. In this specification, the schematic representations of the above terms do not necessarily refer to the same embodiment or example. Moreover, the specific features, structures, materials or characteristics described may be combined in any one or more embodiments or examples in a suitable manner. In addition, those skilled in the art may combine and combine the different embodiments or examples described in this specification and the features of the different embodiments or examples, unless they are contradictory.

[0097] Although embodiments of the present invention have been shown and described, it will be appreciated by those skilled in the art that various changes, modifications, substitutions and variations may be made to the embodiments without departing from the principles and spirit of the present invention, and that the scope of the present invention is defined by the appended claims and their equivalents.

Claims

1. A control system for contact force of a robot arm, characterized in that: include: I-PD force controller, the I-PD force controller is used to determine the desired contact force F of the robot arm. d and the actual contact force F c Generate output signal F r ; The admittance controller is used to match the I-PD force controller and the admittance controller, wherein the input end of the admittance controller is connected to the output end of the I-PD force controller, and the admittance controller is used to adjust the output signal F according to the output signal F. r Output the posture deviation E of the robot arm; an adder, wherein a first input end of the adder is connected to an output end of the admittance controller, and the adder is used to output a reference posture X of the manipulator according to the posture deviation E of the manipulator r ; An interactive system, wherein the input end of the interactive system is connected to the output end of the adder, and the interactive system is used to generate an interactive image according to the reference posture X. r Output the actual posture X of the robot arm, and detect the actual contact force F when the robot arm contacts the environment based on the actual posture X of the robot arm c , the actual contact force F c Inputting the feedback to the input terminal of the I-PD force controller; The force controller and the admittance controller are matched and designed using the following formula: Among them, ω n and ξ represent the resonant frequency and damping ratio of the second-order system, respectively. c represents the time constant of the first-order system, M, D, and K represent the mass / inertia, damping, and stiffness matrices of the desired second-order system of the admittance controller, respectively, and K i ,K p ,K d are the integral, proportional and differential coefficients of the I-PD force controller, K e represents the environmental stiffness, ω a represents the first matching coefficient, ξ a represents the second matching coefficient; the desired contact force tracking transfer function T(s) and the disturbance suppression transfer function S(s) of the control system are obtained by the following formula: Wherein, T(s) is the desired contact force tracking transfer function, S(s) is the disturbance suppression transfer function, s is the Laplace operator, ω n and ξ represent the resonant frequency and damping ratio of the second-order system, respectively. c represents the time constant of the first-order system, ω a represents the first matching coefficient, ξ a Represents the second matching coefficient.

2. The control system of the contact force of the robot arm according to claim 1, characterized in that: The adder outputs the reference pose X according to the following formula r : X r =X d,n +δX d -E; Among them, X r is the reference pose, δX d is the desired posture correction, X d,n is the nominal desired posture, and E is the posture deviation.

3. The control system of the contact force of the robot arm according to claim 1, characterized in that: The interactive system is used to determine the reference posture X r Output the actual position X of the robot arm, and detect the actual contact force F generated based on the actual position X of the robot arm when the robot arm contacts the environment c , including: when the robot arm contacts the environment, the interactive system e , the actual position X of the robot arm and the environment position X e Output the actual contact force F of the robot arm c .

4. The control system of the contact force of the robot arm according to claim 3, characterized in that: The actual contact force F of the robot arm is output according to the following formula c : F c =K e (X-X e ); Among them, F c is the actual contact force, K e is the environmental stiffness, X is the actual pose, X e For the environmental location.

5. The control system of the contact force of the robot arm according to claim 2, characterized in that: Also includes: A disturbance observer, wherein a first input terminal of the disturbance observer is connected to an output terminal of the adder, and a second input terminal of the disturbance observer inputs the actual contact force F c , the disturbance observer is used to calculate the actual contact force F c and the reference pose X r The calculated desired posture correction δX d , and the desired posture correction δX d The third input terminal of the adder is input so that the adder can calculate the expected posture X according to the posture deviation E and the nominal expected posture X. d,n and the desired posture correction δX d Output reference pose X r .

6. The control system of the contact force of the robot arm according to claim 5, characterized in that: The filter of the disturbance observer is selected using the following formula: Among them, Q(s) is the filter, s is the Laplace operator, and a1, a2, a3 and b2 are the first to fourth coefficients.

7. The control system of the contact force of the robot arm according to claim 6, characterized in that: The first to fourth coefficients a1, a2, a3 and b2 are based on the actual model P(s) and the nominal model P of the interactive system. n (s) Deviation setting.

8. A robotic arm, characterized in that: A control system comprising the contact force of a robot arm according to any one of claims 1-7.

Citation Information

Cited By

  • Robot variable admittance compliant teleoperation control method based on human intention recognition

    CN120578058A