CN110442020B - 一种新型的基于鲸鱼优化算法的容错控制方法 - Google Patents

一种新型的基于鲸鱼优化算法的容错控制方法 Download PDF

Info

Publication number
CN110442020B
CN110442020B CN201910587276.7A CN201910587276A CN110442020B CN 110442020 B CN110442020 B CN 110442020B CN 201910587276 A CN201910587276 A CN 201910587276A CN 110442020 B CN110442020 B CN 110442020B
Authority
CN
China
Prior art keywords
sliding mode
control
time
fault
whale
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.)
Active
Application number
CN201910587276.7A
Other languages
English (en)
Other versions
CN110442020A (zh
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 CN201910587276.7A priority Critical patent/CN110442020B/zh
Publication of CN110442020A publication Critical patent/CN110442020A/zh
Application granted granted Critical
Publication of CN110442020B publication Critical patent/CN110442020B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/048Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators using a predictor
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
    • G05D1/0816Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
    • G05D1/0825Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions specially adapted for aircraft

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Mathematical Analysis (AREA)
  • Algebra (AREA)
  • Mathematical Optimization (AREA)
  • Mathematical Physics (AREA)
  • Pure & Applied Mathematics (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Feedback Control In General (AREA)

Abstract

本发明公开了一种新型针对变时滞控制***执行器故障的滑模预测容错控制方法。针对于离散时滞不确定的四旋翼***的容错控制问题,设计了一种基于鲸鱼优化算法的滑模预测容错控制方法。利用全程滑模面作为预测模型,以保证全局鲁棒性,并且设计了一种带有故障补偿的幂次函数参考轨迹,在削弱抖振影响的同时,针对于不确定性和故障起到抑制效果。在滚动优化的过程中,考虑到寻优过程需要高精度快响应,采用鲸鱼优化算法,该算法寻优性能强,参数设置少,收敛速度快,精度高。本发明用于一类含有时变时滞的不确定离散***的鲁棒容错控制。

Description

一种新型的基于鲸鱼优化算法的容错控制方法
技术领域
本发明涉及一种针对变时滞控制***执行器故障设计基于鲸鱼优化算法的滑模预测容错控制方法,属于不确定离散控制***的鲁棒容错控制技术领域。
背景技术
随着科学技术的发展,现今社会很大程度上成为了一个由各种智能器械所驱动的社会。智能器械在长期运行,外部因素影响的情况下常常会发生一系列的故障。为了使得智能体在故障情况下能够安全运行,针对处理故障问题的容错控制技术正在蓬勃发展,并在处理实际问题上有了一些成果。容错控制大致发展为主动容错和被动容错两个方向,在处理执行器和传感器故障方面提出了众多出彩的策略。
四旋翼无人机,已经走进了日常生活,在农业,军工,运输,寻迹跟踪等方面展现了其不可或缺的价值。自动控制领域近年来,对于无人机编队飞行,寻迹避障,故障处理等方面提出了相当多的具有实际效用的控制策略,例如滑模控制,预测控制,自适应控制,滑模预测等等。在研究四旋翼离散***时,由于飞行时易受干扰,***建模时也存在着一定的误差,对控制***的复杂程度和控制策略的设计都有重大的影响。实际上,飞行过程中存在的故障,***中存在着的时间滞后更加剧了控制的难度。
离散控制***的研究已经成为了控制领域的重要组成,针对与离散***的故障诊断与容错控制具有极大的探索价值。在离散***中,滑模控制可以很好的处理***中存在的参数摄动、外部扰动等不确定性因素,并且具有很好的鲁棒性。滑模变结构控制本质上是一类特殊的非线性控制,这种控制策略与其他控制方法的不同之处在于***可以在动态过程中,根据当前的状态有目的地不断变化,***的滑动模态是可以设计且与***的扰动无关,这使得SMC具有快速响应、对参数变化和扰动不灵敏以及物理实现简单等优势。因而目前在不确定离散***控制中得到了广泛的研究与应用。然而在实际的控制***中,时滞现象普遍存在。当***中出现时滞项时,单纯的滑模控制难以取得很好的控制效果,特别是时间滞后较大时,滑模控制难以满足***对快速性的要求,并且又可能出现失稳现象。然而,预测控制在消除时滞对离散***的影响上又很好的处理效果。预测控制在滚动优化过程中,控制序列的求解是时时刻刻在线进行的,不断的求解优化问题,这也是滚动优化的含义。也正因如此,滚动优化可以使得实际控制保持最优,进而,时滞问题可以得到很好的处理,降低其对***的影响。所以,本发明将滑模控制与预测控制的优势相结合,针对于时滞离散不确定性***设计滑模预测算法,充分利用滑模控制处理解决***的参数摄动和外部干扰,利用模型预测控制避免时滞的影响,进一步优化控制效果。
目前,对于滑模预测算法的研究越来越多,各种新颖的控制策略不断提出,但是,在处理时变时滞这类问题上很少进行深入研究和分析。
发明内容
发明目的:针对上述已有的处理方案,提出了一种针对于含有故障项的离散时滞不确定的四旋翼***的控制问题,设计了基于鲸鱼优化算法的滑模预测容错控制方法。利用全程滑模面作为预测模型,以保证全局鲁棒性,并且设计了一种带有故障补偿的幂次函数参考轨迹,在削弱抖振影响的同时,针对于不确定性和故障起到抑制效果。在滚动优化的过程中,考虑到寻优过程需要高精度快响应,采用鲸鱼优化算法,该算法寻优性能强,参数设置少,收敛速度快,精度高。从而使得带有执行器故障情况下的时变时滞不确定离散***保持鲁棒稳定,并且在快速性和准确性上获得很好的效果。
技术方案:一种针对变时滞控制***执行器故障的滑模预测容错控制方法,根据***的状态设计滑模预测模型,该模型为全程滑模切换函数,避免趋近过程失稳,保证了全局的鲁棒性;考虑时滞***同时受到内部参数摄动和外部扰动的影响,设计了带有故障和不确定性补偿的幂次函数参考轨迹,更大程度的削弱抖振的同时,又保证了收敛速度;在滚动优化问题上设计了鲸鱼优化算法进行寻优,相较于粒子群优化算法,该算法具有更快的收敛速度,更精确的求解精度,更少更简易的参数设置。针对一类含有时变时滞的不确定离散***的鲁棒容错控制,包括如下具体步骤:
步骤1)确立离散***模型:
步骤1.1)ΔA,ΔB,ΔAd分别为***的参数摄动,x(k)∈Rn,u(k)∈Rp,y(k)∈Rq,分别为***的状态,输入,输出,w(k)∈Rn为外部干扰,f(k)为故障函数,τ(k)为不确定时变时滞,但有其上下界[τl,τu],A,B,C,E,Ad为适当维数的矩阵
Figure GSB0000190078160000021
步骤1.2)将***(1)改写为式(2),其中,d(k)=ΔAx(k)+ΔBu(k)+ΔAdx(k-τ(k))+v(k)+Ef(k),并且d(k)满足|d(k)-d(k-1)|≤d0和dL≤|d(k)|≤dU
Figure GSB0000190078160000031
步骤2)滑模预测模型设计:
步骤2.1)设计全程滑模切换函数,使***状态轨迹的初始状态就位于切换面上,消除了线性滑模面趋近过程,保障了***的全局鲁棒性;其中y(k)为***的实际输出,σ可以通过极点配置法则求解,x0为***初始状态,y0为初始状态时的输出,s(0)=0,初始时刻***状态轨迹就位于切换面,省去了趋近过程;
s(k)=σy(k)-αkσy0=σCx(k)-αkσCx0 (3)
步骤2.2)k+1时刻滑模预测模型为(4);
s(k+1)=σCx(k+1)-αk+1σCx0 (4)
步骤2.3)根据标称***x(k+1)=Ax(k)+Bu(k)+Adx(k-τ(k))可以得到滑模预测模型在(k+P)时刻的预测输出(5)及其向量表示(6);
Figure GSB0000190078160000032
SPM(k)=ΩX(k)+ΞU(k)+ΨXd(k)-ГX0 (6)
其中,P为预测时域,M为控制时域,且满足M≤P,控制量u(k+j)在M-1≤j≤P时保持u(k+M-1)不变,
SPM(k)=[s(k+1),...,s(k+p)]T
X(k)=[x(k+1),...,x(k+p)]T
X0=[x0,...,x0]T
U(k)=[u(k),u(k+1),...,u(k+M-1)]T
Ω=[(σCA)T,...,(σCAp)T]T
Figure GSB0000190078160000041
Γ=[αk,αk+1,...,αk+P]T
Figure GSB0000190078160000042
步骤3)参考轨迹设计:
步骤3.1)滑模预测控制中,参考轨迹的选取可以根据滑模趋近律构造,从而如何减小避免抖振的影响成为了选取时需要慎重考虑的问题;鉴于幂次函数在削弱抖振中的巨大作用,采用幂次函数作为参考轨迹,同时考虑到故障和不确定性的影响,在参考轨迹中嵌入了干扰抑制手段,最大限度地弥补故障和不确定性,设计如式(7)的参考轨迹:
Figure GSB0000190078160000043
其中
Figure GSB0000190078160000044
sgn()表示为符号函数,各参数的取值范围如下,0<β<1,0<δ<1,
Figure GSB0000190078160000051
补偿函数表示为:
Figure GSB0000190078160000052
定义ξ(k)为***的故障和不确定性函数,ξU为ξ(k)的上界,ξL为ξ(k)的下界;
步骤3.2)式(8)表示为通过一步延迟估计法近似求得
Figure GSB0000190078160000058
可以在d(k)未知的情况下完成对sref(k+1)的求解,sref(k+1)的向量形式满足(9);
Figure GSB0000190078160000053
Sref(k)=[sref(k+1),sref(k+2),...,sref(k+P)]T (9)
步骤4)反馈校正设计:
步骤4.1)预测模型(10)表示k时刻之前p步对k时刻的预测输出,式(11)表示为k时刻实际输出与预测输出之间的误差;
Figure GSB0000190078160000054
e(k)=s(k)-s(k|k-P) (11)
步骤4.2)将式(11)所表示的误差作为校正加入到滑模预测模型中,可以得到P步预测输出及其向量形式分别为(12),(13);
Figure GSB0000190078160000055
Figure GSB0000190078160000056
其中,
Figure GSB0000190078160000057
jp作为校正系数,随着预测步骤的递增,校正系数依次递减,j1=1,j1>j2>...>jp>0;
步骤5)优化性能指标设计:
步骤5.1)设计优化性能指标如式(14),其中λi为非负权系数,表示采样时刻误差在性能指标中所占的比重;γl为正的权系数,用于约束控制输入;
Figure GSB0000190078160000061
步骤5.2)将优化性能指标表示为向量形式(15);
Figure GSB0000190078160000062
其中,
Figure GSB0000190078160000063
步骤6)鲸鱼优化算法求解控制律
步骤6.1)取优化性能指标J(k)作为适应值函数Ψ,初始化鲸鱼种群,初始化各个参数
Figure GSB0000190078160000064
l,ρ。其中,
Figure GSB0000190078160000065
Figure GSB0000190078160000066
为系数向量,分别表示摆动因子和收敛因子,
Figure GSB0000190078160000067
随着迭代次数的增加从2线性递减到0,l为[-1,1]之间的随机数,常数ρ∈[0,1]且为均匀分布产生的随机数,且
Figure GSB0000190078160000068
Figure GSB0000190078160000069
可由如下公式计算得出;
Figure GSB00001900781600000610
其中,
Figure GSB00001900781600000611
为[0,1]之间的随机数;
步骤6.2)当参数ρ<0.5,并且
Figure GSB00001900781600000612
时,鲸鱼优化算法采取如下迭代公式计算最优值;
Figure GSB00001900781600000613
其中,
Figure GSB00001900781600000614
为个体与目标猎物之间的距离,当前迭代次数为t,
Figure GSB00001900781600000615
为迭代t次时的最优解的位置,
Figure GSB0000190078160000071
为t次迭代的鲸鱼个***置向量。
步骤6.3)当参数ρ<0.5,并且
Figure GSB0000190078160000072
时,鲸鱼优化算法采取随机搜寻的方法搜寻最优解,随机选择一个个体鲸鱼位置
Figure GSB0000190078160000073
并按照公式(18)进行寻优;
Figure GSB0000190078160000074
步骤6.4)当参数ρ>0.5,鲸鱼优化算法采取bubble-net的寻优方式进行寻优,按照如下公式进行迭代;
Figure GSB0000190078160000075
步骤6.5)当达到最大迭代次数时,寻优结束,实施当前控制量,并令k+1→k返回步骤2)。
有益效果:针对于含有故障项的离散时滞不确定的四旋翼***的控制问题,设计了基于鲸鱼优化算法的滑模预测容错控制方法。利用全程滑模面作为预测模型,以保证全局鲁棒性,并且设计了一种带有故障补偿的幂次函数参考轨迹,在削弱抖振影响的同时,针对于不确定性和故障起到抑制效果。在滚动优化的过程中,考虑到寻优过程需要高精度快响应,采用鲸鱼优化算法,该算法寻优性能强,参数设置少,收敛速度快,精度高。从而使得带有执行器故障情况下的时变时滞不确定离散***保持鲁棒稳定,并且在快速性和准确性上获得很好的效果。具有如下具体优点:
①根据***状态,设计全局滑模切换作为***的滑模预测模型,该模型具有时变特征,避免趋近过程失稳,保证了全局的鲁棒性,能够动态改善***的运动品质;
②考虑到离散时滞***带有的时滞问题和不确定性,设计了一种带有故障补偿的幂次函数参考轨迹,在削弱抖振影响的同时,针对于不确定性和故障起到抑制效果;
③利用鲸鱼算法改进的滚动优化过程,相较于传统的求导法和一般的优化,其求解速度和收敛精度都有很大的优势,并且其还具有参数设计少,操作简单的优势。
本发明所提方法作为一种针对含有时变状态时滞、执行器故障、***参数摄动和扰动的离散***的鲁棒容错控制方法,具有一定的实用价值,实现简易,实时性好,精确性高,能够有效提高控制***安全性且可操作性强,节省时间,效率更高,可广泛应用于不确定离散控制***的执行器故障容错控制中。
附图说明
图1是本发明方法的流程图;
图2是Quanser公司研制的用以研究四旋翼直升机控制的实验装置Qball-X4四旋翼直升机;
图3是Qball-X4四旋翼直升机X轴位置曲线图;
图4是Qball-X4四旋翼直升机执行器动态曲线图;
图5是控制律曲线图;
图6是部分放大的控制律曲线图。
具体实施方式
下面结合附图对本发明做更进一步的解释。
如图1所示考虑到一般滑模算法设计的线性滑模面存在趋近过程,而趋近过程易出现失稳现象,针对此情况在滑模预测模型方面设计全程滑模切换函数,避免趋近过程失稳,保证了全局的鲁棒性。考虑***存在故障,干扰和时滞等诸多影响***控制性能的因素,设计了带有故障和不确定性补偿的幂次函数参考轨迹,而设计幂次函数参考轨迹是考虑到更大程度的削弱滑模自带的抖振问题。在滚动优化问题上设计了鲸鱼优化算法进行寻优,该算法参数设置少,求解方便,又能快速精准的求解出控制律,相较于粒子群优化算法,该算法具有更快的收敛速度,更精确的求解精度。针对一类含有时变时滞的不确定离散***的鲁棒容错控制,包括如下具体步骤:
步骤1)确立离散***模型:
步骤1.1)ΔA,ΔB,ΔAd分别为***的参数摄动,x(k)∈Rn,u(k)∈Rp,y(k)∈Rq,分别为***的状态,输入,输出,w(k)∈Rn为外部干扰,f(k)为故障函数,τ(k)为不确定时变时滞,但有其上下界[τl,τu],A,B,C,E,Ad为适当维数的矩阵
Figure GSB0000190078160000081
步骤1.2)将***(1)改写为式(2),其中,d(k)=ΔAx(k)+ΔBu(k)+ΔAdx(k-τ(k))+v(k)+Ef(k),并且d(k)满足|d(k)-d(k-1)|≤d0和dL≤|d(k)|≤dU
Figure GSB0000190078160000091
步骤2)滑模预测模型设计:
步骤2.1)设计全程滑模切换函数,使***状态轨迹的初始状态就位于切换面上,消除了线性滑模面趋近过程,保障了***的全局鲁棒性;其中y(k)为***的实际输出,σ可以通过极点配置法则求解,x0为***初始状态,y0为初始状态时的输出。s(0)=0,初始时刻***状态轨迹就位于切换面,省去了趋近过程;
s(k)=σy(k)-αkσy0=σCx(k)-αkσCx0 (3)
步骤2.2)k+1时刻滑模预测模型为(4);
s(k+1)=σCx(k+1)-αk+1σCx0 (4)
步骤2.3)根据标称***x(k+1)=Ax(k)+Bu(k)+Adx(k-τ(k))可以得到滑模预测模型在(k+P)时刻的预测输出(5)及其向量表示(6);
Figure GSB0000190078160000092
SPM(k)=ΩX(k)+ΞU(k)+ΨXd(k)-ΓX0 (6)
其中,P为预测时域,M为控制时域,且满足M≤P,控制量u(k+j)在M-1≤j≤P时保持u(k+M-1)不变,
SPM(k)=[s(k+1),...,s(k+p)]T
X(k)=[x(k+1),...,x(k+p)]T
X0=[x0,...,x0]T
U(k)=[u(k),u(k+1),...,u(k+M-1)]T
Ω=[(σCA)T,...,(σCAP)T]T
Figure GSB0000190078160000101
Γ=[αk,αk+1,...,αk+P]T
Figure GSB0000190078160000102
步骤3)参考轨迹设计:
步骤3.1)滑模预测控制中,参考轨迹的选取可以根据滑模趋近率构造,从而如何减小避免抖振的影响成为了选取时需要慎重考虑的问题。鉴于幂次函数在削弱抖振中的巨大作用,采用幂次函数作为参考轨迹,同时考虑到故障和不确定性的影响,在参考轨迹中嵌入了干扰抑制手段,最大限度地弥补故障和不确定性.设计如式(7)的参考轨迹:
Figure GSB0000190078160000103
其中
Figure GSB0000190078160000104
sgn()表示为符号函数。各参数的取值范围如下,0<β<1,0<δ<1,
Figure GSB0000190078160000105
补偿函数表示为:
Figure GSB0000190078160000111
定义ξ(k)为***的故障和不确定性函数,ξU为ξ(k)的上界,ξL为ξ(k)的下界;
步骤3.2)式(8)表示为通过一步延迟估计法近似求得
Figure GSB0000190078160000117
可以在d(k)未知的情况下完成对sref(k+1)的求解,sref(k+1)的向量形式满足(9);
Figure GSB0000190078160000112
Sref(k)=[sref(k+1),sref(k+2),...,sref(k+P)]T (9)
步骤4)反馈校正设计:
步骤4.1)预测模型(10)表示k时刻之前p步对k时刻的预测输出,式(11)表示为k时刻实际输出与预测输出之间的误差;
Figure GSB0000190078160000113
e(k)=s(k)-s(k|k-P) (11)
步骤4.2)将式(11)所表示的误差作为校正加入到滑模预测模型中,可以得到P步预测输出及其向量形式分别为(12),(13);
Figure GSB0000190078160000114
Figure GSB0000190078160000115
其中,
Figure GSB0000190078160000116
jp作为校正系数,随着预测步骤的递增,校正系数依次递减,j1=1,j1>j2>...>jp>0;
步骤5)优化性能指标设计:
步骤5.1)设计优化性能指标如式(14),其中λi为非负权系数,表示采样时刻误差在性能指标中所占的比重;γl为正的权系数,用于约束控制输入;
Figure GSB0000190078160000121
步骤5.2)将优化性能指标表示为向量形式(15);
Figure GSB0000190078160000122
其中,
Figure GSB0000190078160000123
步骤6)鲸鱼优化算法求解控制律
步骤6.1)取优化性能指标J(k)作为适应值函数Ψ,初始化鲸鱼种群,初始化各个参数
Figure GSB0000190078160000124
l,ρ。其中,
Figure GSB0000190078160000125
Figure GSB0000190078160000126
为系数向量,分别表示摆动因子和收敛因子,
Figure GSB0000190078160000127
随着迭代次数的增加从2线性递减到0,l为[-1,1]之间的随机数,常数ρ∈[0,1]且为均匀分布产生的随机数,且
Figure GSB0000190078160000128
Figure GSB0000190078160000129
可由如下公式计算得出;
Figure GSB00001900781600001210
其中,
Figure GSB00001900781600001211
为[0,1]之间的随机数。
步骤6.2)当参数ρ<0.5,并且
Figure GSB00001900781600001212
时,鲸鱼优化算法采取如下迭代公式计算最优值;
Figure GSB00001900781600001213
其中,
Figure GSB00001900781600001214
为个体与目标猎物之间的距离,当前迭代次数为t,
Figure GSB00001900781600001215
为迭代t次时的最优解的位置,
Figure GSB00001900781600001216
为t次迭代的鲸鱼个***置向量;
步骤6.3)当参数ρ<0.5,并且
Figure GSB00001900781600001217
时,鲸鱼优化算法采取随机搜寻的方法搜寻最优解,随机选择一个个体鲸鱼位置
Figure GSB0000190078160000131
并按照公式(18)进行寻优;
Figure GSB0000190078160000132
步骤6.4)当参数ρ>0.5,鲸鱼优化算法采取bubble-net的寻优方式进行寻优,按照如下公式进行迭代;
Figure GSB0000190078160000133
步骤6.5)当达到最大迭代次数时,寻优结束,实施当前控制量,并令k+1→k返回步骤2)。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
下面以实际案例仿真说明实施方案的有效性。
采用由加拿大Quanser公司研制的Qball-X4四旋翼直升机飞行控制***执行器作为应用研究对象。Qball-X4实验主体如图2。Qball-X4四旋翼直升机,***存在六维度变量即(X,Y,Z,ψ,θ,φ),其中X,Y,Z为位置变量,ψ为偏航角,θ为俯仰角,φ为滚转角。本案例仿真选择X轴前进方向通道信号作为研究对象。
首先,为了方便建立模型对Q-ball做出如下假设:
(1)四旋翼飞行器整体视为不会发生弹性形变的刚体,可以使用牛顿-欧拉公式;
(2)机体结构几何对称、质量分布均匀,机体的质心正好在机体坐标系的原点上,且与重心重合;
(3)整个飞行实验中,由于地面对四旋翼的影响微乎其微,故忽略空气摩擦、陀螺效应以及空气阻力扭矩等;
(4)忽略地球曲率对四旋翼飞行运动的影响,假设重力加速度保持不变,将地面坐标系视为惯性坐标系;
(5)四旋翼在做线运动时,机体姿态角(偏航ψ,俯仰θ,滚转φ)的变化不超过±5°。
四旋翼直升机动力来源于四个旋翼旋转所产生的推力,改变四个旋翼的转速,即改变了四旋翼的飞行状态,推力模型如下所示:
Figure GSB0000190078160000141
其中Fi为旋翼推力,K为正值增益,ω为执行器带宽,ui为执行器输入。
飞行器沿X方向飞行时,偏航角ψ为0,滚转角φ很小可以近似为0,则X方向位置的动态模型可以简化为:
Figure GSB0000190078160000142
其中m为机体总质量,θ为俯仰角,
Figure GSB0000190078160000143
为X方向加速度,F为升力。
执行器动态vi
Figure GSB0000190078160000144
在X轴位置控制模型中,俯仰角θ是与其相耦合的,整体的控制可以分为两个阶段,一个是俯仰角控制阶段,等俯仰角控制到预设值之后,就进入第二阶段——位置控制阶段。在位置到达设定位置时,通过俯仰角控制通道将俯仰角θ归零。在θ较小的情况下,通过线性化得到在不含外界扰动、参数摄动以及时变时滞的理想情况下的X轴方向的模型为:
Figure GSB0000190078160000145
假设在X轴位置控制阶段,俯仰角已经定在2°≈0.035rad,考虑外界扰动、参数摄动、网络延迟及执行器故障,引入执行器动态相关的扰动、摄动、时滞与故障,***(1)中各矩阵的取值如下:
Figure GSB0000190078160000146
C=[1 0 0],
Figure GSB0000190078160000147
Δ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)]x(k),w(k)中的元素取均值为零的高斯白噪声,滑模面系数矩阵σ取为σ=[1 1 1]。鲸鱼优化算法参数设置,种群规模取30,最大迭代次数取50次,常数b=1,
Figure GSB0000190078160000148
初值取2,终值取0。优化时域P应当覆盖被控对象动态影响的主要部分,所以本案例仿真选择兼顾快速性和稳定性的预测时域P=4,仿真控制时域选为M=2。仿真时域取k=500,其中,机体参数取值为K=120N,ω=15rad/s,M=1.4kg。控制输入PWM可能带来的时滞,以及进而影响到垂直方向加速度动态而产生的时滞。由于时滞大小是不确定的,本案例仿真时变时滞取[0,5]之间的随机整数。
此案例仿真结果表明,本发明所设计的基于鲸鱼优化算法的滑模预测容错控制算法在处理带有时滞和带有执行器故障的离散不确定***具有很强的鲁棒性,并且同时具有快速性和收敛的精确性。与一般传统的处理时滞离散不确定性***的算法相比,四旋翼直升机机体在本案例仿真所设计的控制方法的作用下,由图3-图4,可以清楚的得到,位置曲线,执行器动态曲线,更为平缓,并且收敛的速度有明显的提升,表明飞行过程更为平滑,且更快速到达预定的位置。同时,控制律收敛后,虽然依然存在一定的抖振抖振明显减小,抖振的幅值有明显的降低,如图6。总体而言,对于含有参数摄动、外部扰动和时变时滞的执行器故障***,本案例仿真的控制方法是行之有效的。

Claims (1)

1.一种新型针对变时滞控制***执行器故障的滑模预测容错控制方法,其特点在于:考虑到一般滑模算法设计的线性滑模面存在趋近过程,而趋近过程易出现失稳现象,针对此情况在滑模预测模型方面设计全程滑模切换函数,避免趋近过程失稳,保证了全局的鲁棒性,考虑***存在故障,干扰和时滞等诸多影响***控制性能的因素,设计了带有故障和不确定性补偿的幂次函数参考轨迹,而设计幂次函数参考轨迹是考虑到更大程度的削弱滑模自带的抖振问题,在滚动优化问题上设计了鲸鱼优化算法进行寻优,该算法参数设置少,求解方便,又能快速精准的求解出控制律,相较于粒子群优化算法,该算法具有更快的收敛速度,更精确的求解精度,针对一类含有时变时滞的不确定离散***的鲁棒容错控制,包括如下具体步骤:
步骤1)确立离散***模型:
步骤1.1)ΔA,ΔB,ΔAd分别为***的参数摄动,x(k)∈Rn,u(k)∈Rp,y(k)∈Rq,分别为***的状态,输入,输出;w(k)∈Rn为外部干扰,f(k)为故障函数,τ(k)为不确定时变时滞,但有其上下界[τl,τu]。A,B,C,E,Ad为适当维数的矩阵
Figure FSB0000190078150000011
步骤1.2)将***(1)改写为式(2),其中,d(k)=ΔAx(k)+ΔBu(k)+ΔAdx(k-τ(k))+v(k)+Ef(k),并且d(k)满足|d(k)-d(k-1)|≤d0和dL≤|d(k)|≤dU
Figure FSB0000190078150000012
步骤2)滑模预测模型设计:
步骤2.1)设计全程滑模切换函数,使***状态轨迹的初始状态就位于切换面上,消除了线性滑模面趋近过程,保障了***的全局鲁棒性;其中y(k)为***的实际输出,σ可以通过极点配置法则求解,x0为***初始状态,y0为初始状态时的输出,s(0)=0,初始时刻***状态轨迹就位于切换面,省去了趋近过程,
s(k)=σy(k)-αkσy0=σCx(k)-αkσCx0 (3)
步骤2.2)k+1时刻滑模预测模型为(4);
s(k+1)=σCx(k+1)-αk+1σCx0 (4)
步骤2.3)根据标称***x(k+1)=Ax(k)+Bu(k)+Adx(k-τ(k))可以得到滑模预测模型在(k+P)时刻的预测输出(5)及其向量表示(6);
Figure FSB0000190078150000021
SPM(k)=ΩX(k)+ΞU(k)+ΨXd(k)-ΓX0 (6)
其中,P为预测时域,M为控制时域,且满足M≤P,控制量u(k+j)在M-1≤j≤P时保持u(k+M-1)不变,
SPM(k)=[s(k+1),...,s(k+p)]T
X(k)=[x(k+1),...,x(k+p)]T
X0=[x0,...,x0]T
U(k)=[u(k),u(k+1),...,u(k+M-1)]T
Ω=[(σCA)T,...,(σCAP)T]T
Figure FSB0000190078150000022
Γ=[αk,αk+1,...,αk+P]T
Figure FSB0000190078150000023
步骤3)参考轨迹设计:
步骤3.1)滑模预测控制中,参考轨迹的选取可以根据滑模趋近率构造,从而如何减小避免抖振的影响成为了选取时需要慎重考虑的问题;鉴于幂次函数在削弱抖振中的巨大作用,采用幂次函数作为参考轨迹,同时考虑到故障和不确定性的影响,在参考轨迹中嵌入了干扰抑制手段,最大限度地弥补故障和不确定性.设计如式(7)的参考轨迹:
Figure FSB0000190078150000031
其中
Figure FSB0000190078150000032
sgn( )表示为符号函数,各参数的取值范围如下,0<β<1,0<δ<1,
Figure FSB0000190078150000033
补偿函数表示为:
Figure FSB0000190078150000034
定义ξ(k)为***的故障和不确定性函数,ξU为ξ(k)的上界,ξL为ξ(k)的下界;
步骤3.2)式(8)表示为通过一步延迟估计法近似求得
Figure FSB0000190078150000035
可以在d(k)未知的情况下完成对sref(k+1)的求解,sref(k+1)的向量形式满足(9);
Figure FSB0000190078150000036
Sref(k)=[sref(k+1),sref(k+2),...,sref(k+P)]T (9)
步骤4)反馈校正设计:
步骤4.1)预测模型(10)表示k时刻之前p步对k时刻的预测输出,式(11)表示为k时刻实际输出与预测输出之间的误差;
Figure FSB0000190078150000037
e(k)=s(k)-s(k|k-P) (11)
步骤4.2)将式(11)所表示的误差作为校正加入到滑模预测模型中,可以得到P步预测输出及其向量形式分别为(12),(13);
Figure FSB0000190078150000041
Figure FSB0000190078150000042
其中,
Figure FSB0000190078150000043
jp作为校正系数,随着预测步骤的递增,校正系数依次递减,j1=1,j1>j2>…>jp>0;
步骤5)优化性能指标设计:
步骤5.1)设计优化性能指标如式(14),其中λ1为非负权系数,表示采样时刻误差在性能指标中所占的比重;γl为正的权系数,用于约束控制输入;
Figure FSB0000190078150000044
步骤5.2)将优化性能指标表示为向量形式(15);
Figure FSB0000190078150000045
其中,
Figure FSB0000190078150000046
步骤6)鲸鱼优化算法求解控制律:
步骤6.1)取优化性能指标J(k)作为适应值函数Ψ,初始化鲸鱼种群,初始化各个参数
Figure FSB0000190078150000047
l,ρ;其中,
Figure FSB0000190078150000048
Figure FSB0000190078150000049
为系数向量,分别表示摆动因子和收敛因子,
Figure FSB00001900781500000410
随着迭代次数的增加从2线性递减到0,l为[-1,1]之间的随机数,常数ρ∈[0,1]且为均匀分布产生的随机数,且
Figure FSB00001900781500000411
Figure FSB00001900781500000412
可由如下公式计算得出;
Figure FSB0000190078150000051
其中,
Figure FSB0000190078150000052
为[0,1]之间的随机数;
步骤6.2)当参数ρ<0.5,并且
Figure FSB0000190078150000053
时,鲸鱼优化算法采取如下迭代公式计算最优值;
Figure FSB0000190078150000054
其中,
Figure FSB0000190078150000055
为个体与目标猎物之间的距离,当前迭代次数为t,
Figure FSB0000190078150000056
为迭代t次时的最优解的位置,
Figure FSB0000190078150000057
为t次迭代的鲸鱼个***置向量;
步骤6.3)当参数ρ<0.5,并且
Figure FSB0000190078150000058
时,鲸鱼优化算法采取随机搜寻的方法搜寻最优解,随机选择一个个体鲸鱼位置
Figure FSB0000190078150000059
并按照公式(18)进行寻优;
Figure FSB00001900781500000510
步骤6.4)当参数ρ>0.5,鲸鱼优化算法采取bubble-net的寻优方式进行寻优,按照如下公式进行迭代;
Figure FSB00001900781500000511
步骤6.5)当达到最大迭代次数时,寻优结束,实施当前控制量,并令k+1→k返回步骤2)。
CN201910587276.7A 2019-06-28 2019-06-28 一种新型的基于鲸鱼优化算法的容错控制方法 Active CN110442020B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910587276.7A CN110442020B (zh) 2019-06-28 2019-06-28 一种新型的基于鲸鱼优化算法的容错控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910587276.7A CN110442020B (zh) 2019-06-28 2019-06-28 一种新型的基于鲸鱼优化算法的容错控制方法

Publications (2)

Publication Number Publication Date
CN110442020A CN110442020A (zh) 2019-11-12
CN110442020B true CN110442020B (zh) 2021-01-12

Family

ID=68428914

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910587276.7A Active CN110442020B (zh) 2019-06-28 2019-06-28 一种新型的基于鲸鱼优化算法的容错控制方法

Country Status (1)

Country Link
CN (1) CN110442020B (zh)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110824928A (zh) * 2019-12-05 2020-02-21 闽江学院 一种改进的半主动h∞鲁棒控制方法
CN111505962B (zh) * 2020-04-29 2023-11-17 河北斐然科技有限公司 一种高速飞行器飞控模拟器
CN111679579B (zh) * 2020-06-10 2021-10-12 南京航空航天大学 针对传感器和执行器故障***的滑模预测容错控制方法
CN111679580B (zh) * 2020-06-11 2022-05-13 江苏理工学院 基于自适应的飞行器控制***故障补偿和扰动抑制方法
CN111722533A (zh) * 2020-06-29 2020-09-29 南京航空航天大学 针对含有传感器故障的多时滞***滑模预测容错控制方法
CN111880561B (zh) * 2020-07-16 2023-03-28 河南大学 城市环境下基于改进鲸鱼算法的无人机三维路径规划方法
CN112596507A (zh) * 2021-01-14 2021-04-02 南京航空航天大学 传感器故障下的多时滞非线性***滑模预测容错控制方法
CN112572772B (zh) * 2021-01-27 2022-05-13 福州大学 无人机飞行过程自动增稳***
CN114840969B (zh) * 2022-03-11 2024-02-09 合肥工业大学 一种非线性机电***的主动容错控制方法

Family Cites Families (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6504410B2 (en) * 2000-05-11 2003-01-07 Goodrich Corporation Fault tolerant storage cell
JP4480921B2 (ja) * 2001-02-19 2010-06-16 株式会社小松製作所 むだ時間を有するプロセス系に対する離散時間スライディングモード制御装置及び方法
CN106597851B (zh) * 2016-12-15 2019-04-30 南京航空航天大学 一种小型无人机飞控***的鲁棒容错控制方法
CN107037734A (zh) * 2017-06-26 2017-08-11 青岛格莱瑞智能控制技术有限公司 一种具有多种不确定因素非线性***稳定跟踪控制方法
CN108733030B (zh) * 2018-06-05 2021-05-14 长春工业大学 一种基于网络的切换时滞***中间估计器设计方法
CN109116736B (zh) * 2018-09-19 2021-01-12 南京航空航天大学 基于滑模的线性多智能体***执行器故障的容错控制方法
CN109085757A (zh) * 2018-09-19 2018-12-25 南京航空航天大学 针对离散***多执行器失效故障的主动容错预测控制方法
CN109606352B (zh) * 2018-11-22 2020-06-26 江苏大学 一种车辆路径跟踪与稳定性协调控制方法
CN109521676B (zh) * 2018-12-24 2021-11-30 哈尔滨理工大学 一种概率分布时滞***的自适应滑模容错控制方法
CN109934351B (zh) * 2019-03-06 2023-06-27 南京航空航天大学 一种量子教与学算法以及基于量子教与学算法的模糊滑模控制方法

Also Published As

Publication number Publication date
CN110442020A (zh) 2019-11-12

Similar Documents

Publication Publication Date Title
CN110442020B (zh) 一种新型的基于鲸鱼优化算法的容错控制方法
Ullah et al. Neuro-adaptive fast integral terminal sliding mode control design with variable gain robust exact differentiator for under-actuated quadcopter UAV
Jia et al. Integral backstepping sliding mode control for quadrotor helicopter under external uncertain disturbances
Xie et al. Differential dynamic programming with nonlinear constraints
Bangura et al. Real-time model predictive control for quadrotors
Tang et al. An integral TSMC-based adaptive fault-tolerant control for quadrotor with external disturbances and parametric uncertainties
Szafranski et al. Different approaches of PID control UAV type quadrotor
Wen et al. Optimized backstepping tracking control using reinforcement learning for quadrotor unmanned aerial vehicle system
CN112987567B (zh) 非线性***的固定时间自适应神经网络滑模控制方法
Yu et al. Attitude tracking control of a quadrotor UAV in the exponential coordinates
Basri Design and application of an adaptive backstepping sliding mode controller for a six-DOF quadrotor aerial robot
Basri et al. Stabilization and trajectory tracking control for underactuated quadrotor helicopter subject to wind-gust disturbance
Raza et al. Robust output feedback control of fixed-wing aircraft
Wang et al. Neural network adaptive inverse model control method for quadrotor UAV
El Houm et al. Optimal new sliding mode controller combined with modified supertwisting algorithm for a perturbed quadrotor UAV
Basri et al. Nonlinear control of an autonomous quadrotor unmanned aerial vehicle using backstepping controller optimized by particle swarm optimization
Xiong et al. Self-tuning sliding mode control for an uncertain coaxial octorotor UAV
CN115202213A (zh) 一种基于自抗扰控制的四旋翼飞行器控制方法
Aruneshwaran et al. Neural adaptive flight controller for ducted-fan UAV performing nonlinear maneuver
CN112631320B (zh) 一种无人机自适应控制方法及***
Zeghlache et al. Adaptive type-2 fuzzy sliding mode control using supervisory type-2 fuzzy control for 6 DOF octorotor aircraft
Reyad et al. An optimal PID controller for a qaudrotor system based on DE algorithm
CN113220031A (zh) 基于抗饱和有限时间的旋翼式植保无人机姿态跟踪控制方法
CN112764426A (zh) 一种四旋翼无人机***的内模抗扰控制方法
Bouzid et al. 3d trajectory tracking control of quadrotor UAV with on-line disturbance compensation

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