CN106774273B - For the algorithm based on sliding mode prediction fault tolerant control method of time_varying delay control system actuator failures - Google Patents

For the algorithm based on sliding mode prediction fault tolerant control method of time_varying delay control system actuator failures Download PDF

Info

Publication number
CN106774273B
CN106774273B CN201710012239.4A CN201710012239A CN106774273B CN 106774273 B CN106774273 B CN 106774273B CN 201710012239 A CN201710012239 A CN 201710012239A CN 106774273 B CN106774273 B CN 106774273B
Authority
CN
China
Prior art keywords
time
sliding mode
particle
prediction
control
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Fee Related
Application number
CN201710012239.4A
Other languages
Chinese (zh)
Other versions
CN106774273A (en
Inventor
杨蒲
郭瑞诚
姜斌
刘剑慰
马犇
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nanjing University of Aeronautics and Astronautics
Original Assignee
Nanjing University of Aeronautics and Astronautics
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Nanjing University of Aeronautics and Astronautics filed Critical Nanjing University of Aeronautics and Astronautics
Priority to CN201710012239.4A priority Critical patent/CN106774273B/en
Publication of CN106774273A publication Critical patent/CN106774273A/en
Application granted granted Critical
Publication of CN106774273B publication Critical patent/CN106774273B/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B23/00Testing or monitoring of control systems or parts thereof
    • G05B23/02Electric testing or monitoring
    • G05B23/0205Electric testing or monitoring by means of a monitoring system capable of detecting and responding to faults
    • G05B23/0218Electric testing or monitoring by means of a monitoring system capable of detecting and responding to faults characterised by the fault detection method dealing with either existing or incipient faults
    • G05B23/0243Electric testing or monitoring by means of a monitoring system capable of detecting and responding to faults characterised by the fault detection method dealing with either existing or incipient faults model based detection method, e.g. first-principles knowledge model
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/20Pc systems
    • G05B2219/24Pc safety
    • G05B2219/24065Real time diagnostics

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Feedback Control In General (AREA)

Abstract

The invention discloses a kind of algorithm based on sliding mode prediction fault tolerant control methods for time_varying delay control system actuator failures.Design to have obtained the system algorithm based on sliding mode prediction model with time varying characteristic using pole-assignment according to system output errors, which can be while guaranteeing sliding mode asymptotically stability, and dynamic improves the motion qualities of system.Consider that time lag system is influenced by inner parameter perturbation and external disturbance simultaneously, propose a kind of novel discrete sliding mode prediction reference track, the reference locus can not only guarantee the state of system had good robustness during approaching sliding-mode surface with quick convergence, and can significantly inhibit sliding formwork chattering phenomenon.Using multi-agent particle swarm algorithm improvement rolling optimization process, control law can either be rapidly and accurately solved, and can effectively avoid the premature convergence problem of conventional particle group's algorithm.The present invention is used for the robust Fault-Tolerant Control of a kind of uncertain discrete-time system containing Time-varying time-delays.

Description

Sliding mode prediction fault-tolerant control method for actuator fault of variable time-lag control system
Technical Field
The invention relates to a sliding mode prediction fault-tolerant control method for faults of an actuator of a variable time-lag control system, and belongs to the technical field of robust fault-tolerant control of an uncertain discrete control system.
Background
With the rapid development of computer technology and the actual needs in the fields of industrial automation, etc., the analysis and design of discrete control systems have become an important component of control theory. In engineering practice, a certain error often exists in the modeling process of the discrete system, the physical structure of the system is inevitably influenced by working conditions, and meanwhile, inevitable external interference exists, and all uncertain factors can deeply influence the final control effect of the discrete control system. In addition, with the increasingly complex composition structure of an actual discrete control system, a large time delay is introduced in the processes of signal transmission, calculation solution, remote control and the like, and the existence of a time lag phenomenon can make the system analysis and control design more complex and difficult, especially for the control fields with fast response and high precision requirements, such as aerospace, fine machining and the like, the time lag often causes the control precision of the system to be greatly reduced, and the serious and even possible system instability and other consequences are caused. With the diversification of the tasks and the complexity of the structure of the control system, the sensors, the actuators and the internal elements of the system inevitably have faults when the system runs. Therefore, it is an urgent problem to solve the engineering application at present to discuss and analyze a fault-tolerant control algorithm suitable for a time-lag discrete uncertain system, and obtain good control accuracy and dynamic quality on the premise of ensuring the stability of the system.
The sliding mode control has stronger robustness to uncertain factors such as parameter perturbation and external disturbance in the system, so that the sliding mode control is widely researched and applied to uncertain discrete system control at present. However, when a time lag phenomenon exists in a discrete system, the sliding mode control shows obvious performance reduction on the control effect, and particularly when the time lag is large and the system has high requirement on rapidity, the sliding mode control is often difficult to meet the actual control requirement, and even the instability phenomenon can occur. Compared with sliding mode control, the prediction control method can estimate the system performance in a future period of time by utilizing the self prediction and optimization capability, further obtain an online optimization real-time control strategy, and is more suitable for eliminating the influence of time lag on the discrete system performance. Therefore, for an uncertain discrete system with time lag, sliding mode control and predictive control are combined, so that the good robust performance advantage of the sliding mode control in processing the uncertain discrete system containing parameter perturbation and external disturbance can be fully utilized, the influence of the time lag on the stability of the system can be effectively avoided through the predictive control, and the control effect is further optimized.
At present, although a sliding mode predictive control method becomes a feasible method for solving the problem of uncertain discrete system robust control, deep research and application are still lacked for a system with a time lag problem.
Disclosure of Invention
The purpose of the invention is as follows: aiming at the prior art, the sliding mode prediction fault-tolerant control method for the actuator fault of the variable time lag control system is provided, the multi-agent particle swarm can be utilized to quickly and accurately optimize under the action of the designed discrete sliding mode prediction control law, the sliding mode buffeting phenomenon is effectively restrained through a novel reference track, and the time-varying uncertain time lag discrete system with the actuator fault keeps robust and stable.
The technical scheme is as follows: a sliding mode prediction fault-tolerant control method aiming at faults of an actuator of a variable time lag control system is characterized in that a system sliding mode prediction model with time-varying characteristics is designed according to system output errors by adopting a pole allocation method, and the model can ensure gradual stability of a sliding mode and dynamically improve the motion quality of the system; considering the influence of the perturbation of internal parameters and the external disturbance on a time-lag system, a novel discrete sliding mode prediction reference track is provided, and the reference track not only can ensure that the state of the system has good robustness and rapid convergence in the process of approaching a sliding mode surface, but also can obviously inhibit the phenomenon of sliding mode buffeting; the method utilizes a multi-agent particle swarm algorithm to improve the rolling optimization process, can quickly and accurately solve the control law, can effectively avoid the premature problem of the traditional particle swarm algorithm, is used for the robust fault-tolerant control of a class of uncertain discrete systems with time-varying time lag, and comprises the following specific steps:
step 1) determining an uncertain discrete system model and parameters thereof:
step 1.1) determining an uncertain discrete system with actuator faults and time-varying time lags as formula (1), wherein x (k) epsilon RnFor the system state, u (k) e RpFor system input, y (k) e RqFor system output, Δ A, Δ B and Δ AdPerturbation of system parameters, A, B, A, respectivelydC and E are real matrices of appropriate dimensions, v (k) E RnFor external interference, f (k) is a fault function, τ (k) e R+Time-varying time-lag;
step 1.2) rewriting system (1) into formula (2), wherein d (k) ═ Δ ax (k) + Δ bu (k) + Δ adx (k- τ (k)) + v (k)) + ef (k), and d (k) satisfies | d (k) < d (k) -d (k-1) | ≦ d0And dL≤|d(k)|≤dU
Step 2), design of a prediction model:
step 2.1) defining the system output error as formula (3), wherein yr(k) Y (k) is the actual output for the desired output;
e(k)=y(k)-yr(k) (3)
step 2.2) adopts a linear sliding mode surface s (k) ═ σ e (k), σ ═ σ e (k)1,σ2,…,σq]The design can be carried out by a pole allocation method, and then a sliding mode prediction model (4) based on the system output error (3) can be obtained;
s(k+1)=σe(k+1) (4)
step 2.3) nominal system x (k +1) ═ ax (k) + bu (k) + a according to system (2)dx (k-tau (k)) can obtain the prediction output (5) of the prediction model at the time (k + P) and the vector form (6) of the prediction model;
SPM(k)=Gx(k)+HU(k)+FXd(k)-σYr(k) (6)
wherein P is a prediction time domain, M is a control time domain, and M is less than or equal to P, and u (k + M-1) is kept unchanged when j is more than or equal to M-1 and less than or equal to P; xd(k)=[x(k-τ(k)),x(k+1-τ(k+1)),...,x(k+P-1-τ(k+P-1))]T;SPM(k)=[s(k+1),s(k+2),...,s(k+P)]T;U(k)=[u(k),u(k+1),..,u(M-1)]T;G=[(σCA)T,(σCA2)T,...,(σCAP)T]T;Yr(k)=[yr(k+1),yr(k+2),...,yr(k+P)]T
Step 3), designing a reference track:
step 3.1) designing a reference track as shown in formula (7):
wherein ζ (k) ═ σ d (k) ═ σ [ Δ ax (k) + Δ bu (k) + Δ adx(k-τ(k))+v(k)+Ef(k)]Representing the influence of the equivalent total disturbance of the system on the sliding mode output value,s0by choosing appropriate s for designing the constants0The relationship between the control signal amplitude being too large and the convergence to s (k) 0 being too slow can be coordinated; due to the uncertainty and fault interference of the system, interference suppression means is embedded in the reference track, and zeta is adopted1Zeta (k) is compensated to maximally counteract the influence on the system performance, and when | s (k) | is smaller, i.e. s (k) gradually enters the quasi-sliding mode, compensation exists, so that the quasi-sliding mode can be enabledThereby effectively inhibiting the slip form from shaking;
step 3.2) approximate calculation by the one-step delay estimation method of formula (8)Pairing s can be done without d (k) being knownrefSolution of (k +1), srefThe vector form of (k +1) satisfies (9) where
Sref(k)=[sref(k+1),sref(k+2),...,sref(k+P)]T (9)
Step 4), feedback correction design:
step 4.1) calculating a prediction error at the time k as an expression (10), wherein s (k) is the actual output of a prediction model at the time k, s (k | k-P) is the prediction output of the time (k-P) to the time k, and the expression (11) is satisfied;
es(k)=s(k)-s(k|k-P) (10)
step 4.2) after correction is added, the prediction output and the vector form of the P step are respectively (12) and (13);
wherein,
Es(k)=[s(k)-s(k|k-1),s(k)-s(k|k-2),...,s(k)-s(k|k-P)]T,hpto correct the coefficients, h is typically taken1=1,1>h2>h3>…>hP0, namely, the feedback correction effect is gradually weakened along with the increase of the prediction step number;
step 5), rolling optimization design:
step 5.1) designing the optimized performance index at the k moment to be formula (14), wherein βi、γlIs a non-negative weight value, βiThe proportion of the error at the sampling moment in the performance index is shown; gamma raylIs a restriction on the input weight; its vector form is equation (15);
wherein,
step 5.2) determining the particle swarm size L, wherein the position of a particle i is ui=(ui1,ui2,...,uiM) Velocity vi=(vi1,vi2,...,viM) Value range of weight coefficient w, maximum number of iterations tmaxLearning factor c1、c2Particle environment range δ;
step 5.3) taking the optimized performance index J (k) as an adaptive value function psi, and updating the particle position according to the information of the adjacent particles; assuming that n is a particle having the best adaptation value among neighboring particles of the particle i, if the adaptation value of the particle i is better than that of n, the particle is maintainedThe position of sub-i is not changed, otherwise, the position of particle i is updated according to equation (16), wherein ξ is [ -1, 1]The random number of (2); neighboring particles of particle i are taken to be positionally located { (n)i1,ni2,...,niM)| |nij-uijAll particles of i ≦ δ, j ≦ 1, 2., M } excluding particle i;
ui′=un+ξ(ui-un) (16)
step 5.4) iteratively updating the position and the speed of the particles according to the updating equation of the formula (17) to obtain the optimal position of the population;
wherein the preferred location of history is pi=(pi1,pi2,...,piM),r1、r2Is between [0, 1]Random number between, g ═ g (g)1,g2,...,gM) Is the overall optimal position;
step 5.5), when the maximum iteration number is reached, optimizing is finished, the current control quantity is implemented, and k +1 → k returns to the step 2).
Has the advantages that: a sliding mode prediction fault-tolerant control method aiming at faults of an actuator of a variable time lag control system is characterized in that a system sliding mode prediction model with time-varying characteristics is designed according to system output errors by adopting a pole allocation method, and the model can ensure gradual stability of a sliding mode and dynamically improve the motion quality of the system; considering the influence of the perturbation of internal parameters and the external disturbance on a time-lag system, a novel discrete sliding mode prediction reference track is provided, and the reference track not only can ensure that the state of the system has good robustness and rapid convergence in the process of approaching a sliding mode surface, but also can obviously inhibit the phenomenon of sliding mode buffeting; the rolling optimization process is improved by using the multi-agent particle swarm algorithm, the control law can be solved quickly and accurately, the prematurity problem of the traditional particle swarm algorithm can be effectively avoided, and the method is used for robust fault-tolerant control of a class of uncertain discrete systems with time-varying time lag. Has the following specific advantages:
①, designing a sliding mode prediction model of the system by adopting a pole allocation method according to the system output error, wherein the model has time-varying characteristics, and can dynamically improve the motion quality of the system while ensuring the gradual stability of the sliding mode;
② A novel discrete sliding mode reference track considering both internal parameter perturbation and external disturbance influence can not only ensure that the state of the system has good robustness and rapid convergence in the sliding mode surface approaching process, but also can obviously inhibit the sliding mode buffeting phenomenon;
③ compared with the traditional derivation method, the improved rolling optimization process of the multi-agent particle swarm optimization not only can rapidly and accurately solve the control law meeting the conditions, but also can effectively avoid the problem that the traditional particle swarm optimization is easy to fall into local extreme points in the optimization process.
The robust fault-tolerant control method for the uncertain discrete system containing the actuator fault and the time-varying time lag has certain application significance, is easy to realize, good in real-time performance and high in accuracy, can effectively improve the safety of the control system, is strong in operability, saves time, is higher in efficiency, and can be widely applied to actuator fault-tolerant control of the uncertain discrete control system.
Drawings
FIG. 1 is a flow chart of the method of the present invention;
FIG. 2 is an experimental setup Qball-X4 quad-rotor helicopter developed by Quanser to study control of a quad-rotor helicopter;
FIG. 3 is a graph of the X-axis position of a Qball-X4 quad-rotor helicopter;
FIG. 4 is a graph of the speed of the Qball-X4 quadrotor in the X-axis direction;
FIG. 5 is a Qball-X4 quad-rotor helicopter actuator dynamic graph;
FIG. 6 is a control law graph;
FIG. 7 is a partially enlarged control law graph.
Detailed Description
The invention is further explained below with reference to the drawings.
As shown in fig. 1, a sliding mode prediction fault-tolerant control method for a variable-time-lag control system actuator fault is designed by adopting a pole allocation method according to a system output error to obtain a system sliding mode prediction model with time-varying characteristics, and the model can dynamically improve the motion quality of a system while ensuring gradual stability of a sliding mode; considering the influence of the perturbation of internal parameters and the external disturbance on a time-lag system, a novel discrete sliding mode prediction reference track is provided, and the reference track not only can ensure that the state of the system has good robustness and rapid convergence in the process of approaching a sliding mode surface, but also can obviously inhibit the phenomenon of sliding mode buffeting; the method utilizes a multi-agent particle swarm algorithm to improve the rolling optimization process, can quickly and accurately solve the control law, can effectively avoid the premature problem of the traditional particle swarm algorithm, is used for the robust fault-tolerant control of a class of uncertain discrete systems with time-varying time lag, and comprises the following specific steps:
step 1) determining an uncertain discrete system model and parameters thereof:
step 1.1) determining an uncertain discrete system with actuator faults and time-varying time lags as formula (1), wherein x (k) epsilon RnFor the system state, u (k) e RpFor system input, y (k) e RqFor system output, Δ A, Δ B and Δ AdAre respectively the perturbation of the system parameters,A、B、Adc and E are real matrices of appropriate dimensions, v (k) E RnFor external interference, f (k) is a fault function, τ (k) e R+Time-varying time-lag;
step 1.2) rewriting system (1) into formula (2), wherein d (k) ═ Δ ax (k) + Δ bu (k) + Δ adx (k- τ (k)) + v (k)) + ef (k), and d (k) satisfies | d (k) < d (k) -d (k-1) | ≦ d0And dL≤|d(k)|≤dU
Step 2), design of a prediction model:
step 2.1) defining the system output error as formula (3), wherein yr(k) Y (k) is the actual output for the desired output;
e(k)=y(k)-yr(k) (3)
step 2.2) adopts a linear sliding mode surface s (k) ═ σ e (k), σ ═ σ e (k)1,σ2,…,σq]The design can be carried out by a pole allocation method, and then a sliding mode prediction model (4) based on the system output error (3) can be obtained;
s(k+1)=σe(k+1) (4)
step 2.3) nominal system x (k +1) ═ ax (k) + bu (k) + a according to system (2)dx (k-tau (k)) can obtain the prediction output (5) of the prediction model at the time (k + P) and the vector form (6) of the prediction model;
SPM(k)=Gx(k)+HU(k)+FXd(k)-σYr(k) (6)
wherein P is a prediction time domain, M is a control time domain, and M is less than or equal to P, and u (k + M-1) is kept unchanged when j is more than or equal to M-1 and less than or equal to P; xd(k)=[x(k-τ(k)),x(k+1-τ(k+1)),...,x(k+P-1-τ(k+P-1))]T
SPM(k)=[s(k+1),s(k+2),...,s(k+P)]T;U(k)=[u(k),u(k+1),...,u(M-1)]T
G=[(σCA)T,(σCA2)T,...,(σCAP)T]T;Yr(k)=[yr(k+1),yr(k+2),...,yr(k+P)]T
Step 3), designing a reference track:
step 3.1) designing a reference track as shown in formula (7):
wherein ζ (k) ═ σ d (k) ═ σ [ Δ ax (k) + Δ bu (k) + Δ adx(k-τ(k))+v(k)+Ef(k)]Representing the influence of the equivalent total disturbance of the system on the sliding mode output value,s0by choosing appropriate s for designing the constants0The control signal amplitude can be coordinated to be too large and the control signal can be converged to be too slow when s (k) is 0A relationship; due to the uncertainty and fault interference of the system, interference suppression means is embedded in the reference track, and zeta is adopted1Zeta (k) is compensated to maximally counteract the influence on the system performance, and when | s (k) | is smaller, i.e. s (k) gradually enters the quasi-sliding mode, compensation exists, so that the quasi-sliding mode can be enabledThereby effectively inhibiting the slip form from shaking;
step 3.2) approximate calculation by the one-step delay estimation method of formula (8)Pairing s can be done without d (k) being knownrefSolution of (k +1), srefThe vector form of (k +1) satisfies (9) where
Sref(k)=[sref(k+1),sref(k+2),...,sref(k+P)]T (9)
Step 4), feedback correction design:
step 4.1) calculating a prediction error at the time k as an expression (10), wherein s (k) is the actual output of a prediction model at the time k, s (k | k-P) is the prediction output of the time (k-P) to the time k, and the expression (11) is satisfied;
es(k)=s(k)-s(k|k-P) (10)
step 4.2) after correction is added, the prediction output and the vector form of the P step are respectively (12) and (13);
wherein,
Es(k)=[s(k)-s(k|k-1),s(k)-s(k|k-2),...,s(k)-s(k|k-P)]T,hpto correct the coefficients, h is typically taken1=1,1>h2>h3>…>hP0, namely, the feedback correction effect is gradually weakened along with the increase of the prediction step number;
step 5), rolling optimization design:
step 5.1) designing the optimized performance index at the k moment to be formula (14), wherein βi、γlIs a non-negative weight value, βiThe proportion of the error at the sampling moment in the performance index is shown; gamma raylIs a restriction on the input weight; its vector form is equation (15);
wherein,
step 5.2) determining the particle swarm size L, wherein the position of a particle i is ui=(ui1,ui2,...,uiM) Velocity vi=(vi1,vi2,...,viM) Value range of weight coefficient w, maximum number of iterations tmaxLearning factor c1、c2Particle environment range δ;
and 5.3) taking the optimized performance index J (k) as an adaptive value function psi, updating the positions of the particles according to the information of the adjacent particles, assuming that n is the particle with the best adaptive value in the adjacent particles of the particle i, if the adaptive value of the particle i is better than the adaptive value of n, keeping the position of the particle i unchanged, and otherwise, updating the position of the particle i according to a formula (16), wherein ξ is [ -1, 1]The random number of (2); neighboring particles of particle i are taken to be positionally located { (n)i1,ni2,...,niM)| |nij-uijAll particles of i ≦ δ, j ≦ 1, 2., M } excluding particle i;
ui′=un+ξ(ui-un) (16)
step 5.4) iteratively updating the position and the speed of the particles according to the updating equation of the formula (17) to obtain the optimal position of the population;
wherein the preferred location of history is pi=(pi1,pi2,...,piM),r1、r2Is between [0, 1]Random number between, g ═ g (g)1,g2,...,gM) Is the overall optimal position;
step 5.5), when the maximum iteration number is reached, optimizing is finished, the current control quantity is implemented, and k +1 → k returns to the step 2).
The foregoing is only a preferred embodiment of the present invention, and it should be noted that, for those skilled in the art, various modifications and decorations can be made without departing from the principle of the present invention, and these modifications and decorations should also be regarded as the protection scope of the present invention.
The effectiveness of the implementation is illustrated in the following by a practical case simulation.
The Qball-X4 quad-rotor helicopter flight control system actuators, developed by Quanser, Canada, were used as the subject of the application. The Qball-X4 experimental subject is shown in FIG. 2. The Qball-X4 four-rotor helicopter has six-dimensional variables (X, Y, Z, psi, theta, phi), wherein X, Y and Z are position variables, psi is yaw angle, theta is pitch angle and phi is roll angle. The simulation of the case selects the channel signal in the forward direction of the X axis as a research object.
The motion of the body about the X axis is affected by the total thrust and roll angle phi/pitch angle theta. Assuming a yaw angle ψ of 0, the dynamic equation for the X-axis is described as follows:
wherein M isgThe mass of the machine body is shown, and X is the position in the X-axis direction. F is the thrust generated by the rotor:
wherein, KgPositive gain, ω actuator bandwidth. Define v as actuator dynamics:
the state space expression is as follows:
in the X-axis position control model, a pitch angle theta is coupled with the X-axis position control model, the integral control can be divided into two stages, one stage is a pitch angle control stage, and the second stage, namely the position control stage, is started after the pitch angle is controlled to a preset value. And when the position reaches the set position, the pitch angle theta is reset to zero through the pitch angle control channel. Under the condition that theta is smaller, a model of an X-axis direction under an ideal condition without external disturbance, parameter perturbation and time-varying time lag is obtained through linearization, and the model is as follows:
suppose that the pitch angle has been set at the X-axis position control stageConsidering external disturbance, parameter perturbation, network delay and actuator faults, introducing dynamic disturbance, perturbation, time delay and faults of the actuator, and taking values of all matrixes in the system (1) as follows:
C=[1 0 0],ΔA=0.1A,ΔB=0.1B,ΔAd=0.1Ad,x(0)=[1 1 1]T,f(k)=1.5+[0.3sin(6k) 0 0.2sin(2k)]elements of x (k), v (k)Taking white Gaussian noise with the mean value of zero, and taking the coefficient matrix sigma of the sliding mode surface as sigma ═ 1]. Particle swarm learning factor c1=2,c22, weight coefficient wmin=0.2,wmax0.9, 20 particle group size, and maximum iteration number tmaxThe environmental range δ is 50, 6. The optimization time domain P represents that the output of the future P step is interested in an expected value at the moment k, and the optimization time domain P should cover the main part of the dynamic influence of the controlled object. Practice shows that increasing P reduces system rapidity and enhances system stability; decreasing P, the opposite is true. Therefore, the prediction time domain P which has both rapidity and stability is selected to be 4 in the simulation of the case. The control time domain M represents the change number of future control quantity to be determined, the influence of increasing and reducing M on the system is just opposite to P, and the control time domain M is generally selected to be 1-2 for the system with less complex dynamic characteristics, so that the control time domain M is selected to be 2 in the simulation of the case. The simulation time domain takes K as 1000, wherein the value of the body parameter is K as 120N, ω as 15rad/s, and M as 1.4 kg. The control input PWM may introduce a time lag and thus affect the vertical acceleration dynamics. Because the time lag is uncertain, the simulation time-varying time lag of the embodiment is taken as [1, 3 ]]Random integer between.
The simulation result shows that the fault-tolerant control method designed by the simulation of the embodiment has stronger robustness on the time-lag uncertain system with the actuator fault and can quickly approach to stability. Compared with the traditional sliding mode control method, the four-rotor helicopter body has the advantages that under the action of the control method designed by the simulation of the embodiment, the X-axis position speed and the actuator dynamic change curve are more gentle and can not obviously shake in the whole flying process as shown in the figures 3-5. Meanwhile, the control law is fast converged and does not generate large fluctuation, and no obvious buffeting exists after convergence, as shown in fig. 6. Although there is still some buffeting with the simulation method of this example, the buffeting amplitude is cut by nearly half, as shown in fig. 7. In general, the simulated control method of the embodiment is effective for an actuator fault system containing parameter perturbation, external disturbance and time-varying time lag.

Claims (1)

1. A sliding mode prediction fault-tolerant control method for actuator faults of a variable time-lag control system is characterized by comprising the following steps: a system sliding mode prediction model with time-varying characteristics is designed and obtained by adopting a pole allocation method according to system output errors, and the model can dynamically improve the motion quality of a system while ensuring gradual stability of a sliding mode; considering the influence of the perturbation of internal parameters and the external disturbance on a time-lag system, a novel discrete sliding mode prediction reference track is provided, and the reference track not only can ensure that the state of the system has good robustness and rapid convergence in the process of approaching a sliding mode surface, but also can obviously inhibit the phenomenon of sliding mode buffeting; the method utilizes a multi-agent particle swarm algorithm to improve the rolling optimization process, can quickly and accurately solve the control law, can effectively avoid the premature problem of the traditional particle swarm algorithm, is used for the robust fault-tolerant control of a class of uncertain discrete systems with time-varying time lag, and comprises the following specific steps:
step 1) determining an uncertain discrete system model and parameters thereof:
step 1.1) determining an uncertain discrete system with actuator faults and time-varying time lags as formula (1), wherein x (k) epsilon RnFor the system state, u (k) e RpFor system input, y (k) e RqFor system output, Δ A, Δ B and Δ AdPerturbation of system parameters, A, B, A, respectivelydC and E are real matrices of appropriate dimensions, v (k) E RnFor external interference, f (k) is a fault function, τ (k) e R+Time-varying time-lag;
step 1.2) rewriting system (I) into formula (2), wherein d (k) ═ Δ ax (k) + Δ bu (k) + Δ adx (k- τ (k)) + v (k)) + ef (k), and d (k) satisfies | d (k) < d (k) -d (k-1) | ≦ d0And dL≤|d(k)|≤dU
Step 2), design of a prediction model:
step 2.1) defining the system output error as formula (3), wherein yr(k) Y (k) is the actual output for the desired output;
e(k)=y(k)-yr(k) (3)
step 2.2) adopts a linear sliding mode surface s (k) ═ σ e (k), σ ═ σ e (k)1,σ2,…,σq]The design can be carried out by a pole allocation method, and then a sliding mode prediction model (4) based on the system output error (3) can be obtained;
s(k+1)=σe(k+1) (4)
step 2.3) nominal system x (k +1) ═ ax (k) + bu (k) + a according to system (2)dx (k-tau (k)) can obtain the prediction output (5) of the prediction model at the time (k + P) and the vector form (6) of the prediction model;
SPM(k)=Gx(k)+HU(k)+FXd(k)-σYr(k) (6)
wherein P is a prediction time domain, M is a control time domain, and M is less than or equal to P, and u (k + M-1) is kept unchanged when j is more than or equal to M-1 and less than or equal to P; xd(k)=[x(k-τ(k)),x(k+1-τ(k+1)),...,x(k+P-1-τ(k+P-1))]T;SPM(k)=[s(k+1),s(k+2),...,s(k+P)]T;U(k)=[u(k),u(k+1),...,u(M-1)]T;G=[(σCA)T,(σCA2)T,...,(σCAP)T]T;Yr(k)=[yr(k+1),yr(k+2),...,yr(k+P)]T
Step 3), designing a reference track:
step 3.1) designing a reference track as shown in formula (7):
wherein ζ (k) ═ σ d (k) ═ σ [ Δ ax (k) + Δ bu (k) + Δ adx(k-τ(k))+v(k)+Ef(k)]Representing the influence of the equivalent total disturbance of the system on the sliding mode output value,s0by choosing appropriate s for designing the constants0The relationship between the control signal amplitude being too large and the convergence to s (k) 0 being too slow can be coordinated; due to the uncertainty and fault interference of the system, interference suppression means is embedded in the reference track, and zeta is adopted1Zeta (k) is compensated to maximally counteract the influence on the system performance, and when | s (k) | is smaller, i.e. s (k) gradually enters the quasi-sliding mode, compensation exists, so that the quasi-sliding mode can be enabledThereby effectively inhibiting the slip form from shaking;
step 3.2) approximate calculation by the one-step delay estimation method of formula (8)Pairing s can be done without d (k) being knownrefSolution of (k +1), srefThe vector form of (k +1) satisfies (9) where
Sref(k)=[sref(k+1),sref(k+2),...,sref(k+P)]T (9)
Step 4), feedback correction design:
step 4.1) calculating a prediction error at the time k as an expression (10), wherein s (k) is the actual output of a prediction model at the time k, s (k | k-P) is the prediction output of the time (k-P) to the time k, and the expression (11) is satisfied;
es(k)=s(k)-s(k|k-P) (10)
step 4.2) after correction is added, the prediction output and the vector form of the P step are respectively (12) and (13);
wherein,ES(k)=[s(k)-s(k|k-1),s(k)-s(k|k-2),...,s(k)-s(k|k-P)]T,hpto correct the coefficients, h is typically taken1=1,1>h2>h3>…>hP0, namely, the feedback correction effect is gradually weakened along with the increase of the prediction step number;
step 5), rolling optimization design:
step 5.1) designing the optimized performance index at the k moment to be formula (14), wherein βi、γlIs a non-negative weight value, βiThe proportion of the error at the sampling moment in the performance index is shown; gamma raylIs a restriction on the input weight; its vector form is equation (15);
wherein,
step 5.2) determining the particle swarm size L, wherein the position of a particle i is ui=(ui1,ui2,...,uiM) Velocity vi=(vi1,vi2,...,viM) Value range of weight coefficient w, maximum number of iterations tmaxLearning factor c1、c2Particle environment range δ;
and 5.3) taking the optimized performance index J (k) as an adaptive value function psi, updating the positions of the particles according to the information of the adjacent particles, assuming that n is the particle with the best adaptive value in the adjacent particles of the particle i, if the adaptive value of the particle i is better than the adaptive value of n, keeping the position of the particle i unchanged, and otherwise, updating the position of the particle i according to a formula (16), wherein ξ is [ -1, 1]The random number of (2); neighboring particles of particle i are taken to be positionally located { (n)i1,ni2,...,niM)| |nij-uijAll particles of i ≦ δ, j ≦ 1, 2., M } excluding particle i;
ui′=un+ξ(ui-un) (16)
step 5.4) iteratively updating the position and the speed of the particles according to the updating equation of the formula (17) to obtain the optimal position of the population;
wherein the preferred location of history is pi=(pi1,pi2,...,piM),r1、r2Is between [0, 1]Random number between, g ═ g (g)1,g2,...,gM) Is the overall optimal position;
step 5.5), when the maximum iteration number is reached, optimizing is finished, the current control quantity is implemented, and k +1 → k returns to the step 2).
CN201710012239.4A 2017-01-04 2017-01-04 For the algorithm based on sliding mode prediction fault tolerant control method of time_varying delay control system actuator failures Expired - Fee Related CN106774273B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710012239.4A CN106774273B (en) 2017-01-04 2017-01-04 For the algorithm based on sliding mode prediction fault tolerant control method of time_varying delay control system actuator failures

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710012239.4A CN106774273B (en) 2017-01-04 2017-01-04 For the algorithm based on sliding mode prediction fault tolerant control method of time_varying delay control system actuator failures

Publications (2)

Publication Number Publication Date
CN106774273A CN106774273A (en) 2017-05-31
CN106774273B true CN106774273B (en) 2019-01-01

Family

ID=58950457

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710012239.4A Expired - Fee Related CN106774273B (en) 2017-01-04 2017-01-04 For the algorithm based on sliding mode prediction fault tolerant control method of time_varying delay control system actuator failures

Country Status (1)

Country Link
CN (1) CN106774273B (en)

Families Citing this family (22)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107121977B (en) * 2017-06-02 2019-07-16 南京邮电大学 Mechanical arm actuator failures fault-tolerant control system and its method based on double-layer structure
CN107273633B (en) * 2017-06-29 2018-03-27 中南大学 Varying delay method of estimation and flow time lag method of estimation is hydrocracked between multiple operation
CN107797454B (en) * 2017-11-03 2019-12-03 南京航空航天大学 Multi-agent system based on finite-time control cooperates with fault tolerant control method
CN107976942B (en) * 2017-11-22 2020-11-24 海南师范大学 2D constraint fault-tolerant control method for intermittent process of infinite time domain optimization
CN108333949B (en) * 2018-03-09 2020-10-02 南京航空航天大学 Sliding mode fault-tolerant control method for failure fault of multi-agent system actuator
CN108803316B (en) * 2018-03-09 2020-12-15 南京航空航天大学 Active fault-tolerant control method for faults of multi-agent system actuator
CN108427288B (en) * 2018-04-25 2020-01-07 江南大学 H-infinity fault-tolerant control method of networked linear parameter change system with time-varying delay
CN108828949B (en) * 2018-07-20 2021-06-15 南京航空航天大学 Distributed optimal cooperative fault-tolerant control method based on self-adaptive dynamic programming
CN109189091B (en) * 2018-07-25 2021-11-02 西北工业大学 Multi-spacecraft cooperative control method based on integral sliding mode and model predictive control
CN109085757A (en) * 2018-09-19 2018-12-25 南京航空航天大学 For the Active Fault Tolerant forecast Control Algorithm of discrete system multi executors failure of removal
CN109116736B (en) * 2018-09-19 2021-01-12 南京航空航天大学 Fault-tolerant control method for actuator fault of linear multi-agent system based on sliding mode
CN109116737B (en) * 2018-09-19 2021-04-06 南京航空航天大学 Multi-agent system fault assessment and fault tolerance consistency control algorithm under observer
CN109212974B (en) * 2018-11-12 2021-07-13 辽宁石油化工大学 Robust fuzzy prediction fault-tolerant control method of interval time-varying time-delay system
CN109557815B (en) * 2018-12-06 2021-04-06 南京航空航天大学 Sensor fault adjusting method for aircraft engine
CN109507886A (en) * 2018-12-26 2019-03-22 南京航空航天大学 For the Robust Prediction fault tolerant control method of time-delay uncertainties system actuators failure
CN109407520B (en) * 2018-12-26 2021-04-06 南京航空航天大学 Fault-tolerant consistency control algorithm of second-order multi-agent system based on sliding mode control
CN109557818B (en) * 2019-01-10 2021-01-12 南京航空航天大学 Sliding mode fault-tolerant control method of multi-agent tracking system with multiple faults
CN110333661B (en) * 2019-08-06 2022-04-01 大连海事大学 UMV adaptive sliding mode fault-tolerant control method considering quantization and state time lag
CN110361975B (en) * 2019-08-06 2022-04-29 大连海事大学 Self-adaptive fault-tolerant control method of UMV state time-lag system based on sliding mode technology
CN111290278B (en) * 2020-02-27 2022-05-03 南京信息工程大学 Hypersonic aircraft robust attitude control method based on prediction sliding mode
CN111679579B (en) * 2020-06-10 2021-10-12 南京航空航天大学 Sliding mode prediction fault-tolerant control method for fault system of sensor and actuator
CN111722533A (en) * 2020-06-29 2020-09-29 南京航空航天大学 Sliding mode prediction fault-tolerant control method for multi-time-lag system containing sensor faults

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6882889B2 (en) * 2002-12-02 2005-04-19 United Technologies Corporation Constrained dynamic inversion control algorithm
CN104932531B (en) * 2015-06-24 2018-06-15 南京航空航天大学 A kind of optimal anti-input saturation control method of quadrotor based on sliding formwork control
CN105353615B (en) * 2015-11-10 2018-02-09 南京航空航天大学 A kind of Active Fault-tolerant Control Method of the quadrotor based on sliding mode observer
CN106597851B (en) * 2016-12-15 2019-04-30 南京航空航天大学 A kind of robust Fault-Tolerant Control method of small drone flight control system

Also Published As

Publication number Publication date
CN106774273A (en) 2017-05-31

Similar Documents

Publication Publication Date Title
CN106774273B (en) For the algorithm based on sliding mode prediction fault tolerant control method of time_varying delay control system actuator failures
Sun et al. Fixed-time sliding mode disturbance observer-based nonsmooth backstepping control for hypersonic vehicles
CN106597851B (en) A kind of robust Fault-Tolerant Control method of small drone flight control system
CN110442020B (en) Novel fault-tolerant control method based on whale optimization algorithm
CN107203138B (en) Aircraft robust control method with saturated input and output
CN110376902B (en) Design method of servo constraint tracking controller of under-actuated mechanical system
CN106842920A (en) For the robust Fault-Tolerant Control method of multiple time delay four-rotor helicopter flight control system
CN107544256A (en) Underwater robot sliding-mode control based on adaptive Backstepping
CN105607472A (en) Self-adaptive inversion sliding-mode control method and device of nonlinear binary wings
Durmaz et al. Sliding mode control for non-linear systems with adaptive sliding surfaces
CN106527148A (en) Sliding mode robust control method of discrete time delay uncertain system
Zhang et al. Anti-disturbance control for dynamic positioning system of ships with disturbances
Pashilkar et al. Adaptive back-stepping neural controller for reconfigurable flight control systems
Sun et al. Augmented fixed‐time observer‐based continuous robust control for hypersonic vehicles with measurement noises
Yang et al. Study on the sliding mode fault tolerant predictive control based on multi agent particle swarm optimization
Liu et al. Antisaturation fixed-time attitude tracking control based low-computation learning for uncertain quadrotor UAVs with external disturbances
An et al. Adaptive backstepping sliding mode tracking control for autonomous underwater vehicles with input quantization
Shauqee et al. Quadrotor Controller Design Techniques and Applications Review.
CN112068446B (en) Discrete time fuzzy model-based anti-interference control method for direct current motor system
CN117452975A (en) Security performance cooperative formation control design method for four-rotor unmanned aerial vehicle cluster
Bouzid et al. 3d trajectory tracking control of quadrotor UAV with on-line disturbance compensation
Zhang et al. Adaptive backstepping sliding mode control for nonlinear systems with input saturation
CN114839882B (en) Nonlinear system composite self-adaptive control method under input constraint
Zheng et al. Robust fuzzy sampled-data control for dynamic positioning ships
CN116000919A (en) Full-state constraint control method of single-link mechanical arm system with dead zone

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20190101