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 PDFInfo
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 50
- 238000004422 calculation algorithm Methods 0.000 title claims abstract description 14
- 239000002245 particle Substances 0.000 claims abstract description 63
- 238000005457 optimization Methods 0.000 claims abstract description 16
- 238000013461 design Methods 0.000 claims abstract description 15
- 230000008569 process Effects 0.000 claims abstract description 15
- 238000005096 rolling process Methods 0.000 claims abstract description 9
- 230000002028 premature Effects 0.000 claims abstract description 4
- 230000003044 adaptive effect Effects 0.000 claims description 9
- 238000012937 correction Methods 0.000 claims description 9
- 239000003795 chemical substances by application Substances 0.000 claims description 6
- 230000000694 effects Effects 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 claims description 4
- 230000002401 inhibitory effect Effects 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 230000001629 suppression Effects 0.000 claims description 3
- 244000145845 chattering Species 0.000 abstract 1
- 238000009415 formwork Methods 0.000 abstract 1
- 238000004088 simulation Methods 0.000 description 10
- 230000008901 benefit Effects 0.000 description 4
- 230000006870 function Effects 0.000 description 4
- 230000009471 action Effects 0.000 description 2
- 230000006978 adaptation Effects 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000005034 decoration Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 1
- 206010036590 Premature baby Diseases 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000003754 machining Methods 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 230000008054 signal transmission Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B23/00—Testing or monitoring of control systems or parts thereof
- G05B23/02—Electric testing or monitoring
- G05B23/0205—Electric testing or monitoring by means of a monitoring system capable of detecting and responding to faults
- G05B23/0218—Electric 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/0243—Electric 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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/20—Pc systems
- G05B2219/24—Pc safety
- G05B2219/24065—Real 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
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).
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)
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 |
CN109116736B (en) * | 2018-09-19 | 2021-01-12 | 南京航空航天大学 | Fault-tolerant control method for actuator fault of linear multi-agent system based on sliding mode |
CN109085757A (en) * | 2018-09-19 | 2018-12-25 | 南京航空航天大学 | For the Active Fault Tolerant forecast Control Algorithm of discrete system multi executors failure of removal |
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)
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 |
-
2017
- 2017-01-04 CN CN201710012239.4A patent/CN106774273B/en not_active Expired - Fee Related
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 | |
CN116000919B (en) | Full-state constraint control method of single-link mechanical arm system with dead zone | |
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 | |
Shui et al. | An approximation-free methodology to tracking control of pure-feedback nonlinear systems with application to hypersonic flight vehicles |
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 |