Fault estimation and fault-tolerant control method based on unknown input sliding mode observer

Through fault estimation and fault-tolerant control methods based on unknown input slip mode observers, the reliability and stability of flexible robot arms in the case of failure are solved, and accurate estimation and reconstruction of faults and unknown states are achieved, reducing jitter Vibration improves the robustness and adaptability of the system.

CN119036434AActive Publication Date: 2024-11-29NANTONG UNIV

Patent Information

Application Number
CN202311771465.2
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2023-12-21
Publication Date
2024-11-29
Estimated Expiration
2043-12-21

AI Technical Summary

Technical Problem

During the movement, flexible robotic arms generate elastic vibration due to their structural characteristics, which increases control difficulty and affects the accuracy and stability of the system when sensors and actuators fail. The existing fault-tolerant control methods perform in the face of unpredictable faults. Limited fault tolerance and adaptability.

Method used

Using fault estimation and fault-tolerant control methods based on unknown input slip mode observers, the input signals of unknown input slip mode observers and integral switching functions are designed to achieve accurate estimation and replication of faults and unknown states by constructing the Takagi-Sugeno fuzzy system. and design sliding mode fault tolerance control methods to ensure stable operation of the system.

Benefits of technology

It significantly improves the reliability and stability of the flexible robotic arm sliding mode control system in the case of failure, reduces the system's vibration, enhances robustness and adaptability, and can effectively deal with unpredictable sensor and actuator failures.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119036434A_ABST
    Figure CN119036434A_ABST
Patent Text Reader

Abstract

The invention provides a fault estimation and fault-tolerant control method based on an unknown input sliding mode observer, and belongs to the technical field of fault-tolerant control of flexible mechanical arms. The technical problem that a flexible mechanical arm system cannot stably operate under the conditions of unknown system states, actuator faults and sensor faults is solved. According to the technical scheme, the method comprises the following steps: S1, establishing a Takagi-Sugeno fuzzy model; s2, setting a sensor fault type, and establishing an augmented system; s3, developing an unknown input sliding mode observer, and obtaining a dynamic error system; s4, accurately estimating and reconstructing a fault and an unknown state; and S5, an SMC measurement strategy is developed, so that the flexible mechanical arm system keeps stable operation when a fault occurs. The method has the beneficial effects that the fault and unknown system state can be estimated and reconstructed at the same time, and the performance of the system can be recovered in the face of unpredictable sensor faults and actuator faults.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of flexible manipulator control, and in particular to a fault estimation and fault-tolerant control method based on an unknown input sliding mode observer. Background Art

[0002] With the rapid development of intelligent technology and industry, the application of robotic arms in complex working environments has gradually increased. Traditional rigid robotic arms and flexible robotic arms play an important role in tasks such as handling and grasping. Flexible robotic arms have attracted much attention for their advantages such as fast response, lightweight structure, low energy consumption, and high load-to-weight ratio. However, due to the characteristics of flexible structure, flexible robotic arms are often accompanied by elastic vibration during movement, which increases the difficulty of control design. Compared with rigid robotic arms, flexible robotic arms often produce elastic vibrations during work due to their low bending stiffness in structure and material, which increases the complexity of the motion state of flexible robotic arms and makes the control design of flexible robotic arms more difficult. At the same time, with the increasing complexity of actual engineering systems, the failure rate of control systems is also increasing. Due to the characteristics of flexible materials, more complex sensors and actuators are often required to achieve precise control. Once the sensors, actuators or components in the flexible robotic arm system fail, it will seriously affect the accuracy and stability of the entire closed-loop system. Therefore, it is particularly important to study the fault-tolerant control method of flexible robotic arm actuators and sensors.

[0003] In order to solve the hazards caused by unpredictable faults, people have achieved a series of results in fault diagnosis (FD), fault reconstruction (FR) and fault-tolerant control (FTC) to ensure the safety and reliability of engineering systems. In recent years, FTC design methods for complex nonlinear systems, stochastic systems and Markov jump systems have also been widely studied. The literature "Faultreconstruction and fault-tolerant control via learning observers in Takagi–Sugeno fuzzy descriptor systems with time delays" (Q. Jia, W. Chen, Y. Zhang, and H. Li, IEEE Transactions on Industrial Electronics, vol. 62, no. 6, pp. 3885-3895, 2015.) estimates the unknown system state and actuator faults through the designed fuzzy learning observer, and ensures the reliability of the control system under actuator faults through the fuzzy FTC scheme. Although it has achieved some results in the control of disturbed UAV systems with uncertain parameters, this control method has limited fault tolerance and poor adaptability, and is not suitable for actual operating environments with changing disturbances.

[0004] From the theoretical perspective of sliding mode variable structure control, the sliding mode variable structure control scheme has attracted extensive attention and research due to its advantages such as simple design, fast response speed and strong robustness, and is often used to control complex flexible joint robotic arms. The literature "Adaptive speed control of PMSM drive system based on a new sliding-mode reaching law" (AKJunejo, W.Xu, C.Mu, MMIsmail, and Y.Liu, IEEE Transactions on Power Electronics, vol.35, no.11, pp.12110-12121, 2020.) proposed terminal sliding mode control method, boundary layer method, reaching law method, etc. Among them, compared with the terminal SMC and boundary layer methods, the reaching law design is simple and does not reduce the system performance, and has been widely used and studied. At present, although several reaching methods have been proposed to reduce chattering, the system chattering problem is still inevitable. How to improve the system's chattering suppression ability is still a challenging topic. Summary of the invention

[0005] In response to the technical problem of fault-tolerant control of a flexible robotic arm system when unpredictable sensor failures and actuator failures occur simultaneously, the present invention provides a fault estimation and fault-tolerant control method based on an unknown input sliding mode observer, which can simultaneously estimate and reconstruct faulty and unknown system states, and can restore system performance in the face of unpredictable sensor failures and actuator failures, thereby significantly improving the reliability of the flexible robotic arm sliding mode control system when a failure occurs; at the same time, by reducing the jitter of the control system, the operating stability of the system is further optimized.

[0006] The inventive concept of the present invention is: the present invention provides a fault estimation and fault-tolerant control method based on an unknown input sliding mode observer, which specifically includes the following steps:

[0007] S1. According to the working characteristics of the flexible joint robot system, and considering the actual application scenarios and usage purposes of the control method claimed in the claim, and considering possible external nonlinear interference, a Takagi-Sugeno fuzzy system describing sensor failure and actuator failure is constructed; S2. Based on the designed Takagi-Sugeno fuzzy system with sensor failure and actuator failure, the sensor failure is set to be independent of time to obtain an augmented system; S3. Based on the designed augmented system, an unknown input sliding mode observer (UISMO) is developed to obtain a dynamic error system; S4. The input signal based on the integral switching function UISMO is designed, and an augmented error system is constructed through UISMO to ensure the stability of the system and realize accurate estimation and reconstruction of faults and unknown states; S5. Based on the fault information measured by the unknown input sliding mode observer with an integral switching function, a sliding mode fault-tolerant control method (SMFTC) is designed to ensure that the flexible robot system maintains stable operation when a fault occurs, and further improve the stability of the flexible robot sliding mode control system under fault conditions.

[0008] In order to achieve the above-mentioned invention object, the technical solution adopted by the present invention is specifically as follows: In order to achieve the above-mentioned invention object, the technical solution adopted by the present invention is specifically as follows:

[0009] S1. Based on the working characteristics of the flexible joint robot system, and considering the actual application scenarios and usage purposes of the claimed control method, and considering possible external nonlinear interference, a Takagi-Sugeno fuzzy system describing sensor failure and actuator failure is constructed;

[0010] S2, based on the Takagi-Sugeno fuzzy system designed in step S1 to describe sensor failure and actuator failure, assume that the sensor failure is independent of time, and obtain an augmented system;

[0011] S3. Based on the augmented system designed in step S2, in order to simultaneously obtain information about faults and unknown states, an unknown input sliding mode observer is developed to obtain a dynamic error system;

[0012] S4. Construct an augmented error system through UISMO, design the input signal and adaptive reaching law ARL based on the integral switching function UISMO, ensure the stability of the system, and realize accurate estimation and reconstruction of faults and unknown states;

[0013] S5. Based on the unknown input sliding mode observer with integral switching function designed in step S3 and step S4, a sliding mode fault-tolerant control method is designed according to the fault information measured by it, so that the flexible robotic arm system can maintain stable operation when a fault occurs, and further improve the stability of the flexible robotic arm sliding mode control system under fault conditions.

[0014] Further as a preferred technical solution of the present invention, S1 comprises the following steps:

[0015] According to the working characteristics of the flexible joint robot arm system, and considering the actual application scenarios and usage purposes of the claimed control method, a clear flexible joint robot arm system structure model is established:

[0016]

[0017] In formula (1), J l and J m are the motor inertia and connecting rod inertia respectively; θ l and θ m θ m They represent the angular positions of the connecting rod and the motor respectively; M is the mass of the connecting rod; l is the distance from the center of the connecting rod to the joint axis; K and F represent the joint spring stiffness coefficient and the rotor friction coefficient respectively; g is the gravity constant. Among them, The external disturbance is expressed as make As state variables, the above flexible joint robotic arm system can be reconstructed:

[0018]

[0019] In formula (2),

[0020] in,

[0021] Based on the nonlinear system with external disturbance, a TS fuzzy model describing sensor failure and actuator failure is constructed. The model described by the IF-THEN framework is as follows:

[0022] Rule i: If z1 is …, z p yes but

[0023]

[0024] In formula (3), the system state is defined as The input and output are defined as and f(t) is an external disturbance and satisfies f(t)≤α+β||x(t)||; the actuator fault is defined as A sensor failure is defined as And meet A i , B, C, D and E are matrices of appropriate dimensions, where C and E satisfy rank(CE)=rank(E), then the TS model can be further derived as:

[0025]

[0026] where z(t)=[z1(t)…z p (t)] T θ i (z(t)) is the membership function in fuzzy rule i, which is in the following form:

[0027]

[0028] In formula (5), is the antecedent variable z j (t) in the fuzzy set The membership degree in θ i (z(t)) satisfies 1≥θ i (z(t))≥0, and

[0029] Further as a preferred technical solution of the present invention, S2 comprises the following steps:

[0030] Assume that sensor failure is independent of time, i.e. The obtained augmented system is as follows:

[0031]

[0032] In formula (6), x a =[x(t) f s (t)] T , C a =[CD],

[0033] Further as a preferred technical solution of the present invention, S3 comprises the following steps:

[0034] In order to achieve accurate estimation of unknown system states, sensor faults, and actuator faults at the same time, the following unknown input sliding mode observer (UISMO) is considered:

[0035]

[0036] In formula (7), C E =(C a E a ) + is the matrix C a E a The generalized inverse matrix of ; and are the state and input signal of observer (7) respectively; and Respectively represent the actuator estimation signal and state estimation signal of the augmented system (6); G, H i , L i , M1 and N i is a set of gains that need to be designed; the output derivative is the actuator fault estimate calculated from the continuous-time output signal y(t). The following dynamic error form is defined:

[0037]

[0038] Among them, the state error of the system is xa (t) is:

[0039]

[0040] In formula (9), The error dynamics are described as follows:

[0041]

[0042] Define the parameter matrix in equation (7) and eliminate the unknown term f a (t) and u(t)

[0043] FE a =0 (11)

[0044] M1=FB a (12)

[0045] N i =L i QR i (13)

[0046] L i =FA ai +R i C a (14)

[0047] The error dynamics can be further expressed as:

[0048]

[0049] The error system described in equation (10) is independent of actuator failure. In addition, the error due to actuator failure can be expressed as:

[0050]

[0051] C-based E C a E a =(C a E a ) + Ca E a =I, select H i =C E C a A ai =C E C a B a , the error of actuator failure can be further expressed as:

[0052]

[0053] Design the input signal v(t) of UISMO so that e xa (t)→0 and the actuator fault estimation error e fa (t)→0 to achieve synchronization to ensure that the subsequent augmented singular system remains stable.

[0054]

[0055] in, Considering FE a =0, rank(C a E a )=rank(CE)=rank(E), then E a =QC a E a , the matrix Q can be calculated as follows:

[0056] Q=Φ1-TΦ2 (19)

[0057] Where Φ1=E a (C a E a ) + , T is an arbitrary matrix to be designed, and then we can get:

[0058]

[0059] Further as a preferred technical solution of the present invention, S4 comprises the following steps:

[0060] The input signal v(t) is designed to make the augmented singular system (18) converge to zero, and the following integral switching function is selected:

[0061]

[0062] In formula (21), G e The value of is determined by the constraints of the control system operation in actual situations, that is, is a reversible matrix. The switching function s e The derivative of (t) The form is as follows:

[0063]

[0064] According to the SMC theory, the equivalent control law is obtained:

[0065] v eq (t) = f(t) (23)

[0066] Combining the adaptive reaching law ARL and the equivalent control law v eq (t), the input signal v(t) in UISMO can be designed as:

[0067]

[0068] To reduce system chattering, the designed ARL adopts the following damped sine function:

[0069]

[0070] Where 0<λ1,λ2,λ3<1,γ1>1. For the given augmented singular system (18), under the SMC input signal v(t) in (24), the following Lyapunov function is constructed:

[0071]

[0072] This proves that the state trajectory can reach the sliding surface S1 = {e xa (t):s e (t)=0}. When the augmented singular system reaches the sliding surface, the system has the following sliding mode dynamics:

[0073]

[0074] For a known matrix A ai , C a The sliding mode dynamics (27), equations (11)-(14) and equation (20), if we can find the matrix P1>0, X1, X2, Y 1i , Y 2i , P2 and P3 satisfy the following inequalities, then the system state trajectory (27) is asymptotically stable:

[0075]

[0076] Where Φ1 and Φ2 are defined by equation (19); The matrix T in equation (19) and the matrix R in equation (13) i Can be calculated as T = P -1 X and R i =P-1 Y i , so that UISMO and its input signal v(t) can be designed.

[0077] By calculating the parameters in UISMO and synthesizing UISMO with the input signal v(t) designed in (15), the estimated signal can be generated: and x a (t), thereby reconstructing the system state and sensor faults in system (4) into their estimated quantities

[0078] Further, as a preferred technical solution of the present invention, a sliding mode fault-tolerant control method (SMFTC) is designed according to the fault information measured by UISMO, and S5 includes the following steps:

[0079] definition And the integral switching function is given in the following form:

[0080]

[0081] Among them, G c is a designable matrix that satisfies the matrix G c B reversible; and UISMO for x(t) and f a The switching function (t) is derived with respect to time:

[0082]

[0083] According to the SMC theory, the following equivalent control scheme is obtained:

[0084]

[0085] In formula (18), Consistent with the design input signal v(t) in equation (15), the SMC scheme u(t) is constructed as follows:

[0086]

[0087] Under the SMC scheme (32), for the state in system (4), the following Lyapunov function is constructed:

[0088]

[0089] It is proved that the sliding surface S1={x(t):s x (t)=0}, the following sliding mode dynamics are obtained:

[0090]

[0091] To overcome Assuming rank(BE) = rank(B), the generalized inverse form of B is as follows:

[0092] K a =-B + E (35)

[0093] It follows that BK a +E=0. Consider The sliding mode dynamics can be reconfigured as:

[0094]

[0095] Combining equation (27) and equation (34), the following augmented system is derived:

[0096]

[0097] Among them, Δ 1i =A i +BK, Δ 3i =FA ai +R i C a +M1K oi . Using the defined matrices F, M1, G c , H i , K oi Find the control gain to ensure the stability of the augmented system (37).

[0098] In addition, the system matrix A is known i , B, E, A ai , C a , find the matrix and Making inequality (38) hold, the asymptotic stability of the augmented sliding mode dynamic system (37) can be guaranteed.

[0099]

[0100] Thus, the gain of SMC is obtained Combined with the UISMO-based sliding mode control scheme designed in equation (31), a fault compensation strategy can be generated.

[0101] Compared with the prior art, the present invention has the following beneficial effects:

[0102] 1. The present invention proposes for the first time a flexible joint robot arm fault estimation and sliding mode fault-tolerant control method based on an unknown input sliding mode observer, which improves the reliability of the flexible robot arm sliding mode control system when a fault occurs, reduces the jitter of the control system, and realizes highly robust motion control of the flexible robot arm control system.

[0103] 2. Considering the characteristics of the actual working environment of the complex flexible robotic arm, a new type of unknown input sliding mode observer is designed, which can simultaneously estimate the unknown state and faults of the system; this method can not only handle faults, but also effectively handle external interference and improve the robustness of the system.

[0104] 3. The introduction of an unknown input sliding mode observer with an integral switching function realizes the joint estimation and reconstruction of faults and unknown states, breaks the limitation that the actuator fault signal must be a step signal, and enhances the applicability of the system.

[0105] 4. Combined with the adaptive reaching law of the damped sine function, an observer-based sliding mode fault-tolerant control scheme is designed to reduce the jitter of the Takagi-Sugeno fuzzy control system. Compared with the traditional reaching law, the jitter of the system is significantly reduced, and the anti-disturbance and error handling performance of the control system can be improved, thereby further improving the adaptability of the control system. BRIEF DESCRIPTION OF THE DRAWINGS

[0106] The accompanying drawings are used to provide further understanding of the present invention and constitute a part of the specification. They are used to explain the present invention together with the embodiments of the present invention and do not constitute a limitation of the present invention.

[0107] Figure 1 This is a schematic diagram of the flexible joint robot arm fault estimation and sliding mode fault-tolerant control method based on the unknown input sliding mode observer of the present invention.

[0108] Figure 2 This is a structural diagram of the flexible robotic arm of the present invention.

[0109] Figure 3 It is a graph of the sliding mode fault-tolerant control input signal and observer input signal of the flexible manipulator of the present invention.

[0110] Figure 4 This is a state trajectory curve diagram of the unknown input observer of the present invention.

[0111] Figure 5 It is a graph showing the angular position and angular velocity of the connecting rod of the flexible mechanical arm of the present invention and their estimated curves.

[0112] Figure 6 It is a graph showing the motor angle position and motor angular velocity of the flexible robotic arm of the present invention and their estimated curves.

[0113] Figure 7 This is a curve diagram of the estimated error of the flexible robot arm's connecting rod angle, angular velocity and motor angle angular velocity of the present invention.

[0114] Figure 8 Input curve diagram for the flexible robotic arm control system of the present invention.

[0115] Fig. 9 This is a graph showing actuator and sensor failures and their estimations according to the present invention.

[0116] Fig.10 This is a graph of the actuator and sensor fault estimation errors of the present invention.

[0117] Fig.11 This is a state trajectory curve diagram of the flexible robotic arm system under the adaptive reaching law proposed by the present invention and the traditional reaching law.

[0118] Fig.12 Input curve diagram of the flexible robotic arm system under the adaptive reaching law proposed by the present invention and the traditional reaching law. DETAILED DESCRIPTION

[0119] In order to make the purpose, technical solution and advantages of the present invention more clearly understood, the present invention is further described in detail below in conjunction with the accompanying drawings and embodiments. Of course, the specific embodiments described here are only used to explain the present invention and are not used to limit the present invention.

[0120] Example 1

[0121] See also Figures 1 to 12 The technical solution provided by this embodiment is a fault estimation and fault-tolerant control method based on an unknown input sliding mode observer. Figure 1 , which is a schematic diagram of the flexible joint manipulator fault estimation and sliding mode fault-tolerant control method based on unknown input sliding mode observer provided by the present invention, such as Figure 1 shown.

[0122] The structure of the flexible robotic arm is shown in the figure Figure 2 As shown, according to the working characteristics of the flexible joint robot arm system and considering the actual application scenarios and usage purposes of the control method of the claim, a clear flexible joint robot arm system structure model is established:

[0123]

[0124] In formula (1), J l and J m are the motor inertia and connecting rod inertia respectively; θ l and θ m θ mThey represent the angular positions of the connecting rod and the motor respectively; M is the mass of the connecting rod; l is the distance from the center of the connecting rod to the joint axis; K and F represent the joint spring stiffness coefficient and the rotor friction coefficient respectively; g is the gravity constant. Among them, The external disturbance is expressed as make As state variables, the above flexible joint robotic arm system can be reconstructed:

[0125]

[0126] In formula (2),

[0127] in, Considering Combining actuator faults and sensor faults, the nonlinear system (2) described by the IF-THEN framework is as follows:

[0128] Rule 1: IF x1(t)is about 0, THEN

[0129]

[0130] Rule 2: IF x1(t)is about THEN

[0131]

[0132] in,

[0133]

[0134]

[0135] Assume that the system parameter M = 0.02kg, l=1m,J1=J m =1kg·m 2 , g = 9.81 m / s 2 , F = 0.008N·m·s / rad. Therefore, the overall TS fuzzy model can be written as follows:

[0136]

[0137] in,

[0138]

[0139]

[0140] B=[0 0 0 1] T

[0141] Actuator and sensor failure assumptions are as follows:

[0142]

[0143]

[0144] is the membership function.

[0145] In order to solve the unpredictability of the system state and the unpredictable failures of actuators and sensors, an unknown input sliding mode observer (UISMO) is first designed. By solving inequality (28), the observer gain is calculated as follows:

[0146]

[0147]

[0148]

[0149]

[0150]

[0151] H1=[-0.1962 1 0 0.1962 0]

[0152] H2=[-0.1249 1 0 0.1962 0]

[0153] M1=[0 0 0 0 0] T , G=1

[0154] C E =[0 0 0 1]

[0155] Secondly, by solving inequality (38), the sliding mode control gain can be obtained as follows:

[0156] K c1 =[0.4395 -2.8417 -1.7407 -1.4832]

[0157] K c2 =[0.4551 -3.2075 -1.8793 -1.5652]

[0158] K a =-1

[0159] The remaining parameters are selected as α = 2, β = 2, λ1 = 0.7, λ2 = 0.1, λ3 = 0.5, G e =[0 0 0 0 -1], γ1 = 10, Gc =[0 0 0 1]; the initial condition is x(0) = [1 -1 π / 4 -1 / 2], x o (0) = [0 0 0 0].

[0160] exist Figure 3 The SMC input signal (32) of the original system and the SMC input signal (24) of the observer are shown in Figure 4 The state trajectory curve of UISMO response is presented. After adopting the designed SMC and UISMO schemes, Figure 5 and Figure 6 The state trajectory of the original system (41) and its estimated curve are shown. The estimated error and the system output signal are Figure 7 and Figure 8 Specifically, Figures 5 to 7 It is clearly demonstrated that the designed UISMO can effectively estimate the unknown system state. In addition, the estimated curves of the actuator and sensor failures in the system (41) are shown in Fig.10 The corresponding estimation error is Fig.11 This proves the effectiveness of UISMO in fault estimation. Figures 5 to 7 as well as Fig.10 It is confirmed that all the augmented system singular states e A (t) = [e x1 (t) e x2 (t) e x3 (t) e x4 (t) e fs (t) e fa (t)] and the system state x(t) converge to the equilibrium point, thereby verifying the effectiveness of the SMC scheme designed by the present invention.

[0161] In order to verify the superiority of the reaching law (25) designed by the present invention, slaw in formula (25) is replaced by the constant rate reaching law slaw = -sign(s(t)), and the reconstructed SMC scheme is as follows:

[0162]

[0163] The control input u(t) in equations (34) and (54) and the system state trajectory x4(t) under the SMC schemes (34) and (54) are as follows: Fig.11 and Fig.12 The reaching law proposed by the present invention effectively suppresses the jitter phenomenon of the system state and the input signal, thereby verifying the superiority of the reaching law proposed by the present invention.

[0164] The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principle of the present invention should be included in the protection scope of the present invention.

Claims

1. A fault estimation and fault-tolerant control method based on an unknown input sliding mode observer, characterized in that: The steps include: S1. Based on the working characteristics of the flexible joint robot system, and considering the actual application scenarios and usage purposes of the claimed control method, and considering possible external nonlinear interference, a Takagi-Sugeno fuzzy system describing sensor failure and actuator failure is constructed; S2, based on the Takagi-Sugeno fuzzy system designed in step S1 to describe sensor failure and actuator failure, assume that the sensor failure is independent of time, and obtain an augmented system; S3. Based on the augmented system designed in step S2, in order to simultaneously obtain information about faults and unknown states, an unknown input sliding mode observer is developed to obtain a dynamic error system; S4. Construct an augmented error system through UISMO, design the input signal and adaptive reaching law ARL based on the integral switching function UISMO, ensure the stability of the system, and realize accurate estimation and reconstruction of faults and unknown states; S5. Based on the unknown input sliding mode observer with integral switching function designed in step S3 and step S4, a sliding mode fault-tolerant control method is designed according to the fault information measured by it, so that the flexible robotic arm system can maintain stable operation when a fault occurs, and further improve the stability of the flexible robotic arm sliding mode control system under fault conditions.

2. The fault estimation and fault-tolerant control method based on unknown input sliding mode observer according to claim 1, characterized in that: The step S1 comprises the following steps: According to the working characteristics of the flexible joint robot system, and considering the actual application scenarios and usage purposes of the claimed control method, and considering possible external nonlinear interference, a Takagi-Sugeno fuzzy system describing sensor failure and actuator failure is constructed: The system state is defined as θ l and θ m are the angular positions of the connecting rod and the motor, respectively. The input and output are defined as u(t) and y(t), respectively. f(t) is an external disturbance and satisfies ||f(t)||≤α+β||x(t)||. The actuator fault is defined as f a (t), the sensor fault is defined as f s (t); A i , B, C, D and E are system matrices with appropriate dimensions, satisfying rank(CE) = rank(E); r = 2 is the number of fuzzy rules, z(t) = [z1(t)…z p (t)] T ; is the membership function in fuzzy rule i, where is the antecedent variable z j (t) in the fuzzy set The membership degree in θ i (z(t)) satisfies 1≥θ i (z(t))≥0, and The system matrix is ​​specifically expressed as follows: Among them, J l and J m are the motor inertia and the connecting rod inertia respectively; M is the mass of the connecting rod; l is the distance from the center of the connecting rod to the joint axis; K and F represent the joint spring stiffness coefficient and the rotor friction coefficient respectively; g is the gravity constant.

3. The fault estimation and fault-tolerant control method based on unknown input sliding mode observer according to claim 1, characterized in that: The step S2 comprises the following steps: Based on the Takagi-Sugeno fuzzy system of sensor failure and actuator failure, it is assumed that the sensor failure is independent of time. The augmented system is as follows: where x a = [x(t) f s (t)] T , C a = [C D], 4. The fault estimation and fault-tolerant control method based on unknown input sliding mode observer according to claim 1, characterized in that: The step S3 comprises the following steps: In order to achieve accurate estimation of unknown system states, sensor faults, and actuator faults at the same time, the following unknown input sliding mode observer is designed: Among them, C E =(C a E a ) + is the matrix C a E a The generalized inverse matrix of o (t) and v(t) are the state and input signal of the observer (3), respectively; and They represent the actuator estimation signal and state estimation signal of the augmented system (5) respectively; G, H i , L i , M1 and N i is a set of gains that need to be designed; the output derivative is the actuator fault estimate calculated from the continuous-time output signal y(t), and the error dynamics is defined as Among them, e xa (t) is the state error of the system, which is further expressed dynamically as: The error system has nothing to do with actuator failure. In addition, based on C E C a E a =(C a E a ) + C a E a =I, select H i =C E C a A ai =C E C a B a , the actuator fault error is 5. The fault estimation and fault-tolerant control method based on unknown input sliding mode observer according to claim 1, characterized in that: The step S4 comprises the following steps: Design of input signal v(t) based on UISMO to synchronize e xa (t)→0 and the actuator fault estimation error e fa (t)→0, to ensure that the following augmented singular system remains stable; in, In order to further reduce the impact of chattering on system stability during sliding mode control, the following adaptive reaching law (ARL) is designed: According to the SMC theory, the compensation input signal v(t) in UISMO is designed as: in, is the integral switching function designed for the augmented singular system (5), 0<λ1,λ2,λ3<1,γ1>1, G e The value of >1 is determined by the constraints of the control system operation in actual situations, that is, is a reversible matrix. By calculating the parameters in UISMO, UISMO is synthesized with the input signal v(t) designed in formula (7) to generate the estimated signal and Thus, the system state and sensor fault in system (2) are reconstructed into their estimated quantities 6. The fault estimation and fault-tolerant control method based on unknown input sliding mode observer according to claim 1, characterized in that: The step S5 comprises the following steps: definition in According to the sliding mode control theory, in order to ensure stable and safe operation of the flexible robotic arm system when a fault occurs, the following fault-tolerant SMC control scheme based on ARL is designed: in, represents the integral switching function designed for the augmented system (2), where G c is the design matrix and satisfies the matrix G c B reversible.

Citation Information

Patent Citations

  • Vector control method, device and system of permanent magnet synchronous motor

    CN110212834A

  • Force and position control method of robot force sense remote control system

    CN111482966A

  • Active suspension fault-tolerant control method based on sliding mode observer

    CN111791660A

  • Sensor fault-oriented aircraft fault-tolerant control method, system and device

    CN115437359A

  • Permanent magnet synchronous motor sliding mode control method based on finite time disturbance observer

    CN116015133A

Cited By

  • Flexible mechanical arm vibration control method based on T-S fuzzy modeling

    CN121105031A