Inverse dynamics robust control method, system and equipment for multi-connecting-rod mechanical arm with fixed time and medium

Through the fixed time robust term inverse dynamic control method, the problem of tracking error in the multi-link robotic arm system cannot be driven to zero-sum uncertainty compensation, and the rapid convergence of joint angular displacement and high-precision trajectory tracking are achieved. The application range of robotic arms.

CN118977242AInactive Publication Date: 2024-11-19XIJING UNIV
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411123051.3
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-15
Publication Date
2024-11-19
Estimated Expiration
Not applicable · inactive patent

AI Technical Summary

Technical Problem

The existing fixed-time control method cannot drive the tracking error of the multi-link robot arm to zero in a limited time, and cannot effectively compensate for uncertainty in the system, resulting in the inability to complete high-precision operation tasks.

Method used

Based on the fixed-time robust term inverse dynamic control method, by establishing the dynamic model and robust term model of the joint end of the multi-link robot arm, a robust controller is designed using a consistent robust precision differential algorithm to ensure joint angular displacement tracking errors. Strictly drop to zero within a fixed time and suppress uncertainty.

Benefits of technology

The rapid convergence of the tracking errors of the joint angle displacement of the multi-link robot arm system is achieved, which suppresses uncertainty within a fixed time, and strictly reduces the tracking error to zero, expands the working range of the robot arm and can handle more diversification. mission.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118977242A_ABST
    Figure CN118977242A_ABST
Patent Text Reader

Abstract

The invention discloses an inverse dynamic robust control method, system and equipment for a multi-connecting-rod mechanical arm with fixed time, and a medium. The method comprises the following steps: based on a fixed time convergence item model and a fixed time robust item model of each joint of a mechanical arm system and a dynamic model of a joint end of the multi-connecting-rod mechanical arm; a mechanical arm controller tau based on fixed time robust item inverse dynamic control is established; the angular displacement tracking error of each joint can be strictly reduced to zero within the fixed time, and the uncertainty within the fixed time can be fully compensated; the system, the device and the medium are used for achieving the inverse dynamics robust control method of the multi-connecting-rod mechanical arm. The method has the advantages that the method is not influenced by an initial value of the system, the angular displacement tracking error of each joint of the multi-connecting-rod mechanical arm system is converged more quickly, the uncertainty in fixed time is restrained, and meanwhile, the tracking error is reduced to zero strictly in a non-singular mode, and the method is not a common approximation method.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of robot arm control algorithms, and in particular to a fixed-time multi-link robot arm inverse dynamics robust control method, system, equipment and medium. Background Art

[0002] With the rapid development of control theory, measurement technology and material science, the performance of multi-link manipulators has been significantly enhanced. Today, under the guidance of trajectory tracking control technology, such manipulators have shown broad application prospects in many engineering fields such as seabed exploration, space exploration, repetitive operations and emergency rescue. In-depth exploration in this field will not only help improve the efficiency and accuracy of multi-link manipulators in various application scenarios, but also promote the development and progress of the entire robot control technology. Therefore, the research on high-precision trajectory tracking control has become one of the most representative control problems in the field of multi-link manipulator research. The finite-time sliding mode controller is closely related to the initial conditions of the system and cannot control the system with unknown initial conditions. The fixed-time stability control method can not only derive the trajectory of the system reaching equilibrium in a finite time, but also ensure that the convergence time is independent of the initial conditions of the system.

[0003] For multi-link manipulator systems, fixed-time control can eliminate the system initial condition problem of conventional finite-time control. However, the existing fixed-time control makes it impossible to drive the tracking error to zero, which means that the manipulator cannot complete some high-precision operation tasks. Since the actual manipulator is a typical uncertain system, fixed-time inverse dynamics control (Fixed-time IDC) may not achieve the expected fixed-time convergence performance in actual situations. Therefore, a new fixed-time control scheme is proposed, which can strictly control the tracking error to zero and compensate for the uncertainty within the fixed time.

[0004] Su, Yuxin [Su, Yuxin et al. "Robust approximate fixed-time tracking control for uncertain robot manipulators." Mechanical Systems and SignalProcessing 135 (2020): 106379.] proposed a robust control method based on a new sliding surface that can guarantee global approximate convergence with fixed-time convergence. The global approximate timing convergence of the tracking error is proved. In a uniformly bounded time, the position tracking error globally converges to an arbitrary small set centered on zero, and then exponentially approaches zero. However, this fixed-time control cannot drive the tracking error to zero, nor does it take into account the uncertainty in the system, which means that the robotic arm system will not be able to complete some high-precision manipulation tasks. Summary of the invention

[0005] In order to solve the defects of the above-mentioned prior art, the purpose of the present invention is to provide a fixed-time multi-link manipulator inverse dynamics robust control method, system, equipment and medium. Based on the fixed-time convergence term model and fixed-time robust term model of each joint of the manipulator system and the dynamic model of the joint end of the multi-link manipulator, a manipulator controller τ based on fixed-time robust term inverse dynamics control is established; it can not only strictly reduce the angular displacement tracking error of each joint to zero within the fixed time, but also fully compensate for the uncertainty within the fixed time; the present invention has the advantages of not being affected by the initial value of the system, so that the angular displacement tracking error of each joint of the multi-link manipulator system converges more quickly and suppresses the uncertainty within the fixed time, and at the same time strictly non-singularly reduces the tracking error to zero instead of the commonly used approximate method.

[0006] In order to achieve the above object, the technical solution adopted by the present invention is:

[0007] A fixed-time multi-link manipulator inverse dynamics robust control method specifically comprises the following steps:

[0008] Step 1: Based on the dynamic behavior of the multi-link robotic arm, a dynamic model of the joint end of the multi-link robotic arm is established; according to the dynamic model of the joint end of the multi-link robotic arm and the predetermined trajectory of the angular displacement of each joint of the robotic arm system, the tracking error of the angular displacement of each joint of the robotic arm system is established;

[0009] Step 2: Based on the URED algorithm that is stable in fixed time, a fixed time convergence term model and a robust term model of each joint of the robotic arm system are established, and the parameters of the fixed time convergence term model and the fixed time robust term model of each joint of the robotic arm system are set;

[0010] Step 3: According to the fixed-time convergence term model and fixed-time robust term model of each joint of the robotic arm system established in step 2 and the dynamic model of the joint end of the multi-link robotic arm established in step 1, a robotic arm controller τ based on fixed-time robust term inverse dynamics control is established, and the fixed-time stability of the robotic arm controller τ is proved;

[0011] Step 4: Input the robotic arm controller τ based on fixed-time robust term inverse dynamics control established in step 3 into the dynamic model of the multi-link robotic arm joint end established in step 1, and control the convergence time by debugging the parameters of the fixed-time convergence term model and the fixed-time robust term model set in step 2, so that the angular displacement tracking error of each joint of the robotic arm system established in step 1 is strictly reduced to zero within a fixed time.

[0012] The step 1 is specifically as follows:

[0013] Step 1.1: Based on the dynamic behavior of the multi-link robotic arm, the multi-link robotic arm system is designed to contain four degrees of freedom. The dynamic model of the joint end of the multi-link robotic arm is defined by formula (1):

[0014]

[0015] Where θ represents the position vector of the joint, represents the joint velocity vector, represents the joint acceleration vector, M(θ) represents the joint space inertia matrix, represents the Coriolis and centripetal coupling matrices, G(θ) represents the gravity load, and τ represents the input torque;

[0016] The four-dimensional parameters of the joint end of the multi-link robotic arm are defined as:

[0017]

[0018] Among them, I i (i=1,2,3,4) is the moment of inertia around the center of mass, and the distance between the center of rotation of each connecting rod and the end of the connecting rod is κ, m i is the mass of the ith connecting rod, d i is the mass center of the ith connecting rod, l i is the length of the ith link, θ i is the angle (position) of the ith joint, and is the acceleration due to gravity; p2=2[l1d2m2+l1l2(m3+m4)], p3=m3+m4, p4=m3+m4, p5=I4;

[0019] Step 1.2: Based on the dynamic model of the joint end of the multi-link manipulator constructed in step 1.1, combined with the predetermined trajectory of the angular displacement of each joint of the manipulator system, the tracking error of the angular displacement of each joint of the manipulator system is defined by formula (3) and formula (4):

[0020] e1=θ d -θ (3)

[0021] definition The error dynamic equation of the multi-link manipulator is defined as:

[0022]

[0023] Among them, θ represents the position vector of the joint, θ d is the desired trajectory of the multi-link robot motor, and e1 is the tracking error between the joint trajectory and the desired trajectory.

[0024] The step 2 is specifically as follows:

[0025] Step 2.1: The uniformly robust exact differentiator (URED) algorithm that is stable in fixed time is defined by equation (5):

[0026]

[0027] Among them, σ in formula (5) j (j=0,1) is a state variable, and f0(t) is bounded as f0(t)|<L, the function and The design is as follows:

[0028]

[0029] Among them, in formula (6) is a scalar, the parameter in formula (5) and Should be in the collection:

[0030]

[0031] According to the Uniformly Robust Exact Differentiator (URED) algorithm, states σ0 and σ1 are f The convergence to the origin is uniform; the convergence time is t f Bounded to t f ≤T fmax , where T fmax is a positive constant and is independent of the initial states σ0(0) and σ1(0) in the Uniformly Robust Exact Differentiator (URED) algorithm;

[0032] Step 2.2: Combined with the URED algorithm that is stable in fixed time in step 2.1, i.e., formula (5), a robust control algorithm is designed for the multi-link manipulator. The robust control algorithm is defined as:

[0033]

[0034] Among them, the vector ξ=[ξ1,...,ξ n ] T ∈R n , real number α>0,φ1(ξ i ),φ2(ξ i )(i=1,2,...,n)

[0035] Step 2.3: Fixed time convergence term model H(e1,e2)∈R for each joint of the robotic arm system n Defined as:

[0036]

[0037] Step 2.4: Based on the robust control algorithm designed in step 2.2 and combined with the fixed-time convergence term model of each joint in step 2.3, the fixed-time robust term model R(e1, e2) of each joint of the manipulator system is defined as:

[0038]

[0039] Among them, the parameters meet the conditions β1=2α1+1, By optimizing the parameters P1, P2, Q1, Q2, α1, k1, and k2, a closed-loop control system is formed to ensure that the robot arm can still achieve high-precision trajectory tracking when facing various uncertainties.

[0040] The step 3 is specifically as follows:

[0041] Step 3.1: Based on the fixed-time convergence term model and robust term model of each joint of the manipulator system in step 2.3 and step 2.4, that is, on the basis of formula (9) and formula (10), the manipulator controller τ of the fixed-time robust term inverse dynamics control is defined as:

[0042]

[0043] Where θ represents the position vector of the joint, represents the joint velocity vector, represents the joint acceleration vector, M(θ) represents the joint space inertia matrix, represents the Coriolis and centripetal coupling matrices, G(θ) represents the gravity load, and τ represents the input torque;

[0044] Step 3.2: Prove the fixed-time stability of the robot controller τ defined in step 3.1:

[0045] Step 3.2.1: Substitute the inverse dynamics robust controller τ of the fixed-time multi-link manipulator, i.e., formula (11), into the error dynamic equation of the multi-link manipulator in step 1.2, i.e., formula (4), to obtain:

[0046]

[0047] Step 3.2.2: According to each control error e 1i (i=1,2,...,n) we get:

[0048]

[0049] Among them, H i (i=1,2,3,4) is the abbreviated form of the convergence model of each joint of the robotic arm system, R i (i=1,2,3,4) is the abbreviated form of the robust term model of each joint of the manipulator system, δ i is the uncertainty and the variable is a positive constant;

[0050] Step 3.2.3: Replace the fixed time convergence model H of each joint of the robotic arm system in steps 2.3 and 2.4 i and the fixed-time robust term model R i Redefine as:

[0051]

[0052] Step 3.2.4: Set and According to formula (13) in step 3.2.2 and formula (14) in step 3.2.3, we get:

[0053]

[0054] Step 3.2.5: According to the uniformly robust exact differentiator (URED) algorithm described in step 2.1, if ω in step 3.2.4 0i =0 at fixed time The internal satisfaction and fixed time convergence can analyze the control error e 1i ; In the convergence period ω 0i In, e 1i The convergence stability of may be affected; therefore, the proof of the convergence of the entire dynamics considered below consists of two steps: In step 1, it is shown that 0i Before converging to zero, the control error e 1iis bounded; in step 2, we will prove that 0i After converging to zero, the control error e 1i Converges to zero in a fixed time, that is, e 1i = 0 is stable at a fixed time.

[0055] In step 1.1, the four degrees of freedom of the multi-link robotic arm system are composed of three rotational joints and one sliding joint, and the coordinate systems of each joint established based on the DH representation are located at the connection points of each joint.

[0056] A fixed-time multi-link manipulator inverse dynamics robust control system, comprising:

[0057] Dynamic modeling module: This module establishes the dynamic model of the joint end of the multi-link robotic arm based on the dynamic behavior of the multi-link robotic arm; according to the dynamic model of the joint end of the multi-link robotic arm and the predetermined trajectory of the angular displacement of each joint of the robotic arm system, the tracking error of the angular displacement of each joint of the robotic arm system is established;

[0058] Control algorithm design module: This module establishes the fixed-time convergence term model and the robust term model of each joint of the robotic arm system based on the URED algorithm that is stable in fixed time, and sets the parameters of the fixed-time convergence term model and the fixed-time robust term model of each joint of the robotic arm system;

[0059] Controller implementation and verification module: This module establishes a robot controller τ based on fixed-time robust term inverse dynamics control based on the fixed-time convergence term model and fixed-time robust term model of each joint of the robot system and the dynamic model of the joint end of the multi-link robot, and proves the fixed-time stability of the robot controller τ;

[0060] Parameter adjustment and optimization module: This module inputs the robot controller τ based on the fixed-time robust term inverse dynamics control into the dynamic model of the joint end of the multi-link robot arm, and controls the convergence time by debugging the parameters of the fixed-time convergence term model and the fixed-time robust term model, so that the angular displacement tracking error of each joint of the established robot arm system is strictly reduced to zero within a fixed time.

[0061] A fixed-time multi-link manipulator inverse dynamics robust control device, comprising:

[0062] Memory: used for storing a computer program to implement the above-mentioned fixed-time robust control method for inverse dynamics control of a multi-link manipulator;

[0063] Processor: used to implement the above-mentioned fixed-time robust control multi-link manipulator inverse dynamics control method when executing the computer program.

[0064] A computer-readable storage medium stores a computer program, which, when executed by a processor, implements the steps of a method for inverse dynamics control of a multi-link manipulator with fixed-time robust control.

[0065] Compared with the prior art, the beneficial effects of the present invention are:

[0066] (1) The proposed fixed-time multi-link manipulator inverse dynamics robust control method extends the commonly used robot trajectory tracking inverse dynamics control (IDC) to a fixed-time stable scheme, that is, the proposed fixed-time multi-link manipulator inverse dynamics robust control method extends the recent fixed-time inverse dynamics control (IDC) results to a robust scheme with strong robustness.

[0067] (2) The new robust fixed-time inverse dynamics control (IDC) control method designed by the fixed-time multi-link robotic arm inverse dynamics robust control method of the present invention can suppress the bounded uncertainty of the multi-link robotic arm system within the fixed time and compensate for the uncertainty within the fixed time.

[0068] (3) The present invention establishes fixed-time convergence terms and robust terms of each joint of the robotic arm system based on the uniformly robust exact differentiator (URED) algorithm, and then establishes a robotic arm controller based on fixed-time robust term inverse dynamic control, so that the angular displacement tracking errors of each joint of the robotic arm system can converge to the predetermined trajectory more quickly.

[0069] (4) Since the proposed scheme is designed based on inverse dynamics control (IDC) and the additional uniformly robust exact differentiator (URED) is non-singular, the method proposed in the present invention does not require the approximate method commonly used in existing fixed-time control schemes, that is, the proposed method can drive the tracking error of the trajectory to zero rather than the neighborhood of zero.

[0070] (5) The present invention extends the fixed-time inverse dynamics robust control method of a multi-link robotic arm to a robotic arm with four degrees of freedom, which can more precisely control the position and posture of the end of the robotic arm, greatly expanding the working range of the robotic arm and enabling it to handle more diverse tasks.

[0071] In summary, the present invention adopts the robust control term of the inverse dynamics control (IDC) algorithm to compensate for the uncertainty within a fixed time, and develops a robust fixed-time stable robotic arm control algorithm; it has the advantages of not being affected by the initial value of the system, making the angular displacement tracking error of each joint of the multi-link robotic arm system converge more quickly and suppressing the uncertainty within a fixed time, and at the same time being strictly non-singular so that the tracking error is reduced to zero instead of the commonly used approximate method, thereby being able to more finely control the position and posture of the end of the robotic arm, greatly expanding the working range of the robotic arm, enabling it to handle more diverse tasks. BRIEF DESCRIPTION OF THE DRAWINGS

[0072] Figure 1 It is a flow chart of the implementation steps of the present invention.

[0073] Figure 2 It is a system model diagram of the multi-link robotic arm of the present invention.

[0074] Figure 3 It is a simulation schematic diagram of the tracking error e1 of each joint trajectory of the multi-link robotic arm control method of the present invention and the Fixed-time IDC method when the initial condition is [0, 0, 0, 0].

[0075] Figure 4 It is a simulation schematic diagram of the joint velocity tracking error e2 of the multi-link robotic arm control method of the present invention and the Fixed-time IDC method when the initial condition is [0, 0, 0, 0].

[0076] Figure 5 It is a simulation diagram of the tracking error e1 of each joint trajectory of the multi-link robotic arm control method of the present invention and the Fixed-time IDC method when the initial conditions are [1, 0.6, 0.9, 0.7].

[0077] Figure 6 It is a simulation diagram of the joint velocity tracking error e2 of the multi-link robotic arm control method of the present invention and the Fixed-time IDC method when the initial conditions are [1, 0.6, 0.9, 0.7].

[0078] Figure 7 It is a simulation schematic diagram of the sliding surface R of each joint of the multi-link mechanism of the present invention.

[0079] Figure 8 It is a simulation schematic diagram of the joint controller τ of the multi-link mechanism of the present invention.

[0080] Fig. 9 The tracking trajectory θ of each joint of the multi-link mechanical device of the present invention and the expected trajectory θ d Simulation schematic. DETAILED DESCRIPTION

[0081] The technical solution of the present invention is described in detail below with reference to the accompanying drawings and embodiments.

[0082] See also Figure 1 , a fixed-time multi-link manipulator inverse dynamics robust control method, specifically comprising the following steps:

[0083] Step 1: Based on the dynamic behavior of the multi-link robotic arm, a dynamic model of the joint end of the multi-link robotic arm is established; according to the dynamic model of the joint end of the multi-link robotic arm and the predetermined trajectory of the angular displacement of each joint of the robotic arm system, the tracking error of the angular displacement of each joint of the robotic arm system is established;

[0084] The step 1 is specifically as follows:

[0085] Step 1.1: Based on the dynamic behavior of the multi-link robotic arm, the multi-link robotic arm system is designed to contain four degrees of freedom. The dynamic model of the joint end of the multi-link robotic arm is defined by formula (1):

[0086]

[0087] Where θ represents the position vector of the joint, represents the joint velocity vector, represents the joint acceleration vector, M(θ) represents the joint space inertia matrix, represents the Coriolis and centripetal coupling matrices, G(θ) represents the gravity load, and τ represents the input torque;

[0088] The four-dimensional parameters of the joint end of the multi-link robotic arm are defined as:

[0089]

[0090] Among them, I i (i=1,2,3,4) is the moment of inertia around the center of mass, and the distance between the center of rotation of each connecting rod and the end of the connecting rod is κ, m i is the mass of the ith connecting rod, d i is the mass center of the ith connecting rod, l i is the length of the ith link, θ i is the angle (position) of the i-th joint, and g is the acceleration due to gravity; then p2=2[l1d2m2+l1l2(m3+m4)], p3=m3+m4, p4=m3+m4, p5=I4;

[0091] In step 1.1, the four degrees of freedom of the multi-link robotic arm system are composed of three rotating joints and one sliding joint, and the coordinate system of each joint established based on the DH representation is located at the connection point of each joint point. Figure 2As shown, the z0, z1, and z3 coordinate systems represent three rotational joints respectively, and the z2 coordinate system represents a sliding joint.

[0092] Step 1.2: Based on the dynamic model of the joint end of the multi-link manipulator constructed in step 1.1, combined with the predetermined trajectory of the angular displacement of each joint of the manipulator system, the tracking error of the angular displacement of each joint of the manipulator system is defined by formula (3) and formula (4):

[0093] e1=θ d -θ (3)

[0094] definition The error dynamic equation of the multi-link manipulator is defined as:

[0095]

[0096] Among them, θ represents the position vector of the joint, θ d is the desired trajectory of the multi-link robot motor, and e1 is the tracking error between the joint trajectory and the desired trajectory.

[0097] Step 2: Based on the URED algorithm that is stable in fixed time, a fixed time convergence term model and a robust term model of each joint of the robotic arm system are established, and the parameters of the fixed time convergence term model and the fixed time robust term model of each joint of the robotic arm system are set;

[0098] The step 2 is specifically as follows:

[0099] Step 2.1: The uniformly robust exact differentiator (URED) algorithm that is stable in fixed time is defined by equation (5):

[0100]

[0101] Among them, σ in formula (5) j (j=0,1) is a state variable, and f0(t) is bounded as f0(t)|<L, the function and The design is as follows:

[0102]

[0103] Among them, in formula (6) is a scalar, the parameter in formula (5) and Should be in the collection:

[0104]

[0105] Considering the dynamic system with uncertainty, the stability of the Uniformly Robust Exact Differentiator (URED) algorithm is demonstrated using Propositions 1 and 2:

[0106] Proposition 1. The Lyapunov function is defined as:

[0107]

[0108] in, is a symmetric and positive definite matrix; for some The derivative of the Lyapunov function V1 satisfies the inequality:

[0109]

[0110] in, is a positive scalar, satisfying the stability theory in the sense of Lyapunov;

[0111] Proposition 2. The states σ0 and σ1 in the Uniformly Robust Exact Differentiator (URED) algorithm at time t f The convergence to the origin is uniform; the convergence time is t f Bounded to t f ≤T fmax , where T fmax is a positive constant, which is independent of the URED algorithm and the initial states σ0(0) and σ1(0) in formula (5), and fully compensates for the uncertainty in the fixed time, thus obtaining a URED algorithm that is stable in the fixed time.

[0112] Step 2.2: Combined with the URED algorithm that is stable in fixed time in step 2.1, i.e., formula (5), a robust control algorithm is designed for the multi-link manipulator. The robust control algorithm is defined as:

[0113] S(ξ) α =[ξ1| α sign(ξ1),...,ξ n | α sign(ξ n )] T ,

[0114] φ1(ξ)=[φ1(ξ1),...,φ1(ξ n )] T , (10)

[0115] φ2(ξ)=[φ2(ξ1),...,φ2(ξ n )] T ,

[0116] where φ1(ξi ),φ2(ξ i )(i=1,2,...,n) can be defined as:

[0117]

[0118] Among them, the vector ξ=[ξ1,...,ξ n ] T ∈R n , real number α>0,φ1(ξ i ),φ2(ξ i )(i=1,2,...,n)

[0119] Step 2.3: Fixed time convergence term model H(e1,e2)∈R for each joint of the robotic arm system n Defined as:

[0120]

[0121] Step 2.4: Based on the robust control algorithm designed in step 2.2 and combined with the fixed-time convergence term model of each joint in step 2.3, the fixed-time robust term model R(e1, e2) of each joint of the manipulator system is defined as:

[0122]

[0123] Among them, the parameters meet the conditions β1=2α1+1, By optimizing the parameters P1, P2, Q1, Q2, α1, k1, and k2, a closed-loop control system is formed to ensure that the robot arm can still achieve high-precision trajectory tracking when facing various uncertainties.

[0124] Step 3: According to the fixed-time convergence term and robust term of each joint of the robotic arm system established in step 2 and the dynamic model of the joint end of the multi-link robotic arm established in step 1, a robotic arm controller based on fixed-time robust term inverse dynamics control is established, and the fixed-time stability of the robotic arm controller is proved;

[0125] The step 3 is specifically as follows:

[0126] Step 3.1: Based on the fixed-time convergence term model and robust term model of each joint of the manipulator system in step 2.3 and step 2.4, that is, on the basis of formula (12) and formula (13), the manipulator controller τ of the fixed-time robust term inverse dynamics control is defined as:

[0127]

[0128] Where θ represents the position vector of the joint, represents the joint velocity vector, represents the joint acceleration vector, M(θ) represents the joint space inertia matrix, represents the Coriolis and centripetal coupling matrices, G(θ) represents the gravity load, and τ represents the input torque;

[0129] Step 3.2: Prove the fixed-time stability of the robot controller τ defined in step 3.1:

[0130] Step 3.2.1: Substitute the inverse dynamics robust controller τ of the fixed-time multi-link manipulator, i.e., formula (14), into the error dynamic equation of the multi-link manipulator in step 1.2, i.e., formula (4), to obtain:

[0131]

[0132] Step 3.2.2: According to each control error e 1i (i=1,2,...,n) we get:

[0133]

[0134] Among them, H i (i=1,2,3,4) is the abbreviated form of the convergence model of each joint of the robotic arm system, R i (i=1,2,3,4) is the abbreviated form of the robust term model of each joint of the manipulator system, δ i is the uncertainty and the variable is a positive constant;

[0135] Step 3.2.3: Replace the fixed time convergence model H of each joint of the robotic arm system in steps 2.3 and 2.4 i and the fixed-time robust term model R i Redefine as:

[0136]

[0137] Step 3.2.4: Set and According to formula (16) in step 3.2.2 and formula (17) in step 3.2.3, we get:

[0138]

[0139] Step 3.2.5: According to the uniformly robust exact differentiator (URED) algorithm described in step 2.1, if ω in step 3.2.4 0i =0 at fixed time The internal satisfaction and fixed time convergence can analyze the control error e 1i ; In the convergence period ω 0i In, e1i The convergence stability of may be affected; therefore, the proof of the convergence of the entire dynamics considered below consists of two steps: In step 1, it is shown that 0i Before converging to zero, the control error e 1i is bounded; in step 2, we will prove that 0i After converging to zero, the control error e 1i Converges to zero in a fixed time, that is, e 1i = 0 is stable at a fixed time.

[0140] Step 1: The Lyapunov function V2 is defined as:

[0141] V2=ω T P ω ω (19)

[0142] where ω=[φ1(ω 0i ),ω 1i ] T , P ω is a symmetric and positive definite matrix. Then, if k1 and k2 are in the set (7), for some ε>0, the derivative of the Lyapunov function V2 satisfies the inequality:

[0143]

[0144] where κ j (P ω ,ε)(j=1,2) is a positive scalar. From formula (20), we can see that when t≥0 Therefore, φ1(ω 0i )| and |ω 1i | is always bounded, then:

[0145]

[0146] Among them, φ 1max and φ 2max is a positive constant. Then, the Lyapunov function V3 is defined as:

[0147]

[0148] Calculate the time derivative of V3 along the trajectory of formula (16), then:

[0149]

[0150] By combining formula (17), formula (20) can be rewritten as:

[0151]

[0152] consider and Then we have:

[0153]

[0154] Since P2>0 and Q2>0, we have:

[0155]

[0156] Consider φ1(ω 0i ) and ω 1i The upper bound of is given by equation (21), and equation (26) can be rewritten as:

[0157]

[0158] Consider the following two cases:

[0159] Case 1: If e 1i e 2i <0, we have Obviously, 1i is bounded. Case 2: If e 1i e 2i ≥0, from formula (27) we get:

[0160]

[0161] Then, formula (28) can be rewritten as:

[0162]

[0163] Let L = ((k1φ 1max +φ 2max ) 2 / 2), then:

[0164]

[0165] According to formula (30), for any initial time t=t g , then:

[0166]

[0167] Where e is a natural number; it can be clearly seen from formula (31) that V3 and e 1i is bounded in any finite time; through the discussion of Case 1 and Case 2, it can be clearly seen that the control error e 1i is always bounded for any initial time.

[0168] Step 2: From formula (18), we can see that at a fixed time T1, the following formula is satisfied:

[0169]

[0170] Where T1 has nothing to do with the initial system conditions. Then:

[0171]

[0172] In step 1, we proved that e 1i is always bounded in any finite time. Therefore, it is clear that e 1i (T1) is bounded. Then, from formula (33), we can see that at a fixed time T1+T2, e 1i =0 can be guaranteed, then:

[0173] e 1i =0,(t≥T2+T1) (34)

[0174] T2+T1 is also independent of the initial system conditions.

[0175] Step 4: Input the robotic arm controller based on fixed-time robust term inverse dynamics control established in step 4 into the dynamic model of the multi-link robotic arm joint end established in step 1, that is, to achieve faster convergence of the angular displacement tracking errors of each joint of the robotic arm system. Through the Simulink simulation tool component of the MATLAB software, the parameters of the components of the convergence term and the robust term are continuously debugged to control the convergence time, and finally the angular displacement tracking errors of each joint of the robotic arm system established in step 1 are strictly reduced to zero within a fixed time.

[0176] A fixed-time multi-link manipulator inverse dynamics robust control system, comprising:

[0177] Dynamic modeling module: This module establishes the dynamic model of the joint end of the multi-link robotic arm based on the dynamic behavior of the multi-link robotic arm; according to the dynamic model of the joint end of the multi-link robotic arm and the predetermined trajectory of the angular displacement of each joint of the robotic arm system, the tracking error of the angular displacement of each joint of the robotic arm system is established;

[0178] Control algorithm design module: This module establishes the fixed-time convergence term and robust term of each joint of the robot system based on the URED algorithm that is stable in fixed time, and sets the parameters of the components of the fixed-time convergence term and robust term;

[0179] Controller implementation and verification module: This module establishes a robot controller τ based on fixed-time robust term inverse dynamics control based on the fixed-time convergence term of each joint of the robot system and the dynamic model of the joint end of the multi-link robot, and proves the fixed-time stability of the robot controller τ;

[0180] Parameter adjustment and optimization module: This module inputs the robot controller τ based on the fixed-time robust term inverse dynamics control into the dynamic model of the joint end of the multi-link robot arm, and controls the convergence time by debugging the parameters of the components of the convergence term and the robust term, so that the angular displacement tracking error of each joint of the established robot arm system is strictly reduced to zero within a fixed time.

[0181] A fixed-time multi-link manipulator inverse dynamics robust control device, comprising:

[0182] Memory: used for storing a computer program to implement the above-mentioned fixed-time robust control method for inverse dynamics control of a multi-link manipulator;

[0183] Processor: used to implement the above-mentioned fixed-time robust control multi-link manipulator inverse dynamics control method when executing the computer program.

[0184] A computer-readable storage medium stores a computer program, which, when executed by a processor, implements the steps of a method for inverse dynamics control of a multi-link manipulator with fixed-time robust control.

[0185] The application effect of the present invention is described in detail below in conjunction with simulation experiments.

[0186] In order to verify the effectiveness and superiority of the method proposed in the present invention, the dynamic data of each joint position of the four-dimensional model is obtained according to the four-dimensional parameters of the joint ends of the multi-link robotic arm described in step 1.1, that is, formula (2). By extending the commonly used robot trajectory tracking inverse dynamics to a fixed-time stable scheme, the fixed-time inverse dynamics control method of the multi-link robotic arm proposed in the present invention is obtained, and the bounded uncertainty of the multi-link robotic arm system within a fixed time can be suppressed, that is, the proposed fixed-time inverse dynamics control method extends the latest fixed-time inverse dynamics control (IDC) results to a robust scheme. Therefore, control tests under zero initial conditions and arbitrary non-zero initial conditions are set during the simulation process for verification, as shown in the attached figure. Figure 3-6 As shown, Figure 3 , 4 The trajectory angle and trajectory angular velocity control images of each joint of the multi-link manipulator under zero initial conditions are shown in the figure. Figure 5 , 6 The trajectory angle and trajectory angular velocity control images of each joint of the multi-link manipulator under any non-zero initial conditions are obtained. The robust control term designed according to the URED algorithm is used to obtain the controller of the inverse dynamics robust control method of the multi-link manipulator with fixed time. The method proposed by the present invention can drive the tracking error of the trajectory to zero, rather than the neighborhood of zero.

[0187] During the simulation process, the proposed controller was compared with the fixed-time inverse dynamics control method without the robust control term in the comparative paper cited in the background technology for verification, as shown in the attached figure. Figure 3-6 As shown, the black solid line in the simulation diagram is the proposed fixed-time multi-link robotic arm inverse dynamics robust control method, and the black dotted line in the diagram is the fixed-time inverse dynamics control method of the comparative paper in the background technology.

[0188] The simulation results are shown in the attached Figure 3-9 According to the simulation results, the following conclusions can be drawn: Figure 3 and attached Figure 5 Under zero initial conditions and with Figure 4 and attached Figure 6 As shown in the comparison under non-zero initial conditions, the trajectory tracking error of each joint of the proposed robust fixed-time IDC method for inverse dynamics of a multi-link manipulator can be guaranteed to converge to zero in 0.8s, and the velocity tracking error of each joint can be guaranteed to converge to zero in about 1s. However, the convergence time of the trajectory tracking error and velocity tracking error of each joint of the Fixed-time IDC method in the control paper under zero initial conditions is about 1.5s, and the convergence time of the trajectory tracking error and velocity tracking error of each joint under non-zero initial conditions is about 2s, that is, the convergence time of the Fixed-time IDC method in the control paper will be affected by the initial conditions. Figure 3-6 It can also be seen that, when the initial conditions remain unchanged and are both zero or non-zero, the proposed robust fixed-time IDC method can ensure that the convergence time of each joint is about 0.7s faster than that of the Fixed-time IDC method in the reference paper. That is, for different system initial conditions, the scheme of the present invention can provide faster trajectory tracking error and velocity tracking error convergence speed without changing the control parameters. It can be seen that the proposed robust fixed-time IDC method is superior to the Fixed-time IDC method in the reference paper.

[0189] Figure 7 The simulation result diagram of the designed robust terms shows that the robust terms of each joint tend to be stable within 1 second. This scheme improves the fixed-time inverse dynamics control (IDC) by designing robust terms, which can not only maintain the expected convergence performance of fixed-time control, but also eliminate the influence of different uncertainties. Figure 8It can be seen that despite the existence of such large-amplitude and fast-changing uncertainties, the proposed robust fixed-time inverse dynamics control (IDC) can still achieve faster convergence speed and higher control accuracy. Fig. 9 This is the state diagram of the multi-link robot arm tracking trajectory. It can be clearly seen that it almost coincides with the expected trajectory, indicating that the expected simulation effect can be achieved well.

[0190] A new fixed-time robust control scheme is proposed for a multi-link manipulator system with uncertainty. The robust control term is designed based on the uniformly robust exact differentiator (URED) algorithm, and the robust fixed-time inverse dynamics control (IDC) extends the existing fixed-time inverse dynamics control (IDC) into a robust scheme. In addition, the proposed method eliminates the singularity problem and does not require the use of approximate methods. It is rigorously proved that the convergence time of the closed-loop system of the proposed control method is fixed time and independent of the initial conditions. Finally, simulation results verify the effectiveness of the proposed method. Under the guidance of trajectory tracking control technology, this type of manipulator has shown broad application prospects in many engineering fields such as seabed exploration, space exploration, repetitive operations, and emergency rescue.

[0191] The above description is only a specific implementation mode of the present invention, but the protection scope of the present invention is not limited thereto. Any modifications, equivalent substitutions and improvements made by any technician familiar with the technical field within the technical scope disclosed by the present invention and within the spirit and principle of the present invention should be covered by the protection scope of the present invention.

Claims

1. A fixed-time multi-link manipulator inverse dynamics robust control method, characterized by: The specific steps include: Step 1: Based on the dynamic behavior of the multi-link robotic arm, a dynamic model of the joint end of the multi-link robotic arm is established; according to the dynamic model of the joint end of the multi-link robotic arm and the predetermined trajectory of the angular displacement of each joint of the robotic arm system, the tracking error of the angular displacement of each joint of the robotic arm system is established; Step 2: Based on the URED algorithm that is stable in fixed time, a fixed time convergence term model and a robust term model of each joint of the robotic arm system are established, and the parameters of the fixed time convergence term model and the fixed time robust term model of each joint of the robotic arm system are set; Step 3: According to the fixed-time convergence term model and fixed-time robust term model of each joint of the robotic arm system established in step 2 and the dynamic model of the joint end of the multi-link robotic arm established in step 1, a robotic arm controller τ based on fixed-time robust term inverse dynamics control is established, and the fixed-time stability of the robotic arm controller τ is proved; Step 4: Input the robotic arm controller τ based on fixed-time robust term inverse dynamics control established in step 3 into the dynamic model of the multi-link robotic arm joint end established in step 1, and control the convergence time by debugging the parameters of the fixed-time convergence term model and the fixed-time robust term model set in step 2, so that the angular displacement tracking error of each joint of the robotic arm system established in step 1 is strictly reduced to zero within a fixed time.

2. The method for inverse dynamics robust control of a multi-link manipulator with a fixed time according to claim 1, characterized in that: The step 1 is specifically as follows: Step 1.1: Based on the dynamic behavior of the multi-link robotic arm, the multi-link robotic arm system is designed to contain four degrees of freedom. The dynamic model of the joint end of the multi-link robotic arm is defined by formula (1): Where θ represents the position vector of the joint, represents the joint velocity vector, represents the joint acceleration vector, M(θ) represents the joint space inertia matrix, represents the Coriolis and centripetal coupling matrices, G(θ) represents the gravity load, and τ represents the input torque; The four-dimensional parameters of the joint end of the multi-link robotic arm are defined as: Among them, I i (i=1,2,3,4) is the moment of inertia around the center of mass, and the distance between the center of rotation of each connecting rod and the end of the connecting rod is κ, m i is the mass of the ith connecting rod, d i is the mass center of the ith connecting rod, l i is the length of the ith link, θ i is the angle (position) of the ith joint, and is the acceleration due to gravity; p2=2[l1d2m2+l1l2(m3+m4)], p3=m3+m4, p4=m3+m4, p5=I4; Step 1.2: Based on the dynamic model of the joint end of the multi-link manipulator constructed in step 1.1, combined with the predetermined trajectory of the angular displacement of each joint of the manipulator system, the tracking error of the angular displacement of each joint of the manipulator system is defined by formula (3) and formula (4): e1=θ d -θ (3) definition The error dynamic equation of the multi-link manipulator is defined as: Among them, θ represents the position vector of the joint, θ d is the desired trajectory of the multi-link robot motor, and e1 is the tracking error between the joint trajectory and the desired trajectory.

3. The method for inverse dynamics robust control of a multi-link manipulator with a fixed time according to claim 1, characterized in that: The step 2 is specifically as follows: Step 2.1: The uniformly robust exact differentiator (URED) algorithm that is stable in fixed time is defined by equation (5): Among them, σ in formula (5) j (j=0,1) is a state variable, and f0(t) is bounded as f0(t)|<L, the function and The design is as follows: Among them, in formula (6) is a scalar, the parameter in formula (5) and Should be in the collection: According to the Uniformly Robust Exact Differentiator (URED) algorithm, states σ0 and σ1 are f The top converges to the origin uniformly; the convergence time t f Bounded to t f ≤T fmax , where T fmax is a positive constant and is independent of the initial states σ0(0) and σ1(0) in the Uniformly Robust Exact Differentiator (URED) algorithm; Step 2.2: Combined with the URED algorithm that is stable in fixed time in step 2.1, i.e., formula (5), a robust control algorithm is designed for the multi-link manipulator. The robust control algorithm is defined as: where the vector ξ = [ξ1,..., ξ n T ∈ R n , and the real number α > 0, φ1(ξ i ), φ2(ξ i )(i = 1, 2,..., n)​ Step 2.3: Fixed time convergence term model H(e1,e2)∈R for each joint of the robotic arm system n Defined as: Step 2.4: Based on the robust control algorithm designed in step 2.2 and combined with the fixed-time convergence term model of each joint in step 2.3, the fixed-time robust term model R(e1, e2) of each joint of the manipulator system is defined as: Among them, the parameters meet the conditions β1=2α1+1, By optimizing the parameters P1, P2, Q1, Q2, α1, k1, and k2, a closed-loop control system is formed to ensure that the robot arm can still achieve high-precision trajectory tracking when facing various uncertainties.

4. The method for inverse dynamics robust control of a multi-link manipulator with a fixed time according to claim 1, characterized in that: The step 3 is specifically as follows: Step 3.1: Based on the fixed-time convergence term model and robust term model of each joint of the manipulator system in step 2.3 and step 2.4, that is, on the basis of formula (9) and formula (10), the manipulator controller τ of the fixed-time robust term inverse dynamics control is defined as: Where θ represents the position vector of the joint, represents the joint velocity vector, represents the joint acceleration vector, M(θ) represents the joint space inertia matrix, represents the Coriolis and centripetal coupling matrices, G(θ) represents the gravity load, and τ represents the input torque; Step 3.2: Prove the fixed-time stability of the robot controller τ defined in step 3.1: Step 3.2.1: Substitute the inverse dynamics robust controller τ of the fixed-time multi-link manipulator, i.e., formula (11), into the error dynamic equation of the multi-link manipulator in step 1.2, i.e., formula (4), to obtain: Step 3.2.2: According to each control error e 1i (i=1,2,...,n) we get: Among them, H i (i=1,2,3,4) is the abbreviated form of the convergence model of each joint of the robotic arm system, R i (i=1,2,3,4) is the abbreviated form of the robust term model of each joint of the manipulator system, δ i is the uncertainty and the variable is a positive constant; Step 3.2.3: Replace the fixed time convergence model H of each joint of the robotic arm system in steps 2.3 and 2.4 i and the fixed-time robust term model R i Redefine as: Step 3.2.4: Set and According to formula (13) in step 3.2.2 and formula (14) in step 3.2.3, we get: Step 3.2.5: According to the uniformly robust exact differentiator (URED) algorithm described in step 2.1, if ω in step 3.2.4 0i =0 at fixed time The internal satisfaction and fixed time convergence can analyze the control error e 1i ; In the convergence period ω 0i In, e 1i The convergence stability of may be affected; therefore, the proof of the convergence of the entire dynamics considered below consists of two steps: In step 1, it is shown that 0i Before converging to zero, the control error e 1i is bounded; in step 2, we will prove that 0i After converging to zero, the control error e 1i Converges to zero in a fixed time, that is, e 1i = 0 is stable at a fixed time.

5. The method for inverse dynamics robust control of a multi-link manipulator with fixed time according to claim 2, characterized in that: In step 1.1, the four degrees of freedom of the multi-link robotic arm system are composed of three rotational joints and one sliding joint, and the coordinate systems of each joint established based on the DH representation are located at the connection points of each joint.

6. A fixed-time multi-link manipulator inverse dynamics robust control system, characterized by: include: Dynamic modeling module: This module builds the dynamic model of the joint end of the multi-link robotic arm based on the dynamic behavior of the multi-link robotic arm; According to the dynamic model of the joint end of the multi-link manipulator and the predetermined trajectory of the angular displacement of each joint of the manipulator system, the tracking error of the angular displacement of each joint of the manipulator system is established; Control algorithm design module: This module establishes the fixed-time convergence term model and the robust term model of each joint of the robotic arm system based on the URED algorithm that is stable in fixed time, and sets the parameters of the fixed-time convergence term model and the fixed-time robust term model of each joint of the robotic arm system; Controller implementation and verification module: This module establishes a robot controller τ based on fixed-time robust term inverse dynamics control based on the fixed-time convergence term model and fixed-time robust term model of each joint of the robot system and the dynamic model of the joint end of the multi-link robot, and proves the fixed-time stability of the robot controller τ; Parameter adjustment and optimization module: This module inputs the robot controller τ based on the fixed-time robust term inverse dynamics control into the dynamic model of the joint end of the multi-link robot arm, and controls the convergence time by debugging the parameters of the fixed-time convergence term model and the fixed-time robust term model, so that the angular displacement tracking error of each joint of the established robot arm system is strictly reduced to zero within a fixed time.

7. A fixed-time multi-link manipulator inverse dynamics robust control device, characterized in that: include: Memory: used for storing a computer program to implement the inverse dynamics control method of a multi-link manipulator with fixed-time robust control as claimed in any one of claims 1 to 5; Processor: used to implement the inverse dynamics control method of a multi-link robotic arm with fixed-time robust control as described in any one of claims 1 to 5 when executing the computer program.

8. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the steps of the inverse dynamics control method of a multi-link robotic arm with fixed-time robust control are implemented.