Anti-saturation self-adaptive fixed time sliding mode trajectory tracking control method for mechanical arm system
By combining anti-saturation technology and neural network technology, the anti-saturation adaptive fixed-time sliding mode tracking controller is designed, which solves the problems of vibration and steady-state performance of the robotic arm system under saturation constraints, and achieves fast response and high-precision tracking Tracking enhances system robustness.
Patent Information
- Application Number
- CN202410704772.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-06-03
- Publication Date
- 2024-11-01
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
The robotic arm system has problems with poor output jitter and steady-state performance under saturation constraints. The existing anti-saturation slip mode control method fails to fully consider system uncertainty and external interference, and the dynamic performance needs to be further improved.
Using the combination of non-singular terminal sliding mode control method based on anti-saturation technology and fixed-time tracking control method of neural network technology, an anti-saturation adaptive fixed-time sliding mode tracking controller is designed, and the non-singular terminal sliding mode surface and auxiliary control are used. The device handles the saturation problem and uses the neural network to approximate the composite uncertainty to construct an anti-saturation adaptive fixed-time sliding mode controller.
The system's fixed time trajectory tracking is realized, the response speed and control accuracy are improved, the singularity problem is avoided, the robustness of the robotic arm system is enhanced, and the convergence is converged to the zero error area in a short time.
Smart Images

Figure CN118884818A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to an anti-saturation adaptive fixed-time sliding mode trajectory tracking control method for a mechanical arm system, and belongs to the technical field of control engineering. Background Art
[0002] The robotic arm system is a nonlinear system that uses motors to drive joint rotation to achieve spatial positioning. However, due to power supply and technical limitations, the output torque of the joint motor is often limited. In actual engineering, saturation of the robotic arm actuator is inevitable. Once the saturation constraint is violated, it will seriously reduce the system performance and even endanger the system. Therefore, it is very necessary to consider the saturation constraint in the actual robotic arm system. At present, there have been some research results on the saturation constraint control problem of nonlinear systems. The methods to solve this type of problem are mainly based on the sliding mode control method based on anti-saturation technology and the fixed time tracking control method based on neural network technology.
[0003] The sliding mode control method based on anti-saturation technology can approximate the saturation constraint through the mean value theorem to ensure the stability of the entire system. At the same time, the sliding mode control has fast dynamic response performance. At present, the sliding mode control method based on anti-saturation technology has been applied to the manipulator drive system. This method solves the input saturation problem in the manipulator system, which has guiding significance for further research.
[0004] Fixed-time control method is an important control method. Compared with the finite-time control method, it can ensure that the convergence time of the system state is independent of the initial conditions and has a faster convergence speed. Therefore, the fixed-time control method has received widespread attention in the field of robotic arm control.
[0005] However, for the robotic arm system, although the sliding mode control method based on anti-saturation technology takes into account the impact of saturation constraints on the system, there is jitter in the output and the steady-state performance is poor; and the simple fixed-time tracking control method based on neural network technology does not fully consider the constraints of the robotic arm on comprehensive factors such as system uncertainty, external interference and saturation, and the dynamic performance of the system still needs to be further improved. Summary of the invention
[0006] The main purpose of the present invention is to: in view of the shortcomings and gaps in the prior art, the present invention provides an anti-saturation adaptive fixed-time sliding mode trajectory tracking control method for a robotic arm system, which fully utilizes the advantages of a non-singular terminal sliding mode control method based on anti-saturation technology and a fixed-time tracking control method based on neural network technology, and realizes the fixed-time trajectory tracking of the system on the premise that the saturation constraint conditions of the robotic arm system are not violated, thereby improving the response speed and ensuring a higher control accuracy.
[0007] In order to achieve the above objectives, an anti-saturation adaptive fixed-time sliding mode trajectory tracking control method for a robotic arm system studied in the present invention comprises the following steps:
[0008] S1: Establishing a dynamic model of an n-DOF manipulator, after giving the nominal part, uncertain part, input saturation and external disturbance of the dynamic model of the manipulator, transforming the dynamic model of the manipulator to obtain the transformed dynamic model of the n-DOF manipulator;
[0009] S2: Based on the error function of the robot model obtained in S1, a continuously differentiable nonlinear function is designed to construct a non-singular terminal sliding surface;
[0010] S3: Based on the non-singular terminal sliding surface constructed in S2, an auxiliary controller is designed to handle saturation.
[0011] S4: Based on the above content, an anti-saturation adaptive fixed-time sliding mode controller is designed to realize trajectory tracking control of the robotic arm system.
[0012] The trajectory tracking control method of the robotic arm system as described above is characterized in that the operation of S1 is specifically as follows:
[0013] Step 1-1: Establish the dynamic equation of the rigid robotic arm:
[0014]
[0015] In the formula is the joint position vector, is the velocity vector, is the acceleration vector, is the control torque vector, represents the inertia matrix, which is symmetric positive definite; is the centripetal force, the Coriolis matrix, represents the gravity term, represents the external disturbance vector.
[0016] Step 1-2: The parameters of the robot dynamics model are rewritten into the nominal part and the uncertain part, as shown below:
[0017]
[0018] Where H0(q), and G0(q) represent nominal values, ΔH(q), and ΔG(q) represent the uncertain parts respectively.
[0019] Construct the control input of saturation nonlinearity, the model is:
[0020]
[0021] To deal with the saturation problem, the saturation nonlinearity can be approximated by the following equation:
[0022]
[0023] where Δτ i (u i ) represents the approximate error and satisfies the following inequality relationship:
[0024]
[0025] Using the mean value theorem, we get the following equation:
[0026]
[0027] but
[0028]
[0029] In the formula 0<μ i <1. And satisfy the following relationship:
[0030]
[0031] Steps 1-3: System compounding uncertainty Including external disturbances and system uncertainties, it is defined as follows:
[0032]
[0033] The dynamic model of the robot arm is rewritten as follows:
[0034]
[0035] The trajectory tracking control method of the robotic arm system as described above is characterized in that the operation of S2 is specifically as follows:
[0036] For system (1), a non-singular fixed-time sliding surface is designed. The specific method is:
[0037] Step 2-1: Define the three tracking errors of the robot as follows:
[0038]
[0039] In the formula is the position error, is the speed error, is the acceleration error.
[0040] Step 2-2: Design the nonlinear function f(z according to step 2-11i ), as follows:
[0041]
[0042] In the formula represents the constant that needs to be designed, and Define the constant k p and k d for:
[0043]
[0044] f(z 1i ) is derived as follows:
[0045]
[0046] It should be pointed out that k p and k d The choice should ensure that When f(z 1i ) and its derivative is continuous.
[0047] k f |z 1i | and k h They are f(z 1i )and The bounds of k f and k h is a positive constant determined by the following two equations:
[0048]
[0049] Step 2-3: According to step 2-2, design the non-singular terminal sliding surface s as follows:
[0050] s=z2+B1F(z1)+B2Sig β (z1) (15)
[0051] Where B1 and B2 are two diagonal matrices, B1 = diag{b 11 , ..., b 1n}>0,B2=diag{b 21 , ..., b 2n}>0, β>1 indicates a defined positive constant. Sig β (z1) is |z 1i | β sign(z 1i ), i = 1, 2, ..., n, F(z1) = [f(z 11 ), ..., f(z 1n)] T .
[0052] The derivative of the non-singular terminal sliding surface s is as follows:
[0053]
[0054] The diagonal matrix is defined as
[0055] Y β-1 (z1)=diag{|z 11 | β-1 , ..., |z 1n | β-1} (17)
[0056] The trajectory tracking control method of the robotic arm system as described above is characterized in that the operation of S3 is specifically as follows:
[0057] Based on the sliding surface constructed by system (1) and S2, an auxiliary controller is designed to handle saturation, as shown below.
[0058] To deal with saturation, the following inequality is used:
[0059]
[0060] Where u = u1 + u2 is the actual controller, u1 is the non-singular terminal sliding mode controller, It is an auxiliary controller designed to handle saturation.
[0061] The trajectory tracking control method of the robotic arm system as described above is characterized in that the operation of S4 is specifically as follows:
[0062] Step 4-1: First, the fixed-time controller constructed needs to satisfy Lemma 1.
[0063] Lemma 1: Assume there is a chosen Lyapunov function So that the following inequality holds:
[0064]
[0065] Where θ>0, c>1, η>0, 0<d<1, ρ is a constant. The system is called practical fixed-time stable, and the convergence time T is guaranteed to satisfy the following inequality:
[0066]
[0067] Furthermore, the residual set of the system is as follows:
[0068]
[0069] Where 0<p<1 represents a constant.
[0070] Step 4-2: Based on S3 and step 4-1, the anti-saturation adaptive fixed-time sliding mode controller is designed as:
[0071]
[0072]
[0073] In the formula, the update law of the neural network is constructed as Λ 2i are the controller parameters, which are diagonal gain matrices, A constant to improve the robustness of the system, i=1, 2, ..., n.
[0074] Note that the function s / ||s|| contained in u2 will cause chattering when When you select Substitute s / ||s||, where is a normal number. It can be initially selected as a smaller constant and then adjusted according to the actual control situation.
[0075] The fixed-time stability of the adaptive fixed-time sliding mode controllers (22) and (23) against saturation is verified based on the Lyapunov function.
[0076] Compared with the prior art, the present invention has the following beneficial effects:
[0077] 1) The non-singular terminal sliding mode control method based on anti-saturation technology proposed in the present invention can improve the system response speed and solve the input saturation problem of the system at the same time;
[0078] 2) Compared with the finite time control scheme, the present invention designs a continuous fixed time sliding mode controller, which can ensure that the convergence time of the system state is independent of the initial conditions, and ensure that the angular position and angular velocity errors of the robot arm joint tracking converge to a small area close to zero within a short fixed time;
[0079] 3) The present invention makes full use of the advantages of neural network, non-singular terminal sliding mode and fixed time control method. The non-singular terminal sliding mode method provides faster trajectory tracking and effectively avoids the singularity problem. The neural network is used to approximate the composite uncertainty, and combined with the adaptive control technology related to the neural network, the influence of system uncertainty on the controller design is successfully eliminated, the robustness of the manipulator system is improved, and at the same time, it can ensure that the system has good dynamic performance and small steady-state error.
[0080] In order to make the above-mentioned objects, features and advantages of the present invention more obvious and easy to understand, the embodiments of the present invention are specifically cited below and described in detail with reference to the attached drawings. BRIEF DESCRIPTION OF THE DRAWINGS
[0081] In order to more clearly illustrate the technical solutions of the embodiments of the present invention, the drawings required for use in the embodiments are briefly introduced below. It should be understood that the following drawings only show certain embodiments of the present invention and therefore should not be regarded as limiting the scope. For ordinary technicians in this field, other related drawings can be obtained based on these drawings without creative work.
[0082] Figure 1 This is a structural block diagram of the control system of the present invention.
[0083] Figure 2 This is a block diagram of the two-degree-of-freedom robotic arm architecture for verifying the algorithm of the present invention.
[0084] Figure 3 This is the position tracking simulation curve under the anti-saturation adaptive fixed-time sliding mode controller of the present invention.
[0085] Figure 4 This is a simulation curve of position tracking error under the anti-saturation adaptive fixed-time sliding mode controller of the present invention.
[0086] Figure 5 This is the speed tracking simulation curve under the anti-saturation adaptive fixed-time sliding mode controller of the present invention.
[0087] Figure 6 It is the simulation curve of speed tracking error under the anti-saturation adaptive fixed-time sliding mode controller of the present invention.
[0088] Figure 7 This is the control input simulation curve of the anti-saturation adaptive fixed-time sliding mode controller of the present invention.
[0089] Figure 8 This is a simulation curve of the sliding mode function of the anti-saturation adaptive fixed-time sliding mode controller of the present invention.
[0090] Fig. 9 It is the position tracking error simulation curve under different initial conditions of the anti-saturation adaptive fixed-time sliding mode controller of the present invention. DETAILED DESCRIPTION
[0091] The present invention will be further described in detail below in conjunction with the accompanying drawings.
[0092] Take a robot with joint constraints n = 2 as an example. Figure 2As shown, the robot arm includes two links: the first link 1, the second link 2, and two constrained joints. The mass and length of the first link 1 are m1 and l1 respectively, and the mass and length of the second link 2 are m2 and l2 respectively; the moments of inertia of the first link 1 and the second link 2 are J1 and J2 respectively; q1 is the angular position of the first link 1, and q2 is the angular position of the second link 2. The counterclockwise direction is specified as the positive rotation direction of the robot arm.
[0093] The present invention provides an anti-saturation adaptive fixed-time sliding mode trajectory tracking control method for a robotic arm system. In order to enable the above-mentioned robotic arm to smoothly track a target trajectory, the method specifically comprises the following steps:
[0094] S1: Step 1-1: Establish the dynamic equations of the rigid manipulator:
[0095]
[0096] In the formula is the joint position vector, is the velocity vector, and are the angular velocity vectors of the first link 1 and the second link 2 respectively; is the acceleration vector, is the control torque vector, represents the inertia matrix, which is symmetric positive definite; is the centripetal force, the Coriolis matrix, represents the gravity term, represents the external interference vector. And:
[0097]
[0098] in, D 22 =0; G1 = (m1 + m2) l1g cos q1 + m2l2g cos (q1 + q2), G2 = m2l2g cos (q1 + q2), g is the acceleration due to gravity, g = 9.80665 m / s 2 .
[0099] Step 1-2: The parameters of the robot dynamics model are rewritten into the nominal part and the uncertain part, as shown below:
[0100]
[0101] Where H0(q), and G0(q) represent nominal values, ΔH(q), and ΔG(q) represent the uncertain parts respectively.
[0102] Construct the control input of saturation nonlinearity, the model is:
[0103]
[0104] To deal with the saturation problem, the saturation nonlinearity can be approximated by the following equation:
[0105]
[0106] where Δτ i (u i ) represents the approximate error and satisfies the following inequality relationship:
[0107]
[0108] Using the mean value theorem, we get the following equation:
[0109]
[0110] but
[0111]
[0112] In the formula 0<μ i <1. And satisfy the following relationship:
[0113]
[0114] Step 1-3: System (24) Compound Uncertainty Including disturbances and system uncertainties, it is defined as follows:
[0115]
[0116] The dynamic model of the robot arm is rewritten as follows:
[0117]
[0118] S2: For system (24), a non-singular fixed-time sliding surface is designed. The specific method is:
[0119] Step 2-1: Define the three tracking errors of the robot as follows:
[0120]
[0121] In the formula is the position error, is the speed error, is the acceleration error.
[0122] Step 2-2: Design the nonlinear function f(z according to step 2-11i ), as follows:
[0123]
[0124] In the formula represents the constant that needs to be designed, and i = 1, 2. Define constant k p and k d for:
[0125] f(z 1i ) is derived as follows:
[0126]
[0127] It should be pointed out that k p and k d The choice should ensure that When f(z 1i ) and its derivative is continuous. f |z 1i | and k h They are f(z 1i )and The bounds of k f and k h is a positive constant determined by the following two equations:
[0128]
[0129] Step 2-3: According to step 2-2, design a non-singular fixed-time sliding surface s as follows:
[0130] s=z2+B1F(z1)+B2Sig β (z1) (38)
[0131] Where B1 and B2 are two diagonal matrices, B1 = diag{b 11 , b 12}>0,B2=diag{b 21 , b 22}>0, β>1 indicates a defined positive constant. Sig β (z1) is |z 1i | β sign(z 1i ), i = 1, 2, F(z1) = [f(z 11 ), ..., f(z 1n )] T .
[0132] The derivative of the non-singular fixed-time sliding surface s is as follows:
[0133]
[0134] The diagonal matrix is defined as
[0135] Y β-1 (z1)=diag{|z 11 | β-1 ,|z 12 | β-1} (40)
[0136] S3: The sliding surface constructed based on system (24) and S2 is designed as an auxiliary controller to handle saturation, as shown below.
[0137] To deal with saturation, the following inequality is used:
[0138]
[0139] Where u = u1 + u2 is the actual controller, u1 is the non-singular terminal sliding mode controller, It is an auxiliary controller designed to handle saturation.
[0140] S4: Step 4-1: The fixed-time controller constructed first needs to satisfy Lemma 2.
[0141] Lemma 2: Assume there is a chosen Lyapunov function So that the following inequality holds:
[0142]
[0143] Where θ>0, c>1, η>0, 0<d<1, ρ is a constant. The system is called practical fixed-time stable, and the convergence time T is guaranteed to satisfy the following inequality:
[0144]
[0145] Furthermore, the residual set of the system is as follows:
[0146]
[0147] Where 0<p<1 represents a constant.
[0148] Step 4-2: Based on S3 and step 4-1, the anti-saturation adaptive fixed-time sliding mode controller is designed as:
[0149]
[0150]
[0151] In the formula, the update law of the neural network is constructed as Λ 2i are the controller parameters, which are diagonal gain matrices, To improve the system robustness, i=1,2.
[0152] Note that the function s / ||s|| contained in u2 will cause chattering when When you select Substitute s / ||s||, where is a normal number. It can be initially selected as a smaller constant and then adjusted according to the actual control situation.
[0153] For an n-link robotic arm system (24) with input saturation, external disturbance and parameter uncertainty, the designed anti-saturation adaptive fixed-time sliding mode controller and non-singular fixed-time sliding mode surface have the following properties: the use of the designed anti-saturation adaptive fixed-time sliding mode controller (45) and (46) can achieve global fixed-time stability, ensuring that the actual trajectory can quickly track the reference trajectory within a fixed time and has high control accuracy.
[0154] Proof: First, consider the following Lyapunov function:
[0155]
[0156] Taking the derivative of formula (47), we can get:
[0157]
[0158] Substituting equations (33), (45) and (46) into equation (48), we can obtain:
[0159]
[0160] Further we get:
[0161]
[0162] Considering lV1=||s|| 2 And formula (47), we can get:
[0163]
[0164] Substituting equation (51) into equation (50), we get the following inequality:
[0165]
[0166] Defining weight error And choose the following Lyapunov function:
[0167]
[0168] Taking the derivative of V4, we can get:
[0169]
[0170] According to Young's inequality, the following inequality holds:
[0171]
[0172]
[0173]
[0174]
[0175]
[0176] Therefore, the resulting inequality is as follows:
[0177]
[0178] The new Lyapunov function is defined as follows:
[0179] V3=V1+V2 (61)
[0180] Further we can get the following formula:
[0181]
[0182]
[0183]
[0184] Where n is ψ i The number of, ρ1 and ρ2 can be expressed as:
[0185]
[0186] According to Lemma 2, s and The settling time of a component is determined by the following formula:
[0187]
[0188] The set of converged residuals is:
[0189]
[0190] In summary, the system has practical fixed-time stability, i.e. Finally, you can 2max Converges to a compact set Ω in time x Note that actual fixed-time stability means that the state variables can reach the residual set, while fixed-time stability means that the state variables converge to the origin in a fixed time.
[0191] The present invention is further described below with a preferred embodiment.
[0192] Figure 2 The parameters of the robot system shown are as follows: m1 = 0.5 kg, m2 = 1.0 kg, l1 = 1.0 m, l2 = 0.8 m, J1 = 4.0 kg.m 2 , J2=4.0kg.m 2 The mass of joint 1 is defined as The mass of joint 2 is Where Δm1∈[-0.1, 0.1] and Δm2∈[-0.2, 0.2] are random numbers. Similarly, the inertia of joint 1 is defined as The inertia of joint 2 is Where ΔJ1∈[-0.8, 0.8] and ΔJ2∈[-0.8, 0.8] are also random numbers.
[0193] Based on the above system parameters, the system simulation conditions are:
[0194] The initial conditions of the robot are: q1(0) = 1.6, q2(0) = 1.1, The target trajectory to be tracked is: q d =[q d1 ,q d2 ] T =[1.25-1.4e -t +0.35e -4t , 1.25+e -t +0.25e -4t ] T , where t∈(0,5s).
[0195] In order to verify the anti-saturation adaptive fixed-time sliding mode control strategy proposed in this invention, the parameters are set as follows: α=0.7, β=1.9, r=1.7, B1=B2=diag{5,5},λ max (Γ) = 0.72. In addition, the actuator has an upper bound and the saturation threshold is set to τ max =[-260, 260] T Nm. 21 =10I 256×256 , Λ 22=10I 256×256 The basis function ψ T S(Θ) contains 2 8 nodes, and the width value is 20.
[0196] According to the above simulation conditions, the system is simulated to verify the trajectory tracking capability of the system.
[0197] Figure 1 This is a structural block diagram of the control system of the present invention. Figure 2 This is a block diagram of the two-degree-of-freedom robotic arm architecture for verifying the algorithm of the present invention. Figure 3 The actual positions q1 and q2 track the reference trajectory q under the anti-saturation adaptive fixed-time sliding mode controller of the present invention. 1d and q 2d The simulation curve. Figure 4 The actual positions q1 and q2 track the reference trajectory q under the anti-saturation adaptive fixed-time sliding mode controller of the present invention. 1d and q 2d Simulation curve of error. Figure 5 is the actual angular velocity under the anti-saturation adaptive fixed-time sliding mode controller of the present invention and Tracking reference angular velocity and The simulation curve. Figure 6 is the actual angular velocity under the anti-saturation adaptive fixed-time sliding mode controller of the present invention and With reference angular velocity and Simulation curve of tracking error. Figure 3-Figure 6 It can be seen that the actual position of the system can quickly track the desired reference trajectory. In addition, the position and angular velocity tracking errors of the manipulator converge to the origin after a short time.
[0198] Figure 7 This is the control input simulation curve of the anti-saturation adaptive fixed-time sliding mode controller of the present invention. It can be seen from the figure that this method can obviously avoid violating the saturation constraint and effectively suppress chattering.
[0199] Figure 8 This is a simulation curve of the sliding mode function in the anti-saturation adaptive fixed-time sliding mode controller of the present invention. The sliding surface variable reaches a small residual set near the origin within a fixed time.
[0200] Fig. 9 This is the position tracking error simulation curve under different initial conditions of the anti-saturation adaptive fixed-time sliding mode controller of the present invention. The initial value is set to q(0) = [1.8, 1] T , q(0) = [3, 2] T, q(0) = [2, 1.5] T , other design parameters remain unchanged. It can be seen that even if the initial conditions increase, the convergence time of the adaptive fixed-time sliding mode scheme proposed in the present invention remains unchanged.
[0201] The above results show that the anti-saturation adaptive fixed-time sliding mode scheme proposed in the present invention can achieve fast convergence while avoiding the singularity problem, has good tracking accuracy, and is highly robust to interference and system uncertainty.
[0202] Of course, the above description is not a limitation of the present invention, and the present invention is not limited to the above examples. Changes, modifications, additions or substitutions made by technicians in this technical field within the essential scope of the present invention should also fall within the protection scope of the present invention.
Claims
1. An anti-saturation adaptive fixed-time sliding mode trajectory tracking control method for a robotic arm system, characterized in that: It includes the following steps: S1: Establish the dynamic model of an n - degree - of - freedom manipulator. After presenting the nominal part, uncertain part, input saturation, and external disturbances of the manipulator dynamic model, perform a formal transformation on the manipulator dynamic model to obtain the transformed n - degree - of - freedom manipulator dynamic model; S2: According to the error function of the manipulator model obtained in S1, design a continuously differentiable non - linear function, thereby constructing a non - singular terminal sliding mode surface; S3: Based on the non - singular terminal sliding mode surface constructed in S2, design an auxiliary controller for dealing with saturation; S4: Based on the above, design an anti - saturation adaptive fixed - time sliding mode controller to achieve trajectory tracking control of the manipulator system.
2. The trajectory tracking control method of the robotic arm system according to claim 1, characterized in that: The operation of S1 is specifically as follows: Step 1 - 1: Establish the dynamic equation of the rigid manipulator: In the formula is the joint position vector, is the velocity vector, is the acceleration vector, is the control torque vector, represents the inertia matrix, which is symmetric positive definite; is the centripetal force, the Coriolis matrix, represents the gravity term, represents the external disturbance vector. Step 1 - 2: Rewrite the parameters of the manipulator dynamic model into the nominal part and the uncertain part, which are expressed as follows: Where H0(q), and G0(q) represent nominal values, ΔH(q), and ΔG(q) represent the uncertain parts respectively. Construct a saturated non - linear control input, and the model is: To deal with the saturation problem, the saturated non - linearity can be approximated by the following formula: where Δτ i (u i ) represents the approximate error and satisfies the following inequality relationship: Using the mean - value theorem, the following equation is obtained: Then In the formula And satisfy the following relationship: Steps 1-3: System compounding uncertainty Including external disturbances and system uncertainties, it is defined as follows: The manipulator dynamic model is rewritten in the following form:
3. The trajectory tracking control method of the robotic arm system according to claim 1, characterized in that: The operation of S2 is specifically as follows: For system (1), design a non - singular fixed - time sliding mode surface. The specific method is: Step 2 - 1: Define the following three tracking errors of the manipulator: In the formula is the position error, is the speed error, is the acceleration error. Step 2-2: Design the nonlinear function f(z according to step 2-1 1i ), as follows: In the formula represents the constant that needs to be designed, and Define the constant k p and k d for: f(z 1i ) is derived as follows: It should be pointed out that k p and k d The choice should ensure that When f(z 1i ) and its derivative is continuous. f |z 1i | and k h They are f(z 1i )and The bounds of k f and k h is a positive constant determined by the following two equations: Step 2 - 3: According to Step 2 - 2, design the non - singular terminal sliding mode surface s as follows: s=z2+B1F(z1)+B2Sig β (z1) (15) Where B1 and B2 are two diagonal matrices, B1 = diag{b 11 , ..., b 1n }>0, B2=diag{b 21 , ..., b 2n }>0, β>1 indicates a defined positive constant. Sig β (z1) is |z 1i | β sign(z 1i ), i = 1, 2, ..., n. F(z1) = [f(z 11 ),…,f(z 1n )] T . Take the derivative of the non - singular terminal sliding mode surface s as follows: The diagonal matrix is defined as 4. The trajectory tracking control method of the robotic arm system according to claim 1, characterized in that: The operation of S3 is specifically as follows: Based on system (1) and the sliding mode surface constructed in S2, design an auxiliary controller for dealing with saturation, which is specifically as follows. To deal with the saturation problem, the following inequality needs to be used: Where u = u1 + u2 is the actual controller, u1 is the non-singular terminal sliding mode controller, It is an auxiliary controller designed to handle saturation.
5. The trajectory tracking control method of the robotic arm system according to claim 1, characterized in that: The operation of S4 is specifically as follows: Step 4 - 1: First, the constructed fixed - time controller needs to satisfy Lemma 1. Lemma 1: Assume there is a chosen Lyapunov function So that the following inequality holds: Where θ>0, c>1, η>0, 0<d<1, and ρ is a constant. The system is then called actually fixed - time stable, and the convergence time T satisfies the following inequality: In addition, the residual set of the system is as follows: Where 0<p<1 represents a constant. Step 4 - 2: Based on S3 and Step 4 - 1, design the anti - saturation adaptive fixed - time sliding mode controller as: In the formula, the update law of the neural network is constructed as Λ 2i are the controller parameters, which are diagonal gain matrices, A constant to improve the robustness of the system, i=1, 2, ..., n. Note that the function s / ||s|| contained in u2 will cause chattering when When you select Substitute s / ||s||, where is a normal number. It can be initially selected as a smaller constant and then adjusted according to the actual control situation. Verify the fixed - time stability of the anti - saturation adaptive fixed - time sliding mode controllers (22) and (23) based on the Lyapunov function.
Citation Information
Patent Citations
Sliding form control method of flexible joint mechanical arm based on disturbance observer
CN102591207A
Neural network full order slip form control method for mechanical arm servo system
CN104932271A
Uncertain mechanical arm fixed time track following control method with input saturation
CN111152225A
Mechanical arm input saturation fixed time trajectory tracking control method and system
CN111496792A
Mechanical arm global fixed time trajectory tracking sliding mode control method
CN116339141A
Cited By
Self-adaptive fixed-time motion control method for mobile mechanical arm based on delay observer
CN119535969A
Integral terminal sliding mode trajectory tracking control method based on radial basis function neural network
CN120056101A
Mechanical arm anti-interference and fault-tolerant control method based on fixed time expansion state observer
CN120269569A
Theoretical control method for mechanical arm state constraint fixed time all-wheel-drive system
CN121223768A
Mechanical arm system fixed time tracking control method and system under random interference
CN121468588A
