An adaptive finite-time variable force tracking control method for a robotic arm

Through the adaptive finite time force tracking control method, the rigidity of unknown environment is estimated and a finite time control strategy is designed, which solves the problem of large errors in time-varying expected force tracking of traditional impedance control and realizes high-precision force tracking of robotic arms to unknown environments , suitable for tasks with high precision requirements.

CN118456419BActive Publication Date: 2024-11-05HARBIN INSTITUTE OF TECHNOLOGY (SHENZHEN) (INSTITUTE OF SCIENCE AND TECHNOLOGY INNOVATION HARBIN INSTITUTE OF TECHNOLOGY SHENZHEN)
View PDF 7 Cites 0 Cited by

Patent Information

Application Number
CN202410506968.5
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-04-25
Publication Date
2024-11-05
Estimated Expiration
2044-04-25

AI Technical Summary

Technical Problem

Traditional impedance control methods require accurate environmental prior information and have large errors in time-varying expected force tracking, making it difficult to effectively realize high-precision force tracking control of unknown environments in practical applications.

Method used

A method of adaptive finite time variable force tracking for robotic arm is designed to estimate unknown environment stiffness through adaptive law, and a finite time control strategy is used to achieve high-precision tracking of time-varying desired forces, combining the Liyapunov function and stability Theoretically, the finite time convergence of tracking error and estimation error is demonstrated.

Benefits of technology

It realizes high-precision force tracking for unknown environments, especially high-precision tracking of time-varying desired forces, and is suitable for variable force tracking tasks with high precision requirements, providing reliable technical support for high-precision force tracking of robotic arm.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118456419B_ABST
    Figure CN118456419B_ABST
Patent Text Reader

Abstract

A method for adaptive finite-time variable force tracking control of a manipulator relates to the technical field of manipulator control. Based on the interaction model between the end effector of the manipulator and the environment, the dynamic equation of the force tracking error is obtained. Then, based on the position-based force tracking control idea, an adaptive control algorithm is designed on the basis of the dynamic equation to estimate the unknown environmental parameters. At the same time, a control law is also designed to make the force tracking error converge. Finally, the finite-time convergence is proved by the Lyapunov finite-time stability theory. According to the position-based force tracking control idea, the design framework of the traditional impedance control is broken out. The control law is designed starting from the dynamic equation of the force tracking error. By designing the adaptive law, the estimation of the unknown environmental stiffness is realized. On this basis, by designing the finite-time control law, the high-precision tracking of the time-varying expected force is realized.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the technical field of mechanical arm control, and in particular to an adaptive finite-time variable force tracking control method for a mechanical arm. Background Art

[0002] With the continuous development of science and technology, robotic arms can be used in a variety of fields to complete various complex tasks, such as grinding, polishing, cutting, etc., and effective control of the interaction force between the end effector of the robotic arm and the environment is the basis for completing the task.

[0003] The problem of controlling the interaction force between the end effector and the environment is essentially a problem of force tracking control. For the problem of force tracking control, the most classic method is position-based impedance control. The force controller of this control method can calculate the reference position of the end effector of the robot arm according to the force tracking error signal. The robot arm then tracks the reference position through the position loop, thereby achieving tracking control of the interaction force. Traditional impedance control requires accurate prior information about the environment, but in practical applications, this prior information is difficult to obtain in advance, which causes traditional impedance control to have large errors in some cases. On the other hand, due to the limitations of the controller form, traditional impedance control has a large tracking error for time-varying desired forces.

[0004] In order to overcome the limitations of traditional impedance control, researchers in the field have been working to seek innovative force tracking control solutions to address the above-mentioned drawbacks of impedance control. Summary of the invention

[0005] In order to overcome the limitations of traditional impedance control, the present invention provides an adaptive finite-time variable force tracking control method for a robotic arm, which breaks away from the design framework of traditional impedance control and designs the control law starting from the dynamic equation of the force tracking error. By designing the adaptive law, the estimation of the unknown environmental stiffness is realized. On this basis, by designing the finite-time control law, the time-varying expected force is tracked with high precision.

[0006] To achieve the above object, the present invention adopts the following technical solution: a method for adaptive finite-time variable force tracking control of a robot arm, comprising the following steps:

[0007] Step 1: Model the interaction model between the end effector of the robot and the environment to obtain the force tracking control system block diagram

[0008] 1.1. Assuming that the contact force generated by the environment is related to the distance that the end effector penetrates into the environment, we have:

[0009]

[0010] In the formula, Fe is the contact force between the end effector and the environment, k e is the environmental stiffness, X is the position of the end effector, and X e for environmental location;

[0011] The force tracking control system block diagram is obtained by using the position-based force tracking control method. The control idea is: the outer loop force controller is based on the expected force F d and its derivative with respect to time And the feedback contact force information F e , calculate the target reference position X of the end effector in real time c , the inner loop position controller controls the manipulator system to track the target reference position X c , and then realize the expected force F d Tracking;

[0012] 1.2. After the end effector contacts the environment, the position controller of the inner loop is assumed to be able to reach X c =X, then the expression of contact force is as follows:

[0013]

[0014] Step 2: Design force tracking control law and adaptive law according to the control block diagram

[0015] 2.1. After the end effector contacts the environment, let the force tracking error be ΔF, then:

[0016] ΔF=F d -F e =F d -k e (X c -X e )

[0017] set up The dynamic equation of the force tracking error is as follows:

[0018]

[0019] 2.2. Introducing adaptive control method to estimate environmental stiffness k e , using a finite time control strategy, for k e The inverse of is estimated, let k e The reciprocal of is B e , then the dynamic equation of the force tracking error becomes:

[0020]

[0021] 2.21. Design the Lyapunov function V1 as follows:

[0022]

[0023] Let the Lyapunov function V1 take the first-order derivative with respect to time:

[0024]

[0025] Then the control law is designed as follows:

[0026]

[0027] In the formula, For B e The estimated value of k1>0, k2>0, 0<β<1 is a designable constant, sig β (ΔF)=|ΔF β ·sign(ΔF);

[0028] Substituting the control law into

[0029]

[0030] In the formula, is the estimated error of the inverse of the ambient stiffness;

[0031] 2.22. Design the Lyapunov function V2 as follows:

[0032]

[0033] In the formula, Γ>0 is a designable constant;

[0034] Let the Lyapunov function V2 take the first-order derivative with respect to time:

[0035]

[0036] Then the adaptive law is designed as follows:

[0037]

[0038] In the formula, k a >0 is a designable constant;

[0039] Step 3: Based on Lyapunov stability theory, prove the finite time convergence of tracking error and estimation error

[0040] Substituting the adaptive law into

[0041]

[0042] In the formula,

[0043] ΔF and The time T required to converge to the residual set Ω will have an upper bound T max :

[0044]

[0045] The residual set Ω is expressed as follows:

[0046]

[0047] In the formula, 0<v<1.

[0048] Compared with the prior art, the beneficial effects of the present invention are as follows: the present invention introduces adaptive control and finite-time stability theory into the force tracking control problem of the robotic arm, and realizes the estimation of the unknown environmental stiffness by designing the adaptive law. On this basis, by designing the finite-time control law, it is realized that for any expected force (including constant force and time-varying force), the force tracking error converges to a smaller value within a finite time, thereby realizing high-precision tracking of the time-varying expected force. The present invention is suitable for variable force tracking tasks with high requirements for control accuracy, and provides reliable technical support for the successful execution of high-precision force tracking tasks of the robotic arm. BRIEF DESCRIPTION OF THE DRAWINGS

[0049] Figure 1 is a block diagram of a force tracking control system in the control method of the present invention;

[0050] Figure 2 is a simplified control block diagram of the outer loop in the control method of the present invention;

[0051] Figure 3 is a schematic diagram of a two-degree-of-freedom robotic arm system in an embodiment;

[0052] Figure 4 is a schematic diagram of a force tracking control process of a two-degree-of-freedom robotic arm system in an embodiment;

[0053] Figure 5 : are the contact force variation curves of the three algorithms in the embodiment when the expected force is a sinusoidal signal;

[0054] Figure 6 : are the contact force error variation curves of the three algorithms in the embodiment when the expected force is a sinusoidal signal;

[0055] Figure 7 In the embodiment, the algorithm of the present invention is used for the expected force to be a sinusoidal signal. The change curve of

[0056] Figure 8 are contact force variation curves of the three algorithms in the embodiment when the expected force is a ramp signal;

[0057] Fig. 9 are contact force error variation curves of the three algorithms in the embodiment when the expected force is a ramp signal;

[0058] Fig.10 In the embodiment, the algorithm of the present invention is used when the desired force is a ramp signal. The change curve of

[0059] Fig.11 are contact force variation curves when the expected forces of the three algorithms in the embodiment suddenly change;

[0060] Fig.12 1 is the contact force variation curve when the environmental stiffness of the three algorithms in the embodiment suddenly changes;

[0061] Fig.13 1 is the contact force variation curve when the environmental positions of the three algorithms in the embodiment suddenly change. DETAILED DESCRIPTION

[0062] The technical solution of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the invention, rather than all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without making creative work are within the scope of protection of the present invention.

[0063] like Figure 1-2 As shown, a method for adaptive finite-time variable force tracking control of a robotic arm comprises the following steps:

[0064] Step 1: Model the interaction model between the end effector of the robot and the environment to obtain the force tracking control system block diagram

[0065] 1.1. In general, assuming that the contact force generated by the environment is similar to the spring model, that is, the contact force generated by the environment is related to the distance that the end effector penetrates into the environment, then:

[0066]

[0067] In the formula, F e is the contact force between the end effector and the environment, k e is the environmental stiffness, X is the position of the end effector, and X e For the environmental location.

[0068] It can be seen from the above expression that the contact force exists only when the end effector penetrates into the environment. Therefore, the control of the contact force is essentially to control the distance that the end effector penetrates into the environment. Therefore, the present invention adopts a position-based force tracking control method. The obtained force tracking control system block diagram is combined with Figure 1 As shown, the control idea is: the outer loop force controller is based on the expected force information (expected force F d and its derivative with respect to time ) and the feedback contact force information F e , calculate the target reference position X of the end effector in real time c , the inner loop position controller controls the manipulator system to track the target reference position X c , and then realize the expected force F d Tracking;

[0069] 1.2. After the end effector contacts the environment, the robot arm generally runs very slowly. Here, it is assumed that the position controller of the inner loop has a good tracking effect and can achieve X c =X, so the control block diagram of the outer loop can be simplified and combined Figure 2 As shown, the expression of contact force can be written as follows:

[0070]

[0071] Step 2: Design force tracking control law and adaptive law according to the control block diagram

[0072] 2.1. After the end effector contacts the environment, let the force tracking error be ΔF, then:

[0073] ΔF=F d -F e =F d -k e (X c -X e )

[0074] Here it is assumed that the contact environment is stationary, that is, Taking the first-order derivative of the above equation with respect to time, the dynamic equation of the force tracking error is as follows:

[0075]

[0076] Among them, the target reference position X c That is the control law that needs to be designed;

[0077] 2.2. To solve the environmental stiffness k e To solve the unknown problem, an adaptive control method is introduced to estimate the environment stiffness. At the same time, a finite time control strategy is adopted to improve the convergence performance. e Generally, it is large, and it is difficult to select the initial value when performing adaptive estimation, so it can be changed to k e The inverse of k is estimated, assuming that e The reciprocal of is B e , Then the dynamic equation of the force tracking error can be changed to:

[0078]

[0079] 2.21. According to the dynamic equation of the force tracking error, the control law is designed through the following steps. The Lyapunov function V1 is designed as follows:

[0080]

[0081] Let the Lyapunov function V1 take the first-order derivative with respect to time, and we can get:

[0082]

[0083] Then the control law is designed as follows:

[0084]

[0085] In the formula, For B e The estimated value of k1>0, k2>0, 0<β<1 is a designable constant, sig β (ΔF)=|ΔF β ·sign(ΔF).

[0086] Substituting the control law into We can get:

[0087]

[0088] In the formula, is the estimated error of the inverse of the ambient stiffness;

[0089] 2.22. Based on the control law, the adaptive law is designed to estimate B through the following steps. e . The Lyapunov function V2 is designed as follows:

[0090]

[0091] Wherein, Γ>0 is a designable constant.

[0092] Let the Lyapunov function V2 take the first-order derivative with respect to time, and we can get:

[0093]

[0094] Then the adaptive law is designed as follows:

[0095]

[0096] In the formula, k a >0 is a designable constant;

[0097] Step 3: Based on Lyapunov stability theory, prove the finite time convergence of tracking error and estimation error

[0098] Substituting the adaptive law into We can get:

[0099]

[0100] In the formula,

[0101] According to the The expression can show that the tracking error of the force ΔF and the estimation error of the inverse of the environmental stiffness are The time T required to converge to the residual set Ω near 0 will have an upper bound T max :

[0102]

[0103] The residual set Ω is expressed as follows:

[0104]

[0105] In the formula, 0<v<1. So far, the proof of finite time convergence is completed.

[0106] In summary, the control method of the present invention is based on the interaction model between the constructed robot end effector and the environment. The unknown environmental stiffness is estimated by designing an adaptive law, and the control law is designed on this basis to achieve the tracking of the time-varying desired force. Finally, based on Lyapunov's finite-time stability theory, it is proved that the estimation error of the environmental stiffness and the tracking error of the time-varying force can converge to a small neighborhood of the origin within a finite time.

[0107] Example

[0108] Consider combining Figure 3 The two-degree-of-freedom robotic arm system shown in the figure combines the control process Figure 4 As shown, the goal is to control the end effector of the robot to contact the environment and make the contact force F e Able to track the time-varying expected force F d .

[0109] In order to verify the effectiveness of the algorithm of the present invention, a force tracking comparison test is conducted on a two-degree-of-freedom manipulator system for the proposed method AFTC, traditional impedance control CIC, and adaptive hybrid impedance control AIC. The main test content is the tracking ability of the three algorithms for time-varying expected force and the robustness of the algorithms when the contact environment changes. In the simulation, the common parameters of the three algorithms will remain consistent.

[0110] Simulation 1: Time-varying desired force tracking control simulation

[0111] In the simulation, it is assumed that the environment contacted by the end effector is a plane and the environment stiffness is set to k e =1000N / m, the environment position is set to X e =1.1m. For the proposed method, the selected parameters are shown in Table 1 below:

[0112] Table 1 Selected parameters

[0113]

[0114] The simulation time is 15s and the simulation step is 0.001s. The time-varying expected forces tracked are the sinusoidal expected forces F d =(10+sin(t))N and the expected slope force F d =(10+0.4t)N. Simulation results combined Figures 5 to 10 As shown. Among them, Figure 5 and Figure 6 The following shows the tracking and error changes of the three algorithms for the sinusoidal expected force. Figure 8 and Fig. 9 The figure shows the tracking and error changes of the slope desired force by the three algorithms. It can be seen from the figure that when the desired force is a time-varying force, both the CIC and AIC algorithms will have different degrees of tracking errors, while the AFTC has a better force tracking performance, which proves the effectiveness of the controller designed by the present invention. At the same time, compared with the other two algorithms, the AFTC has a faster response speed. Figure 7 and Fig.10 The figure shows the estimation of the inverse of the environmental stiffness by AFTC when tracking the sinusoidal expected force and the ramp expected force. It can be seen from the figure that in both cases, the estimated value is close to the true value and the error is small, which shows that the adaptive law can estimate the unknown parameters more effectively. In order to further compare the tracking performance of the three algorithms for time-varying expected force, the three performance indicators of mean square error MSE, root mean square error RMSE, and mean absolute error MAE from 3 to 10 seconds are used for quantitative analysis. The comparison results are shown in Table 2 below:

[0115] Table 2 Comparison results

[0116]

[0117] The data in the table prove that the MSE, RMSE and MAE performance indicators of AFTC are better than those of CIC and AIC. Taking the RMSE indicator of sinusoidal expected force tracking as an example, the tracking accuracy of AFTC is improved by 95.4% compared with CIC and 93.5% compared with AIC, which proves the effectiveness of the AFTC method.

[0118] Simulation 2: Control robustness test simulation

[0119] In the robustness test, three test environments are provided, namely: sudden change in expected constant force (case A), sudden change in environmental stiffness (case B), and sudden change in environmental position (case C). The test parameters of the three environments are selected as shown in Table 3 below:

[0120] Table 3 Test parameters of three environments

[0121]

[0122] In the simulation, it is assumed that the environment contacted by the end effector is a plane and the environment stiffness is set to k e =1000N / m, the environment position is set to X e =1.1m. For the proposed method, the selected parameters are shown in Table 1. The simulation time is 30s and the simulation step is 0.001s. Figures 11 to 13 As shown. Among them, combined Fig.11 As shown in the figure, when the desired force changes suddenly, all three algorithms can track the desired force, but AIC has a large overshoot. In contrast, AFTC has a small overshoot and a fast response speed. Fig.12 and Fig.13 As shown in the figure, when the environment stiffness or environment position changes suddenly, the convergence time of CIC and AIC is longer, while AFTC responds the fastest and almost no overshoot occurs. Through simulation experiments in these three environments, it can be proved that AFTC has good robustness in sudden change environment.

[0123] It will be apparent to those skilled in the art that the invention is not limited to the details of the exemplary embodiments described above and that the invention can be implemented in other forms of assembly without departing from the spirit or essential features of the invention. Therefore, the embodiments should be considered in all respects as exemplary and non-restrictive, and the scope of the invention is defined by the appended claims rather than the foregoing description, and it is intended that all variations within the meaning and range of equivalents of the claims be included in the invention. Any reference numeral in a claim should not be considered as limiting the claim to which it relates.

[0124] In addition, it should be understood that although the present specification is described according to implementation modes, not every implementation mode contains only one independent technical solution. This description of the specification is only for the sake of clarity. Those skilled in the art should regard the specification as a whole. The technical solutions in each embodiment may also be appropriately combined to form other implementation modes that can be understood by those skilled in the art.

Claims

1. A method for adaptive finite-time variable force tracking control of a robotic arm, characterized in that it comprises the following steps: Step 1: Model the interaction model between the end effector of the robot and the environment to obtain the force tracking control system block diagram 1.

1. Assuming that the contact force generated by the environment is related to the distance that the end effector penetrates into the environment, we have: In the formula, F e is the contact force between the end effector and the environment, k e is the environmental stiffness, X is the position of the end effector, and X e for environmental location; The force tracking control system block diagram is obtained by using the position-based force tracking control method. The control idea is: the outer loop force controller is based on the expected force F d and its derivative with respect to time And the feedback contact force information F e , calculate the target reference position X of the end effector in real time c , the inner loop position controller controls the manipulator system to track the target reference position X c , and then realize the expected force F d Tracking; 1.

2. After the end effector contacts the environment, the position controller of the inner loop is assumed to be able to reach X c =X, then the expression of contact force is as follows: Step 2: Design force tracking control law and adaptive law according to the control block diagram 2.

1. After the end effector contacts the environment, let the force tracking error be ΔF, then: ΔF=F d -F e =F d -k e (X c -X e ) set up The dynamic equation of the force tracking error is as follows: 2.

2. Introducing adaptive control method to estimate environmental stiffness k e , using a finite time control strategy, for k e The inverse of is estimated, let k e The reciprocal of is B e , then the dynamic equation of the force tracking error becomes: 2.

21. Design the Lyapunov function V1 as follows: Let the Lyapunov function V1 take the first-order derivative with respect to time: Then the control law is designed as follows: In the formula, For B e The estimated value of k1>0, k2>0, 0<β<1 is a designable constant, sig β (ΔF)=|ΔF| β ·sign(ΔF); Substituting the control law into In the formula, is the estimated error of the inverse of the ambient stiffness; 2.

22. Design the Lyapunov function V2 as follows: In the formula, Γ>0 is a designable constant; Let the Lyapunov function V2 take the first-order derivative with respect to time: Then the adaptive law is designed as follows: In the formula, k a >0 is a designable constant; Step 3: Based on Lyapunov stability theory, prove the finite time convergence of tracking error and estimation error Substituting the adaptive law into In the formula, ΔF and The time T required to converge to the residual set Ω will have an upper bound T max : The residual set Ω is expressed as follows: In the formula, 0<v<1.

Citation Information

Patent Citations

  • Controller

    CN101034283A

  • Method for adaptively tracking and controlling fingertip force of robot anthropomorphic finger

    CN102363301A

  • Industrial mechanical arm force / position mixed control method based on Kalman filter

    CN106041926A

  • Reconfigurable mechanical arm control method and system oriented to unknown environmental constraints

    CN113103237A

  • Finite time adaptive robot force and position hybrid control method

    CN113927591A