Rigid robot mechanical arm angular position tracking control method

By establishing a state space model and designing a self-triggered adaptive fault-tolerant controller, the tracking and control problems caused by actuator failure and model uncertainty of the robotic arm are solved, and the precise tracking of the angle position of the robotic arm and the improvement of system stability are achieved.

CN118876044AActive Publication Date: 2024-11-01TIANJIN POLYTECHNIC UNIV

Patent Information

Application Number
CN202410000856.2
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-01-02
Publication Date
2024-11-01
Estimated Expiration
2044-01-02

AI Technical Summary

Technical Problem

During long-term high-precision operations, the tracking control effect is poor due to actuator failure and system model uncertainty, high computing requirements and waste of communication resources, resulting in inaccurate tracking data.

Method used

By establishing a state space model, designing funnel conversion functions and self-triggered adaptive fault-tolerant controllers, the output voltage is adjusted to achieve accurate tracking of angular positions, and avoiding tracking errors exceeding the funnel boundary.

Benefits of technology

It realizes accurate tracking of the angle position of the robotic arm when communication resources are constrained, improves computing efficiency and system stability, reduces the accumulation of tracking errors, and improves tracking accuracy.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118876044A_ABST
    Figure CN118876044A_ABST
Patent Text Reader

Abstract

The invention relates to the technical field of rigid robot control, in particular to an angular position tracking control method for a mechanical arm of a rigid robot, which can effectively solve the problems that communication resources of the rigid robot are wasted and the rigid robot is easily influenced by actuator faults and dead zone constraints, and ensures that the mechanical arm of the rigid robot realizes accurate angular position tracking.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the technical field of rigid robot control, and in particular to a rigid robot mechanical arm angular position tracking control method. Background Art

[0002] The robotic arm is the main component of the robot. It is a complex system with high precision, multi-input and multi-output, high nonlinearity and strong coupling that can automatically complete some repetitive tasks according to control signals. As an important part of the modern automation industry, the robotic arm is flexible, efficient, accurate and reliable in operation, and has been widely used and promoted in the fields of manufacturing and medical treatment.

[0003] However, due to interference factors such as the environment in which the robot is located and the uncertainty of the system model, the robot often fails to make correct instructions. On the one hand, after long-term, high-precision continuous operation, the actuator of the robot will fail due to aging of some components or external interference, resulting in unsatisfactory tracking control effects; on the other hand, since the communication between the actuator and the control device in the robot system is continuous, this means that tracking control needs to be calculated and run in real time, which not only puts forward higher computing power and storage capacity requirements on the computer, but also causes system structure wear and waste of communication resources, which leads to problems such as poor tracking effects and inaccurate tracking data of the robot. Summary of the invention

[0004] The purpose of the present invention is to provide a method for tracking and controlling the angular position of a rigid robot manipulator.

[0005] The technical solution of the present invention is as follows:

[0006] The present invention provides a rigid robot mechanical arm angular position tracking control method, comprising the following steps:

[0007] Step 1: Taking the robot arm angular position, robot arm angular velocity and armature current as state quantities, and considering the influence of actuator failure and dead zone constraint, a state space model of the rigid robot arm driven by a DC motor is established;

[0008] Step 2: Design a funnel transfer function and a command filter for the state space model, and obtain an error system model through equivalent coordinate transformation based on the funnel variables and the command filter output;

[0009] Step 3: Under the condition of limited communication resources, considering the error system model, using Lyapunov stability theory and backstepping technology, a self-triggered adaptive fault-tolerant controller is designed;

[0010] Step 4: By adjusting the design parameters in the self-triggering adaptive fault-tolerant controller in step 3, the output voltage of the DC motor is controlled so that the tracking error does not exceed the funnel boundary, thereby achieving accurate tracking of the angular position of the rigid robot arm.

[0011] As a preferred solution of the present invention, the state space model of the rigid robot arm driven by the DC motor in step 1 is:

[0012]

[0013] Among them, q, are the angular position and angular velocity of the robot arm, I is the armature current, V e is the DC motor output voltage, J, K r , m, L o , M o , R o ,L,R,K B , B0 are the nominal values ​​of moment of inertia, electromechanical conversion coefficient, connecting rod mass, connecting rod length, load mass, load radius, armature inductance, armature resistance, back electromotive force coefficient and viscous friction coefficient at the joint. m represents the model uncertainty in the rigid robot manipulator control system. Considering the influence of actuator failure and dead zone constraint, the output voltage expression is Among them, π k is the unknown sensitivity parameter of the kth actuator, v k , is the unknown dead zone constraint parameter, u dk The input torque for control.

[0014] As a preferred embodiment of the present invention, the specific process of step 2 is as follows:

[0015] Step 2.1, based on the state space model established in step 1, define q = x1, I=x3, and we can get the following derivative:

[0016]

[0017] in,

[0018] Step 2.2, define the angular position tracking error e1 = x1-x d , where x d is the angular position reference trajectory. The funnel transfer function and command filter are designed as follows:

[0019]

[0020]

[0021] x i,c (0) = α i (0), i = 1, 2,

[0022] Among them, e1 is the angular position tracking error, z1 is the angular position related error variable, is the funnel boundary, is the adjustable parameter of the funnel boundary, a1 is the convergence rate of the funnel boundary, α i is the virtual control input signal, x i,c is the output signal of the command filter, τ i * is the filter gain, x i,c (0) and α i (0) are the initial values ​​of the command filter state and the virtual control input signal, respectively, and t is time.

[0023] Step 2.3, based on the designed funnel conversion function and command filter, perform the following equivalent coordinate transformation:

[0024]

[0025] Among them, z1, z2, z3 are the error variables related to angular position, angular velocity and armature current, ξ1, ξ2, ξ3 are error compensation signals, v1, v2, v3 are the compensation tracking errors of angular position, angular velocity and armature current, respectively, α 1,c , α 2,c is the command filter output.

[0026] As a preferred embodiment of the present invention, the specific process of step 3 is:

[0027] Step 3.1, based on step 2.3, construct the Lyapunov function:

[0028]

[0029] Among them, η K , η P , Γ1, Γ2 are positive design parameters, is the neural network weight error, is the parameter estimation error.

[0030] Step 3.2, design virtual control input signal:

[0031]

[0032] Among them, k1, k2, k3, and l1 are positive design parameters.

[0033] Step 3.3, design error compensation signal:

[0034]

[0035] Step 3.4, design a self-triggered adaptive fault-tolerant controller:

[0036]

[0037] Among them, u ck is the input signal for the kth controller, is the estimated vector of K, K = [K1, K 21 , K 22 ] T is the unknown vector containing fault information, ∏=[∏1,∏ 21 ,∏ 22 ] T is the control input signal vector in the dynamic model, ∏1=α3, ∏ 21 =∏ 22 =1, α3 is the virtual control input signal. k is the dead zone constraint slope of the kth actuator. π k is the unknown sensitivity parameter of the kth actuator. Based on the adaptive fault-tolerant controller, a continuous input signal ω(t) is constructed:

[0038]

[0039] Where ω(t) is the continuous control input signal, s G , ι and s m Design parameters for self-triggering.

[0040] Step 3.5, according to the rigid robot manipulator angular position tracking control method of claim 1, characterized in that the continuous control input signal satisfies u dk (t) is t k The actual input of the rigid robot manipulator control system at time s G 、s D and Λ is the self-triggering design parameter, t k The derivative of the continuous control input ω(t) at time t∈[t k , t k+1 ),u dk (t) = ω(t k ), t is time, t k Indicates the time when the controller is triggered for the kth time, t k+1 is the time when the controller is triggered for the k+1th time, [t k , tk+1 ) is the time interval between the controller's k+1th self-triggering and the kth self-triggering. The design parameter adaptive law includes the controller parameter adaptive law Dead zone parameter adaptive law and the adaptive law of neural network weight update The expressions are:

[0041]

[0042]

[0043]

[0044] Among them, η K , m K , η P , m P , Γ, σ are positive design parameters. As a preferred embodiment of the present invention, the specific process of step 4 is:

[0045] Step 4.1, adjust the parameters so that The derivative of the Lyapunov function is guaranteed to be negative definite outside the residual set.

[0046] Step 4.2, by proving that the Lyapunov function is bounded, the boundedness of the error variable related to the angular position is obtained, and then the output voltage of the permanent magnet brushed motor is controlled so that the tracking error does not exceed the funnel boundary, thereby achieving accurate tracking of the angular position of the rigid robot arm.

[0047] The beneficial effects of the present invention are:

[0048] The present invention provides a rigid robot arm angular position tracking control method, which takes into account the modeling uncertainty, input dead zone and actuator failure in the system, and controls the output voltage of the DC motor so that the tracking error does not exceed the funnel boundary, thereby achieving accurate tracking of the angular position of the rigid robot arm.

[0049] The present invention provides a method for tracking the angular position of a rigid robot arm. Compared with the existing time-triggered control and periodic-triggered control, the self-triggering mechanism designed in the present invention avoids unnecessary calculations and improves calculation efficiency. The system response speed is faster, making the system more stable and reliable. While achieving high-performance tracking, it avoids frequent updates of control inputs, reduces the accumulation of tracking errors, and improves the tracking accuracy of the system. Compared with the existing event-triggered control, the self-triggering mechanism designed in the present invention does not need to monitor whether the tracking error meets the triggering conditions at all times, and the next triggering time only depends on the state information of the current triggering time, which further saves communication resources. At the same time, the constant s is introduced. ΛAvoid long-term stagnation of controller updates, thus improving the transient performance of the system.

[0050] The present invention provides a method for tracking the angular position of a rigid robot arm, which improves the transient performance of the system and overcomes the influence of model uncertainty on the system by introducing a funnel conversion function and a radial basis neural network function. On the one hand, the present invention generalizes the system applied by the traditional self-triggering control to the system with actuator failure and dead zone constraints, ensuring that such a system can operate stably within the triggering interval; on the other hand, the radial basis neural network function is introduced to achieve the approximation of the model uncertainty in the system, thereby enhancing the robustness of the system. BRIEF DESCRIPTION OF THE DRAWINGS

[0051] By reading the detailed description of the preferred embodiments below, the scheme and advantages of the present invention will become clear to those of ordinary skill in the art. The accompanying drawings are only used to illustrate the preferred embodiments and are not considered to be limiting of the present invention. In the accompanying drawings, case 1 is that the rigid robot manipulator system has actuator fault compensation and funnel transfer function constraints; case 2 is that the rigid robot manipulator system does not have actuator fault compensation; case 3 is that the rigid robot manipulator system does not have funnel transfer function constraints. The specific description is as follows:

[0052] Figure 1 is a control block diagram of the rigid robot mechanical arm of the present invention;

[0053] Figure 2 The tracking error curve e1 and the reference signal curve y of 0s-20s in case 1 and case 2 of the present invention are d Schematic diagram;

[0054] Figure 3 The tracking error curve e1 and the reference signal curve y of 0s-20s in case 1 and case 3 of the present invention are d Schematic diagram;

[0055] Figure 4 The angular position attitude curve x1 and the reference signal curve y of the present invention are as follows: d Schematic diagram;

[0056] Figure 5 This is a schematic diagram of an actual control input curve based on self-triggering control for a period of 0s-20s in the present invention;

[0057] Figure 6 This is the parameter adaptive law curve of 0s-20s in the present invention. DETAILED DESCRIPTION

[0058] Reference will now be made in detail to embodiments of the invention, examples of which are illustrated in the accompanying drawings.

[0059] A rigid robot arm angular position tracking control method, the specific steps are as follows:

[0060] Step 1: Taking the robot arm angular position, robot arm angular velocity and armature current as state quantities, and considering the influence of actuator failure and dead zone constraint, a state space model of the rigid robot arm driven by a DC motor is established;

[0061] Step 2: Design a funnel transfer function and a command filter for the state space model, and obtain an error system model through equivalent coordinate transformation based on the funnel variables and the command filter output;

[0062] Step 3: Under the condition of limited communication resources, considering the error system model, using Lyapunov stability theory and backstepping technology, a self-triggered adaptive fault-tolerant controller is designed;

[0063] Step 4: By adjusting the design parameters in the self-triggering adaptive fault-tolerant controller in step 3, the output voltage of the DC motor is controlled so that the tracking error does not exceed the funnel boundary, thereby achieving accurate tracking of the angular position of the rigid robot arm.

[0064] Step 1:

[0065] Based on the dynamic model of the rigid robot manipulator, a rigid robot manipulator control system with model uncertainty, actuator failure and dead zone constraints is constructed. According to the balance equation of armature voltage and torque balance equation, the following state space model is established:

[0066]

[0067] Among them, q, are the angular position and angular velocity of the robot arm, I is the armature current, V e is the DC motor output voltage, J, K τ , m, L o , M o , R o ,L,R,K B , B0 are the nominal values ​​of moment of inertia, electromechanical conversion coefficient, connecting rod mass, connecting rod length, load mass, load radius, armature inductance, armature resistance, back electromotive force coefficient and viscous friction coefficient at the joint, and t is time. m represents the model uncertainty in the rigid robot manipulator control system. Considering the influence of actuator failure and dead zone constraint, the output voltage expression is Among them, π k is the unknown sensitivity parameter of the kth actuator, vk , is the unknown dead zone constraint parameter, u dk The input torque for control.

[0068] Let J = 1.625 × 10 -3 Kg·m 2 , m=0.506Kg, M o =0.434Kg, L o =0.305m, R o =0.023m, G=9.8N / Kg, B o =16.25×10 -3 N·m·s / rad,K r =0.90N·m / A,π k =0.8. m represents the model uncertainty in the rigid robot manipulator control system, The above parameter values ​​are empirical data, which are widely used and have high modeling accuracy.

[0069] Step 2:

[0070] Based on the state space model established in step 1, define q = x1, I=x3, and we can get the following derivative:

[0071]

[0072] in, Define the angular position tracking error e1 = x1-x d , where x d (t) is the angular position reference trajectory. The funnel transfer function and command filter are designed as follows:

[0073]

[0074]

[0075]

[0076] Wherein, z1 is the error variable related to the angular position, e1 is the position tracking error, is the funnel boundary, is the adjustable parameter of the funnel boundary, a1 is the convergence rate of the funnel boundary, α i is the virtual control input signal of the dynamic model, x i,c is the output signal of the command filter, τ i * is the filter gain, x i,c (0) and α i(0) are the initial value of the command filter state and the initial value of the control input signal of the dynamic model respectively. Based on the designed funnel conversion function and command filter, the following equivalent coordinate transformation is performed:

[0077]

[0078] Among them, z1, z2, z3 are the error variables related to angular position, angular velocity and armature current, ξ1, ξ2, ξ3 are error compensation signals, v1, v2, v3 are the compensation tracking errors of angular position, angular velocity and armature current, respectively, α 1,c , α 2,c is the command filter output.

[0079] Step 3:

[0080] The angular position tracking control of traditional rigid robot manipulator systems requires that the tracking error of the target trajectory must be limited to a constraint boundary. However, due to actuator failures and dead-zone constraints in the system, the tracking error may violate the performance boundary when a failure occurs, resulting in singular phenomena and causing the traditional control algorithm to fail.

[0081] To solve this technical problem, the funnel transfer function is introduced to make the system have good transient performance; in addition, the self-triggering adaptive fault-tolerant controller is designed by using Lyapunov theory and backstepping technology to ensure that the angular position tracking error of the system will not violate the performance boundary when a fault occurs, so that the system has good steady-state performance and greatly saves communication resources. The specific operation process of step 3 is as follows:

[0082] Derivative of the error variable related to the angular position yields:

[0083]

[0084] in, Construct the following candidate Lyapunov function V1:

[0085]

[0086] Taking the derivative of V1, we get:

[0087]

[0088] Young's inequality is:

[0089]

[0090] Where a, b, p, q are all positive real numbers and satisfy The Young's inequality in the present invention is used to deal with the strong coupling terms, neural network weights and other nonlinear terms existing in the rigid robot arm control system, so that the control mechanism design of the rigid robot arm control system is simplified and a more accurate error tracking range is obtained.

[0091] Design the virtual control signal and error compensation signal as follows:

[0092]

[0093]

[0094] Substitute the above formula into the candidate Lyapunov function derivative In the example, we can further expand and shrink the Young's inequality to obtain:

[0095]

[0096] The candidate Lyapunov function V1 is combined with the error variable related to the angular velocity and the neural network weight estimation to construct the following candidate Lyapunov function V2:

[0097]

[0098] Among them, Γ1 is a positive design parameter, is the neural network weight error, The radial basis neural network is used to extract, classify, and approximate the model uncertainty, actuator failure, and dead zone constraint in the system, map the system model data, and simplify the data processing. The adaptive neural network tracking controller is used in the radial basis neural network to facilitate the rapid calculation and processing of the radial basis neural network in the rigid robot manipulator system.

[0099] Taking the derivative of the candidate Lyapunov function V2, we get:

[0100]

[0101] Design the following virtual control signal, error compensation signal and adaptive law for updating neural network weights:

[0102]

[0103]

[0104]

[0105] Substitute the above formula into the candidate Lyapunov function In the example, we can further expand and shrink the Young's inequality to obtain:

[0106]

[0107] Among them, k2 and σ1 are the controller and neural network gains respectively, ι 1m Estimation error for neural network weights.

[0108] The candidate Lyapunov function V2 is combined with the armature current related error variable, neural network weight estimation, and adaptive parameter estimation to construct the following Lyapunov function V3:

[0109]

[0110] Among them, Γ2, η P , η K is a positive design parameter, is the neural network weight error, Estimation of neural network weights. is the parameter estimation error, is the adaptive parameter estimate.

[0111] When t∈[t k , t k+1 ), the derivative of the Lyapunov function V3 is:

[0112]

[0113] Design the following self-triggering mechanism:

[0114] u dk (t) = ω(t s ),

[0115]

[0116] It can be seen that when t∈[t k , t k+1 ), we have |ω(t)-u dk (t)|≤s G |u dk (t)|+s D Established. Let φ1(t s )=φ2(t s )=0,φ1(t s+1 )=φ2(t s+1 )=±1 and |φ1(t)|≤1, |φ2(t)|≤1, make Established. Construct a continuous input signal ω(t):

[0117]

[0118] Where ω(t) is the continuous control input signal, sG , ι and s m Design parameters for self-triggering.

[0119] Substitute the continuous input signal into u dk Win:

[0120]

[0121] Design a self-triggered adaptive fault-tolerant controller:

[0122]

[0123] Among them, u ck is the input signal for the kth controller, is the estimated vector of K, K = [K1, K 21 , K 22 ] T is the unknown vector containing fault information, ∏=[∏1,∏ 21 ,∏ 22 ] T is the control input signal vector in the dynamic model, Π1=α3, Π 21 =∏ 22 =1, α3 is the virtual control input signal. k is the dead zone constraint slope of the kth actuator. π k is the unknown sensitivity parameter of the kth actuator.

[0124] will u ck Substitution Win:

[0125]

[0126] Design the following virtual control signal, error compensation signal, neural network weight update adaptive law and parameter adaptive law:

[0127]

[0128] Among them, k3, σ2, m K , m P , l1 is a positive design parameter. Substituting the above formula into In combination with Young's inequality, we can further expand and shrink it to get:

[0129]

[0130] in

[0131] Integrating the above formula gives:

[0132]

[0133] According to Lyapunov function theory, we know that V3,v i (i=1, 2, 3), is bounded, so x1, x2, x3, ξ1, ξ2, ξ3 are bounded, and further we get α1, α2, α3, u ck ,ω,u dk is bounded, so all signals in the closed-loop system are bounded; on the other hand, the continuous control input signal satisfies where u dk t k The actual input of the rigid robot arm control system at this moment, t k The derivative of the continuous control input ω(t) at time t. is bounded, so t k+1 -t k >0, thus avoiding Zeno behavior.

[0134] By introducing a self-triggering mechanism into the system and designing a continuous control input signal to meet the self-triggering condition, the number of updates and calculations of the control mechanism state can be effectively reduced, system resources can be saved, and the reliability and stability of the control system can be improved. Compared with the traditional event-triggered control scheme, the self-triggering mechanism directly calculates the next triggering moment through the information at the current moment, avoiding the problem of the controller reacting too frequently. In addition, by introducing the constant s Λ It is used to control the trigger interval to avoid the problem of system performance degradation due to long-term stagnation of controller updates.

[0135] In order to verify the effectiveness of the angular position tracking control method of a rigid robot arm proposed in the present invention, the rigid robot arm system with modeling uncertainty and actuator fault input dead zone is considered, and compared with the case without actuator fault compensation and funnel transfer function constraint. In the accompanying drawings, case one is that the rigid robot arm system has actuator fault compensation and funnel transfer function constraint; case two is that the rigid robot arm system does not have actuator fault compensation; case three is that the rigid robot arm system does not have funnel transfer function constraint. The specific description is as follows:

[0136] Figure 1 is a control block diagram of the rigid robot mechanical arm of the present invention;

[0137] Figure 2 The tracking error curve e1 and reference signal curve y from 0s to 20s in case 1 and case 2 are given. dSchematic diagram. The solid line is a schematic diagram of the tracking error curve change when the rigid robot arm system has actuator fault compensation and funnel transfer function constraints (case 1), the dotted line is a schematic diagram of the tracking error curve change when the rigid robot arm system does not have actuator fault compensation (case 2), and the thick dotted line is the boundary of the funnel transfer function. As can be seen from the figure, the controller without actuator fault compensation makes the system tracking error curve gradually diverge, making it difficult for the system output to track the reference signal in time, resulting in a large position tracking error. In contrast, the designed control scheme (case 1) ensures that the tracking error is always constrained within the funnel boundary, achieving accurate angular position trajectory tracking.

[0138] Figure 3 The tracking error curve e1 and reference signal curve y from 0s to 20s in case 1 and case 3 are given. d Schematic diagram. The solid line is a schematic diagram of the tracking error curve change when the rigid robot arm system has actuator fault compensation and funnel transfer function constraints (case 1), the dotted line is a schematic diagram of the tracking error curve change when the rigid robot arm system does not apply the funnel transfer function constraints (case 3), and the thick dotted line is the boundary of the funnel transfer function. It can be seen from the figure that the controller without the funnel transfer function constraint causes the system tracking error to exceed the funnel boundary, has a large overshoot, and when the system gradually stabilizes, it has a larger steady-state error than the designed control scheme (Case 3).

[0139] Figure 4 The angular position curve x1 and the reference signal curve x1 from 0s to 20s in case 3 d Schematic diagram; wherein the solid line is a schematic diagram of the angular position curve change of the rigid robot manipulator system with actuator fault compensation and funnel transfer function constraints (case 1), and the dotted line is a schematic diagram of the reference signal curve change. It can be seen from the figure that under the designed control scheme, the angular position curve can accurately track the reference signal curve.

[0140] Figure 5 The actual control input curve based on self-triggering control from 0s to 20s in case 3 is shown in the figure. The solid line is a schematic diagram of the change of the control input curve under self-triggering control. It can be seen from the figure that when the system starts running, a larger control amount is required to make the tracking error converge quickly to a small neighborhood of zero. When the system tends to be stable, the control amount fluctuates around zero to ensure that the tracking error is always within the boundary of the funnel function.

[0141] Figure 6 The controller parameter adaptive law for 0s-20s in case 3 Dead zone parameter adaptive law Adaptive law for updating neural network weights The solid line is the controller parameter adaptation law. The dotted line is the dead zone parameter adaptive law The curve change diagram, the dotted line is the adaptive law of neural network weight update It can be seen from the figure that when in situation 1, the designed adaptive law always remains within a bounded range, and as the system runs, the designed adaptive law can effectively estimate the unknown input dead zone parameters.

[0142] For rigid robot manipulator systems with model uncertainty, actuator failure and input dead zone, based on adaptive control theory, radial basis function neural network technology and funnel transfer function method can effectively solve the existing problems. The proposed control scheme has the following advantages: based on adaptive theory, the controller parameters of the system can be adjusted online automatically to adapt to the dynamic changes and uncertainties of the system; the system motion and control strategy can be adjusted in real time according to feedback signals to better adapt to the environment and improve control accuracy; the self-triggering fault-tolerant control scheme designed by the present invention can effectively reduce the computing load and energy consumption of the system, and can automatically adjust the system parameters according to the faults that occur in the system, so as to ensure the safe operation of the system; radial basis function neural network technology can learn the dynamic behavior and response of the system, improve the intelligence level of the system, and at the same time, radial basis function neural network technology can adaptively adjust the parameters and models of the system to adapt to different environments and application scenarios, ensure the stable and efficient operation of the system, and make the system have the characteristics of good tracking effect and high tracking data accuracy.

Claims

1. A method for tracking the angular position of a rigid robot arm, characterized in that: The following steps are involved: Step 1: Taking the robot angular position, robot angular velocity and armature current as state quantities, and considering the influence of actuator failure and dead zone constraint, a state space model of the rigid robot arm driven by a DC motor is established; Step 2: Design a funnel transfer function and a command filter for the state space model, and obtain an error system model through equivalent coordinate transformation based on the funnel variables and the command filter output; Step 3: Under the condition of limited communication resources, considering the error system model, using Lyapunov stability theory and backstepping technology, a self-triggered adaptive fault-tolerant controller is designed; Step 4: By adjusting the design parameters in the self-triggering adaptive fault-tolerant controller in step 3, the output voltage of the DC motor is controlled so that the tracking error does not exceed the funnel boundary, thereby achieving accurate tracking of the angular position of the rigid robot arm.

2. The rigid robot arm angular position tracking control method according to claim 1, characterized in that: The state space model of the rigid robot arm driven by a DC motor in step 1 is: Among them, q(t), are the angular position and angular velocity of the robot arm, I(t) is the armature current, V e (t) is the output voltage of the DC motor, J, K τ , m, L o , M o , R o ,L,R,K B , B0 are the nominal values ​​of moment of inertia, electromechanical conversion coefficient, connecting rod mass, connecting rod length, load mass, load radius, armature inductance, armature resistance, back electromotive force coefficient and viscous friction coefficient at the joint, and t is time. m represents the model uncertainty in the rigid robot manipulator control system. Considering the influence of actuator failure and dead zone constraint, the output voltage expression is Among them, π k is the unknown sensitivity parameter of the kth actuator, v k , is the unknown dead zone constraint parameter, u dk The input torque for control.

3. The rigid robot arm angular position tracking control method according to claim 1, characterized in that: The specific process of step 2 is: Step 2.1, based on the state space model established in step 1, define q(t) = x1(t), I(t)=x3(t), and we can get the following derivative: in, Step 2.2, define the angular position tracking error e1(t) = x1(t)-x d (t), where x d (t) is the angular position reference trajectory. The funnel transfer function and command filter are designed as follows: x i,c (0)=a i (0), i=1, 2, Where, e1(t) is the angular position tracking error, z1(t) is the angular position related error variable, is the funnel boundary, is the adjustable parameter of the funnel boundary, a1 is the convergence rate of the funnel boundary, α i (t) is the virtual control input signal, x i,c (t) is the output signal of the command filter, τ i * is the filter gain, x i,c (0) and α i (0) are the initial values ​​of the command filter state and the virtual control input signal, respectively, and t is time. For convenience, the variable t is omitted below. Step 2.3, based on the designed funnel conversion function and command filter, perform the following equivalent coordinate transformation: Among them, z1, z2, z3 are the error variables related to angular position, angular velocity and armature current, ξ1, ξ2, ξ3 are error compensation signals, v1, v2, v3 are the compensation tracking errors of angular position, angular velocity and armature current, respectively, 1,c , α 2,c is the command filter output.

4. The rigid robot arm angular position tracking control method according to claim 1, characterized in that: The specific process of step 3 is as follows: Step 3.1, based on step 2.3, construct the Lyapunov function: Among them, η K , η P , Γ1, Γ2 are positive design parameters, is the neural network weight error, is the parameter estimation error. Step 3.2, design virtual control input signal: Among them, k1, k2, k3, and l1 are positive design parameters. Step 3.3, design error compensation signal: Step 3.4, design a self-triggered adaptive fault-tolerant controller: Among them, u ck is the input signal for the kth controller, is the estimated vector of K, K = [K1, K 21 , K 22 ] T is the unknown vector containing fault information, ∏=[∏1,∏ 21 ,∏ 22 ] T is the control input signal vector in the dynamic model, ∏1=α3, ∏ 21 =∏ 22 =1, α3 is the virtual control input signal. k is the dead zone constraint slope of the kth actuator. π k is the unknown sensitivity parameter of the kth actuator. Based on the adaptive fault-tolerant controller, the continuous input signal ω(t) is constructed: Where ω(t) is the continuous control input signal, s G , ι and s m Design parameters for self-triggering. Step 3.5, according to the rigid robot manipulator angular position tracking control method of claim 1, characterized in that the continuous control input signal satisfies u dk (t) is t k The actual input of the rigid robot manipulator control system at time s G 、s D and Λ is the self-triggering design parameter, t k The derivative of the continuous control input ω(t) at time t∈[t k , t k+1 ),u dk (t) = ω(t k ), t is time, t k Indicates the time when the controller is triggered for the kth time, t k+1 is the time when the controller is triggered for the k+1th time, [t k , t k+1 ) is the time interval between the controller's k+1th self-triggering and the kth self-triggering. The design parameter adaptive law includes the controller parameter adaptive law Dead zone parameter adaptive law and the adaptive law of neural network weight update The expressions are: Among them, η K , m K , η P , m P , Γ, σ are positive design parameters.

5. The rigid robot arm angular position tracking control method according to claim 1, characterized in that: The specific process of step 4 is: Step 4.1, adjust the parameters so that The derivative of the Lyapunov function is guaranteed to be negative definite outside the residual set. Step 4.2, by proving that the Lyapunov function is bounded, the boundedness of the error variable related to the angular position is obtained, and then the output voltage of the DC motor is controlled so that the tracking error does not exceed the funnel boundary, thereby achieving accurate tracking of the angular position of the rigid robot arm.

Citation Information

Patent Citations

  • Fixed-time predetermined performance recurrent neural network mechanical arm control method

    CN110456641A

  • Design method of self-adaptive neural network controller of electrically-driven flexible joint mechanical arm based on disturbance observer and command filter

    CN114895564A

  • Uncertain mechanical arm nerve adaptive control method considering tracking error constraint

    CN115256386A

  • High-dynamic funnel control method based on state predictor

    CN115580188A

  • Acceleration adaptive backstepping funnel control method for dual-mass MEMS gyroscope with event triggering mechanism

    CN116149176A

Cited By

  • Autonomous underwater robot system trajectory tracking control method

    CN116483099A

  • A trajectory tracking control method for autonomous underwater robot system

    CN116483099B

  • Self-adaptive control method for turntable servo system

    CN119200413A