CN104197792B - 一类多平衡点饱和切换系统的离散增益调度控制器设计方法及实现btt导弹控制的方法 - Google Patents

一类多平衡点饱和切换系统的离散增益调度控制器设计方法及实现btt导弹控制的方法 Download PDF

Info

Publication number
CN104197792B
CN104197792B CN201410418611.8A CN201410418611A CN104197792B CN 104197792 B CN104197792 B CN 104197792B CN 201410418611 A CN201410418611 A CN 201410418611A CN 104197792 B CN104197792 B CN 104197792B
Authority
CN
China
Prior art keywords
mrow
msub
subsystem
gamma
msubsup
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
CN201410418611.8A
Other languages
English (en)
Other versions
CN104197792A (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.)
Harbin Institute of Technology
Original Assignee
Harbin Institute of Technology
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 Harbin Institute of Technology filed Critical Harbin Institute of Technology
Priority to CN201410418611.8A priority Critical patent/CN104197792B/zh
Publication of CN104197792A publication Critical patent/CN104197792A/zh
Application granted granted Critical
Publication of CN104197792B publication Critical patent/CN104197792B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Feedback Control In General (AREA)

Abstract

一类多平衡点饱和切换系统的离散增益调度控制器设计方法,涉及一种控制领域的增益调度控制器设计方法,本发明还涉及一种BTT导弹控制的方法。本发明为了解决实际系统由设计信号跟踪控制器转化的子系统平衡点不都是相同的问题。本发明利用参量Lyapunov方程法和椭球不变集理论,根据选取系统的状态向量,建立多平衡点线性切换系统,设计多平衡点饱和线性切换系统在于与时间相关的切换路径下的离散增益调度控制器。本发明适用于多平衡点饱和切换系统的离散增益调度控制器设计。

Description

一类多平衡点饱和切换系统的离散增益调度控制器设计方法及实现BTT导弹控制的方法
技术领域
本发明涉及一种控制领域的增益调度控制方法,本发明还涉及一种BTT导弹控制的方法。
背景技术
现实生活中的许多系统自身表现出切换特性,即整个系统在几个不同的子系统之间依据环境因素的变化而呈现出不同的模态,最明显的例子有火车、汽车等机动车在其行进过程中的速度调整和含有饱和、滞环等环节的控制对象。一般情况下,一个典型的切换系统是由一些连续子系统或离散子系统和一个切换法则组成。整个切换系统的进行由切换法则控制,通常这个切换法则也被称为切换律、切换信号或者是切换函数,一般是依赖于时间或者是系统状态或者是两者同时的分段常值函数。“切换”作为一种控制思想,很早就在控制理论中得到了应用。由于切换系统在理论上和实际应用中都有重大价值,很多学者对其进行了研究并给出了一些结果。其中比较典型研究切换系统稳定性的方法为共同Lyapunov函数法、多重Lyapunov函数法和驻留时间法。但是,目前的切换系统的结果很多是基于一个所有子系统的平衡点都是相同的且都是原点的假设。然而,在实际系统中,子系统的平衡点不一定都是相同的。也就是说,多平衡点切换系统是描述实际现象最具有一般性的模型。由于各个子系统平衡点不同,上面提到的共同Lyapunov函数法和多重Lyapunov函数法以及驻留时间法很难适应解决此类问题。因此针对一类多平衡点切换系统的研究有一定的难点,且具有重要的理论意义和应用价值。
在实际物理系统中,饱和非线性广泛存在,在设计控制系统时,不可避免地会遇到输入信号饱和限制。在某些时候,可以忽略输入饱和的影响,直接按照线性系统的控制理论设计控制器,但是在大多数情况下,忽略输入饱和的非线性特征而直接用线性系统的控制理论来设计控制器会使得系统性能迅速变坏,甚至变得不稳定。所以必须针对饱和非线性的特性采用一些特殊的控制手段来达到预期效果。由于此类控制问题具有很强的实际意义和实际应用背景,因此得到了大量学者的重视和研究,目前在处理饱和非线性方法中具有代表性的有:低增益控制、抗饱和补偿器和采用鲁棒等控制手段。低增益控制器的设计大体上有三种方法。目前在处理饱和非线性方法中具有代表性的有:低增益控制、抗饱和补偿器和采用鲁棒等控制手段。低增益控制器的设计大体上有三种方法。Lin和Saberi在文献中采用的基于极点配置的方法。Lin和Teel提出了基于代数Riccati方程的方法。综合了以上两种设计方法的优点,zhou求解一个参数化的Lyapunov方程,也得到一种低增益控制器的设计方法。
一类多平衡点的切换系统是实际系统中一般性模型的描述形式,在系统控制器设计中考虑输入饱和使得控制器的设计非常困难。因此,针对具有输入饱和的多平衡点的切换系统,提出合理的控制器设计方法,且所提出的控制方法达到改善系统的性能的目的研究是十分必要的。
发明内容
本发明为了解决实际系统由设计信号跟踪控制器转化的子系统平衡点不都是相同的问题,进而提出一种多平衡点饱和切换系统的离散增益调度控制器设计方法。
一类多平衡点饱和切换系统的离散增益调度控制器设计方法的过程为:
步骤1:选取为系统的状态向量,建立多平衡点线性切换系统,如公式(1)所示
d ( x ‾ ( t ) - x ‾ δ ( t ) * ) dt = A δ ( t ) ( x ‾ ( t ) - x ‾ δ ( t ) * ) + B δ ( t ) u ‾ δ ( t ) - - - ( 1 )
其中,为系统的状态向量,Rn为n维欧几里德空间,的导数,Aδ(t)和Bδ(t)是常数矩阵,为系统的输入向量,本发明中设计Kδ(t)为控制增益,Rm为m维欧几里德空间,切换信号δ(t):R+→I={1,2,…,M}是一个分段时间常值函数,切换信号是与时间相关的,决定了在切换时刻子系统的切换顺序,M>1为子系统个数;是系统的平衡点,当δ(t)=j时,第j个子系统起作用,其中j=1,2,…,M;假设(Aj,Bj)是可控的,Aj∈Rn×nBj∈Rn×m,j∈I且是第j个子系统的平衡点;
当执行器受限时,系统(1)可写为:
d ( x ‾ ( t ) - x ‾ δ ( t ) * ) dt = A δ ( t ) ( x ‾ ( t ) - x ‾ δ ( t ) * ) + B δ ( t ) sat ( u ‾ δ ( t ) ) - - - ( 2 )
x ‾ ( t 0 ) = x ‾ 0 ;
假设输入向量受到单位饱和函数的限制,形式如下:
sat(u)=[sat(u1) sat(u2) … sat(um)]T
sat(uk)=sign(uk)min{1,|uk|},k=1,…,m
对于切换信号δ(t),假设切换时间序列为:t(j)0<t(j)1<…<t(j+1)0<t(j+1)1<…<+∞,其中t(j)i-1表示第j个子系统作用时间ti-1,i∈I[0,Nj],当δ(t)=j时,子系统j被激活,则Aδ(t)=Aj,Bδ(t)=Bj,t∈[t(j)0,t(j+1)0);
则公式(2)可表示为:
x . ( t ) = A δ ( t ) x ( t ) + B δ ( t ) sat ( u δ ( t ) ) - - - ( 3 )
步骤2:多平衡点饱和切换系统离散增益调度控制器设计:
假设(Aj,Bj)(j=1,2,…,M)可控,多平衡点饱和切换系统(3)离散增益调度控制器设计具体实现过程如下:
步骤2.1:定义集合 &Gamma; N 1 = { &gamma; ( 1 ) 0 , &gamma; ( 1 ) 1 , . . . , &gamma; ( 1 ) N 1 } , &gamma; ( 1 ) i - 1 < &gamma; ( 1 ) i , i &Element; I [ 1 , N 1 ] , 满足集合的选取方法是:
&gamma; ( 1 ) i = &gamma; ( 1 ) 0 + i N 1 ( &gamma; ( 1 ) N 1 - &gamma; ( 1 ) 0 ) , i &Element; I [ 1 , N 1 ] - - - ( 4 )
其中,γ(1)0中的初值,大于γ(1)0
矩阵P(γ(1)i)是下面参量Riccati方程的唯一对称正定解
A 1 T P ( &gamma; ( 1 ) i ) + P ( &gamma; ( 1 ) i ) A 1 - P ( &gamma; ( 1 ) i ) B 1 B 1 T P ( &gamma; ( 1 ) i ) = - &gamma; ( 1 ) i P ( &gamma; ( 1 ) i ) ;
令P(γ(1)i)=W-1(1)i),那么解参量Riccati方程可转化为解参量Lyapunov方程(5)
( A 1 + &gamma; ( 1 ) i 2 I n ) W ( &gamma; ( 1 ) i ) + W ( &gamma; ( 1 ) i ) ( A 1 + &gamma; ( 1 ) i 2 I n ) T = B 1 B 1 T - - - ( 5 )
其中,In是单位矩阵;
步骤2.2:根据椭球的标准定义形式ε(P,1)={x:xTPx≤1},可以写为ε(P),假设子系统1内有N1个椭球,且这组椭球是嵌套的;即
&epsiv; ( P ( 1 ) &gamma; 0 ) &Superset; &epsiv; ( P ( 1 ) &gamma; 1 ) &Superset; . . . &Superset; &epsiv; ( P ( 1 ) &gamma; N 1 ) - - - ( 6 )
在t(2)0时刻,系统由1子系统切换到2子系统;当子系统发生切换时,定义子系统1有如下N1个有界的集合:
E ( 1 ) i - 1 = &epsiv; ( P ( 1 ) &gamma; i - 1 ) \&epsiv; ( P ( 1 ) &gamma; i ) , i &Element; I [ 1 , N 1 ]
本发明中用凸包的方法处理饱和非线性;对于i∈I[1,N1],考虑下面的集合
L ( 1 ) i - 1 &Element; { x : | B ( 1 ) k T P ( &gamma; ( 1 ) i ) x | &le; 1 , k &Element; I [ 1 , m ] }
其中,|·|表示绝对值,B(1)k表示B1的第k列,则
| B ( 1 ) k T P ( &gamma; ( 1 ) i ) x | 2 = B ( 1 ) k T P ( &gamma; ( 1 ) i ) xx T P ( &gamma; ( 1 ) i ) B ( 1 ) k &le; &Sigma; k = 1 m B ( 1 ) k T P ( &gamma; ( 1 ) i ) xx T P ( &gamma; ( 1 ) i ) B ( 1 ) k = x T P ( &gamma; ( 1 ) i ) B 1 B 1 T P ( &gamma; ( 1 ) i ) x &le; x T P 1 / 2 ( &gamma; ( 1 ) i ) tr ( P 1 / 2 ( &gamma; ( 1 ) i ) B 1 B 1 T P 1 / 2 ( &gamma; ( 1 ) i ) ) P 1 / 2 ( &gamma; ( 1 ) i ) x = n&gamma; ( 1 ) i x T P ( &gamma; ( 1 ) i ) x = x T P ( 1 ) &gamma; i x , &ForAll; k &Element; I [ 1 , m ] - - - ( 7 )
从而根据L(1)i的定义有 &epsiv; ( P ( 1 ) &gamma; i - 1 ) &SubsetEqual; L ( 1 ) i - 1 , &ForAll; i &Element; I [ 1 , N 1 ] ;
对于i∈I[1,N1],如果,则可知x∈L(1)i-1,由公式(7)可知控制律简化成 u 1 = - B 1 T P ( &gamma; ( 1 ) i - 1 ) x且||u1||≤1;
针对子系统1,设计如下形式的控制器
u 1 = u ( 1 ) N 1 = - B 1 T P ( &gamma; ( 1 ) N 1 ) x , x &Element; &epsiv; ( P ( 1 ) &gamma; N 1 ) u ( 1 ) N 1 - 1 = - B 1 T P ( &gamma; ( 1 ) N 1 - 1 ) x , x &Element; &epsiv; ( P ( 1 ) &gamma; N 1 - 1 ) \ &epsiv; ( P ( 1 ) &gamma; N 1 ) &CenterDot; &CenterDot; &CenterDot; u ( 1 ) 0 = - B 1 T P ( &gamma; ( 1 ) 0 ) x , x &Element; &epsiv; ( P ( 1 ) &gamma; 0 ) \ &epsiv; ( P ( 1 ) &gamma; 1 ) - - - ( 8 )
当t∈[t(1)0,t(2)0]时,系统(3)的控制器为式(8);
步骤2.3:针对子系统1,取下面的Lyapunov函数
V ( 1 ) i - 1 ( x ( t ) ) = n&gamma; ( 1 ) i - 1 x T ( t ) P ( &gamma; ( 1 ) i - 1 ) x ( t ) , &ForAll; x ( t ) &Element; E ( 1 ) i - 1
V(1)i-1(x(t))是时不变的,对于t∈[t(1)i-1,t(1)i],i∈I[1,N1],有
V ( 1 ) i - 1 ( x ( t ) ) &le; V ( 1 ) i - 1 ( x ( t ( 1 ) i - 1 ) ) e - &gamma; ( 1 ) i - 1 ( t - t ( 1 ) i - 1 ) - - - ( 9 )
由式(9)可解得
| | x ( t ) | | &le; &kappa; i - 1 1 2 e - &gamma; ( 1 ) i - 1 2 ( t - t ( j ) i - 1 ) | | x ( t ( 1 ) i - 1 ) | | , t &Element; [ t ( 1 ) i - 1 , t ( 1 ) i ) &kappa; N 1 1 2 e - &gamma; ( 1 ) N 2 ( t - t ( 1 ) N 1 ) | | x ( t ( 1 ) N 1 ) | | , t &Element; [ t ( 1 ) N 1 , t ( 2 ) 0 ) - - - ( 10 )
其中,||·||表示2范数,λmin{P(γ(1)i)}≤P(γ(1)i)≤λmax{P(γ(1)i)},λmin{P(γ(1)i)}表示对称矩阵P(γ(1)i)的最小特征值,λmax{P(γ(1)i)}表示对称矩阵P(γ(1)i)的最大特征值;那么,当i∈I[1,N1]时,定义 &kappa; i = &lambda; max { P ( &gamma; ( 1 ) i ) } &lambda; min { P ( &gamma; ( 1 ) i ) } ;
在t(2)0时刻,子系统由1切换到2时, | | x &OverBar; ( t ( 2 ) 0 ) - x 1 * | | &le; &kappa; N 1 1 2 e - &gamma; ( 1 ) N 2 ( t ( 2 ) 0 - t ( 1 ) N 1 ) | | x ( t ( 1 ) N 1 ) | | ;
z 1 = x &OverBar; ( t ( 2 ) 0 ) - x 1 * , 可以得出
| | x ( t ( 2 ) 0 ) | | = | | x &OverBar; ( t ( 2 ) 0 ) - x &OverBar; 2 * | | = | | z 1 + x &OverBar; 1 * - x &OverBar; 2 * | | &le; | | z 1 | | + | | x &OverBar; 1 * - x &OverBar; 2 * | | &le; &kappa; N 1 1 2 e - &gamma; ( 1 ) N 2 ( t ( 2 ) 0 - t ( 1 ) N 1 ) | | x ( t ( 1 ) N 1 ) | | + | | x &OverBar; 1 * - x &OverBar; 2 * | | - - - ( 11 )
当子系统2的初值即瞬间切换的初始条件x(t(2)0)满足公式(11)时,取γ(2)0使得
(2)0xT(t(2)0)P(γ(2)0)x(t(2)0)=1
成立;
当公式(11)成立时,则有γ(2)0的估计值为
&gamma; ( 2 ) 0 &lambda; max ( P ( &gamma; ( 2 ) 0 ) ) &GreaterEqual; 1 | | x ( t ( 2 ) 0 ) | | 2 &gamma; ( 2 ) 0 > max { 0,2 Re { &lambda; max { - A 2 } } } - - - ( 12 )
公式(11)和公式(12)保证了子系统2的初值在椭球边界上;且满足
&epsiv; ( P ( 2 ) &gamma; 0 ) &cap; &epsiv; ( P ( 1 ) &gamma; N 1 ) &NotEqual; &epsiv; ( P ( 1 ) &gamma; N 1 )
针对子系统2进行控制器设计,设计方法重复子系统1的设计过程,直到系统切换到子系统M-1;
(Aj,Bj)可控,当j=1,2,…,M-1时,则控制器u从控制器集合{u1,u2,…,uM-1}依次切换,即,当t∈[t(j)0,t(j+1)0)时,系统(3)的控制器为如下形式
u j = u ( j ) N j = - B j T P ( &gamma; ( j ) N j ) x , x &Element; &epsiv; ( P ( j ) &gamma; N j ) u ( j ) N j - 1 = - B j T P ( &gamma; ( j ) N j - 1 ) x , x &Element; &epsiv; ( P ( j ) &gamma; N j - 1 ) \ &epsiv; ( P ( j ) &gamma; N j ) . . . u ( j ) 0 = - B j T P ( &gamma; ( j ) 0 ) x , x &Element; &epsiv; ( P ( j ) &gamma; 0 ) \ &epsiv; ( P ( j ) &gamma; 1 )
在切换时刻t(j+1)0,子系统j+1的初值x(t(j+1)0)和γ(j+1)0满足下面的公式
| | x ( t ( j + 1 ) 0 ) | | &le; &kappa; N j 1 2 e - &gamma; ( j ) N 2 ( t ( j + 1 ) 0 - t ( j ) N j ) | | x ( t ( j ) N j ) | | + | | x - j * - x - j + 1 * | |
&gamma; ( j + 1 ) 0 &lambda; max ( P ( &gamma; ( j + 1 ) 0 ) ) &GreaterEqual; 1 | | x ( t ( j + 1 ) 0 ) | | 2 &gamma; ( j ) 0 > max { 0,2 Re { &lambda; max { - A j } } }
&epsiv; ( P ( &gamma; ( j + 1 ) 0 ) ) &cap; &epsiv; ( P &gamma; ( j ) N j ) &NotEqual; &epsiv; ( P &gamma; ( j ) N j )
系统由子系统j切换到子系统j+1时状态收敛到子系统j+1的第一个椭球的边界上;
当j=M时,系统切换到最后一个子系统,系统(3)的控制器切换为
u M = u ( M ) N M = - B M T P ( &gamma; ( M ) N M ) x , x &Element; &epsiv; ( P ( M ) &gamma; N M ) u ( M ) N M - 1 = - B M T P ( &gamma; ( M ) N M - 1 ) x , x &Element; &epsiv; ( P ( M ) &gamma; N M - 1 ) \ &epsiv; ( P ( M ) &gamma; N M ) . . . u ( M ) 0 = - B M T P ( &gamma; ( M ) 0 ) x , x &Element; &epsiv; ( P ( M ) &gamma; 0 ) \ &epsiv; ( P ( M ) &gamma; 1 )
步骤2.1中γ(1)0由等式(13)得出
n &gamma; ( 1 ) 0 x ( 1 ) 0 T P ( &gamma; ( 1 ) 0 ) x ( 1 ) 0 = 1 - - - ( 13 )
且需要满足下面约束
γ(1)0>max{0,2Re{λmax{-A1}}}
其中,λmax为矩阵的最大特征值,Re{·}是特征值的实部。
多平衡点切换系统的稳定性分析如下:
当j=1,2,…,M-1时,如果i∈I[1,Nj],t∈[t(j)i-1,t(j)i)时,状态x(t(j)i-1)从椭球的边界指数收敛到的边界,当时,从椭球的边界收敛到的边界;
当j=M,也就是切换到子系统M时,有
| | x ( t ) | | &le; &kappa; i - 1 1 2 e - &gamma; ( M ) i - 1 2 ( t - t ( M ) i - 1 ) | | x ( t ( M ) i - 1 ) | | , [ t ( M ) i - 1 , t ( M ) i ) &kappa; N M 1 2 e - &gamma; ( M ) N M 2 ( t - t ( M ) N M ) | | x ( t ( M ) N M ) | | , t &Element; [ t ( M ) N M , &infin; )
即对于i∈I[1,NM],当t∈[t(M)i-1,t(M)i),状态x(t(M)i-1)从椭球的边界指数收敛到的边界,当时,状态指数收敛到原点,因此系统(3)是指数稳定的。
本发明利用参量Lyapunov方程法和椭球不变集理论,设计了多平衡点饱和线性切换系统在于与时间相关的切换路径下的离散增益调度控制器。所提出的控制器设计方法可实现切换系统半全局镇定(局部镇定),且Nj越大,切换次数越多,相应的γ(j)i-1(状态的收敛速度)的控制律u(j)i-1作用的时间越短。
附图说明
图1多平衡点饱和切换系统(3)离散增益调度控制器设计流程图;
图2控制量δz的仿真曲线;
图3控制量δy的仿真曲线;
图4状态x1的仿真曲线;
图5状态x2的仿真曲线;
图6状态x3的仿真曲线;
图7状态x4的仿真曲线。
具体实施方式
具体实施方式一:结合图1说明本实施方式,一类多平衡点饱和切换系统的离散增益调度控制器设计方法包括下述步骤:
步骤1:选取为系统的状态向量,建立多平衡点线性切换系统,如公式(1)所示
d ( x &OverBar; ( t ) - x &OverBar; &delta; ( t ) * ) dt = A &delta; ( t ) ( x &OverBar; ( t ) - x &OverBar; &delta; ( t ) * ) + B &delta; ( t ) u &OverBar; &delta; ( t ) - - - ( 1 )
其中,为系统的状态向量,Rn为n维欧几里德空间,的导数,Aδ(t)和Bδ(t)是常数矩阵,为系统的输入向量,本发明中设计Kδ(t)为控制增益,Rm为m维欧几里德空间,切换信号δ(t):R+→I={1,2,…,M}是一个分段时间常值函数,切换信号是与时间相关的,决定了在切换时刻子系统的切换顺序,M>1为子系统个数;是系统的平衡点,当δ(t)=j时,第j个子系统起作用,其中j=1,2,…,M;假设(Aj,Bj)是可控的,Aj∈Rn×nBj∈Rn×m,j∈I且是第j个子系统的平衡点;
当执行器受限时,系统(1)可写为:
d ( x &OverBar; ( t ) - x &OverBar; &delta; ( t ) * ) dt = A &delta; ( t ) ( x &OverBar; ( t ) - x &OverBar; &delta; ( t ) * ) + B &delta; ( t ) sat ( u &OverBar; &delta; ( t ) ) - - - ( 2 )
x &OverBar; ( t 0 ) = x &OverBar; 0 ;
假设输入向量受到单位饱和函数的限制,形式如下:
sat(u)=[sat(u1) sat(u2)…sat(um)]T
sat(uk)=sign(uk)min{1,|uk|},k=1,…,m
对于切换信号δ(t),假设切换时间序列为:t(j)0<t(j)1<…<t(j+1)0<t(j+1)1<…<+∞,其中t(j)i-1表示第j个子系统作用时间ti-1,i∈I[0,Nj],当δ(t)=j时,子系统j被激活,则Aδ(t)=Aj,Bδ(t)=Bj,t∈[t(j)0,t(j+1)0);
则公式(2)可表示为:
x &CenterDot; ( t ) = A &delta; ( t ) x ( t ) + B &delta; ( t ) sat ( u &delta; ( t ) ) - - - ( 3 )
步骤2:多平衡点饱和切换系统离散增益调度控制器设计:
假设(Aj,Bj)(j=1,2,…,M)可控,多平衡点饱和切换系统(3)离散增益调度控制器设计具体实现过程如下:
步骤2.1:定义集合 &Gamma; N 1 = { &gamma; ( 1 ) 0 , &gamma; ( 1 ) 1 , &CenterDot; &CenterDot; &CenterDot; , &gamma; ( 1 ) N 1 } , &gamma; ( 1 ) i - 1 < &gamma; ( 1 ) i , i &Element; I [ 1 , N 1 ] , 满足集合的选取方法是:
&gamma; ( 1 ) i = &gamma; ( 1 ) 0 + i N 1 ( &gamma; ( 1 ) N 1 - &gamma; ( 1 ) 0 ) , i &Element; I [ 1 , N 1 ] - - - ( 4 )
其中,γ(1)0中的初值,大于γ(1)0
矩阵P(γ(1)i)是下面参量Riccati方程的唯一对称正定解
A 1 T P ( &gamma; ( 1 ) i ) + P ( &gamma; ( 1 ) i ) A 1 - P ( &gamma; ( 1 ) i ) B 1 B 1 T P ( &gamma; ( 1 ) i ) = - &gamma; ( 1 ) i P ( &gamma; ( 1 ) i ) ;
令P(γ(1)i)=W-1(1)i),那么解参量Riccati方程可转化为解参量Lyapunov方程(5)
( A 1 + &gamma; ( 1 ) i 2 I n ) W ( &gamma; ( 1 ) i ) + W ( &gamma; ( 1 ) i ) ( A 1 + &gamma; ( 1 ) i 2 I n ) T = B 1 B 1 T - - - ( 5 )
其中,In是单位矩阵;
步骤2.2:根据椭球的标准定义形式ε(P,1)={x:xTPx≤1},可以写为ε(P),假设子系统1内有N1个椭球,且这组椭球是嵌套的;即
&epsiv; ( P ( 1 ) &gamma; 0 ) &Superset; &epsiv; ( P ( 1 ) &gamma; 1 ) &Superset; &CenterDot; &CenterDot; &CenterDot; &Superset; &epsiv; ( P ( 1 ) &gamma; N j ) - - - ( 6 )
在t(2)0时刻,系统由1子系统切换到2子系统;当子系统发生切换时,定义子系统1有如下N1个有界的集合:
E ( 1 ) i - 1 = &epsiv; ( P ( 1 ) &gamma; i - 1 ) \ &epsiv; ( P ( 1 ) &gamma; i ) , i &Element; I [ 1 , N 1 ]
本发明中用凸包的方法处理饱和非线性;对于i∈I[1,N1],考虑下面的集合
I ( 1 ) i - 1 &Element; { x : | B ( 1 ) k T P ( &gamma; ( 1 ) i ) x | &le; 1 , k &Element; I [ 1 , m ] }
其中,|·|表示绝对值,B(1)k表示B1的第k列,则
| B ( 1 ) k T P ( &gamma; ( 1 ) i ) x | 2 = B ( 1 ) k T P ( &gamma; ( 1 ) i ) xx T P ( &gamma; ( 1 ) i ) B ( 1 ) k &le; &Sigma; k = 1 m B ( 1 ) k T P ( &gamma; ( 1 ) i ) xx T P ( &gamma; ( 1 ) i ) B ( 1 ) k = x T P ( &gamma; ( 1 ) i ) B 1 B 1 T P ( &gamma; ( 1 ) i ) x &le; x T P 1 / 2 ( &gamma; ( 1 ) i ) tr ( P 1 / 2 ( &gamma; ( 1 ) i ) B 1 B 1 T P 1 / 2 ( &gamma; ( 1 ) i ) ) P 1 / 2 ( &gamma; ( 1 ) i ) x = n &gamma; ( 1 ) i x T P ( &gamma; ( 1 ) i ) x = x T P ( 1 ) &gamma; i x , &ForAll; k &Element; I [ 1 , m ] - - - ( 7 )
从而根据的定义有 &epsiv; ( P ( 1 ) &gamma; i - 1 ) &SubsetEqual; L ( 1 ) i - 1 , &ForAll; i &Element; I [ 1 , N 1 ] ;
对于i∈I[1,N1],如果则可知x∈L(1)i-1’由公式(7)可知控制律简化成 u 1 = - B 1 T P ( &gamma; ( 1 ) i - 1 ) x 且||u1||≤1;
针对子系统1,设计如下形式的控制器
u 1 = u ( 1 ) N 1 = - B 1 T P ( &gamma; ( 1 ) N 1 ) x , x &Element; &epsiv; ( P ( 1 ) &gamma; N 1 ) u ( 1 ) N 1 - 1 = - B 1 T P ( &gamma; ( 1 ) N 1 - 1 ) x , x &Element; &epsiv; ( P ( 1 ) &gamma; N 1 - 1 ) \ &epsiv; ( P ( 1 ) &gamma; N 1 ) . . . u ( 1 ) 0 = - B 1 T P ( &gamma; ( 1 ) 0 ) x , x &Element; &epsiv; ( P ( 1 ) &gamma; 0 ) \ &epsiv; ( P ( 1 ) &gamma; 1 ) - - - ( 8 )
当t∈[t(1)0,t(2)0)时,系统(3)的控制器为式(8);
步骤2.3:针对子系统1,取下面的Lyapunov函数
V ( 1 ) i - 1 ( x ( t ) ) = n &gamma; ( 1 ) i - 1 x T ( t ) P ( &gamma; ( 1 ) i - 1 ) x ( t ) , &ForAll; x ( t ) &Element; E ( 1 ) i - 1
V(1)i-1(x(t))是时不变的,对于t∈[t(1)i-1,t(1)i],i∈I[1,N1],有
V ( 1 ) i - 1 ( x ( t ) ) &le; V ( 1 ) i - 1 ( x ( t ( 1 ) i - 1 ) ) e - &gamma; ( 1 ) i - 1 ( t - t ( 1 ) i - 1 ) - - - ( 9 )
由式(9)可解得
| | x ( t ) | | &le; &kappa; i - 1 1 2 e - &gamma; ( 1 ) i - 1 2 ( t - t ( j ) i - 1 ) | | x ( t ( 1 ) i - 1 ) | | , t &Element; [ t ( 1 ) i - 1 , t ( 1 ) i ) &kappa; N 1 1 2 e - &gamma; ( 1 ) N 2 ( t - t ( 1 ) N 1 ) | | x ( t ( 1 ) N 1 ) | | , t &Element; [ t ( 1 ) N 1 , t ( 2 ) 0 ) - - - ( 10 )
其中,||·||表示2范数,λmin{P(γ(1)i)}≤P(γ(1)i)≤λmax{P(γ(1)i)},λmin{P(γ(1)i)}表示对称矩阵P(γ(1)i)的最小特征值,λmax{P(γ(1)i)}表示对称矩阵P(γ(1)i)的最大特征值;那么,当i∈I[1,N1]时,定义 &kappa; i = &lambda; max { P ( &gamma; ( 1 ) i ) } &lambda; min { P ( &gamma; ( 1 ) i ) } ;
在t(2)0时刻,子系统由1切换到2时, | | x - ( t ( 2 ) 0 ) - x 1 * | | &le; &kappa; N 1 1 2 e - &gamma; ( 1 ) N 2 ( t ( 2 ) 0 - t ( 1 ) N 1 ) | | x ( t ( 1 ) N 1 ) | | ;
z 1 = x - ( t ( 2 ) 0 ) - x 1 * , 可以得出
| | x ( t ( 2 ) 0 ) | | = | | x &OverBar; ( t ( 2 ) 0 ) - x &OverBar; 2 * | | = | | z 1 + x &OverBar; 1 * - x &OverBar; 2 * | | &le; | | z 1 | | + | | x &OverBar; 1 * - x &OverBar; 2 * | | &le; &kappa; N 1 1 2 e - &gamma; ( 1 ) N 1 2 ( t ( 2 ) 0 - t ( 1 ) N 1 ) | | x ( t ( 1 ) N 1 ) | | + | | x &OverBar; 1 * - x &OverBar; 2 * | | - - - ( 11 )
当子系统2的初值即瞬间切换的初始条件x(t(2)0)满足公式(11)时,取γ(2)0使得
(2)0xT(t(2)0)P(γ(2)0)x(t(2)0)=1
成立;
当公式(11)成立时,则有γ(2)0的估计值为
&gamma; ( 2 ) 0 &lambda; max ( P ( &gamma; ( 2 ) 0 ) ) &GreaterEqual; 1 | | x ( t ( 2 ) 0 ) | | 2 &gamma; ( 2 ) 0 > max { 0,2 Re { &lambda; max { - A 2 } } } - - - ( 12 )
公式(11)和公式(12)保证了子系统2的初值在椭球边界上;且满足
&epsiv; ( P ( 2 ) &gamma; 0 ) &cap; &epsiv; ( P ( 1 ) &gamma; N 1 ) &NotEqual; &epsiv; ( P ( 1 ) &gamma; N 1 )
针对子系统2进行控制器设计,设计方法重复子系统1的设计过程,直到系统切换到子系统M-1;
(Aj,Bj)可控,当j=1,2,…,M-1时,则控制器u从控制器集合{u1,u2,…,uM-1}依次切换,即,当t∈[t(j)0,t(j+1)0)时,系统(3)的控制器为如下形式
u j = u ( j ) N j = - B j T P ( &gamma; ( j ) N j ) x , x &Element; &epsiv; ( P ( j ) &gamma; N j ) u ( j ) N j - 1 = - B j T P ( &gamma; ( j ) N j - 1 ) x , x &Element; &epsiv; ( P ( j ) &gamma; N j - 1 ) \ &epsiv; ( P ( j ) &gamma; N j ) &CenterDot; &CenterDot; &CenterDot; u ( j ) 0 = - B j T P ( &gamma; ( j ) 0 ) x , x &Element; &epsiv; ( P ( j ) &gamma; 0 ) \ &epsiv; ( P ( j ) &gamma; 1 )
在切换时刻t(j+1)0,子系统j+1的初值x(t(j+1)0)和γ(j+1)0满足下面的公式
| | x ( t ( j + 1 ) 0 ) | | &le; &kappa; N j 1 2 e - &gamma; ( j ) N 2 ( t ( j + 1 ) 0 - t ( j ) N j ) | | x ( t ( j ) N j ) | | + | | x &OverBar; j * - x &OverBar; j + 1 * | |
&gamma; ( j + 1 ) 0 &lambda; max ( P ( &gamma; ( j + 1 ) 0 ) ) &GreaterEqual; 1 | | x ( t ( j + 1 ) 0 ) | | 2 &gamma; ( j ) 0 > max { 0,2 Re { &lambda; max { - A j } } }
&epsiv; ( P ( j + 1 ) &gamma; 0 ) &cap; &epsiv; ( P ( j ) &gamma; N j ) &NotEqual; &epsiv; ( P ( j ) &gamma; N j )
系统由子系统j切换到子系统j+1时状态收敛到子系统j+1的第一个椭球的边界上;
当j=M时,系统切换到最后一个子系统,系统(3)的控制器切换为
u M = u ( M ) N M = - B M T P ( &gamma; ( M ) N M ) x , x &Element; x &Element; &epsiv; ( P ( M ) &gamma; N M ) u ( M ) N M - 1 = - B M T P ( &gamma; ( M ) N M - 1 ) x , x &Element; &epsiv; ( P ( M ) &gamma; N M - 1 ) \ &epsiv; ( P ( M ) &gamma; N M ) . . . u ( M ) 0 = - B M T P ( &gamma; ( M ) 0 ) x , x &Element; &epsiv; ( P ( M ) &gamma; 0 ) \ &epsiv; ( P ( M ) &gamma; 1 )
多平衡点切换系统的稳定性分析如下:
当j=1,2,…,M-1时,如果i∈I[1,Nj],t∈[t(j)i-1,t(j)i)时,状态x(t(j)i-1)从椭球的边界指数收敛到的边界,当时,从椭球的边界收敛到的边界;
当j=M,也就是切换到子系统M时,有
| | x ( t ) | | &le; &kappa; i - 1 1 2 e - &gamma; ( M ) i - 1 2 ( t - t ( M ) i - 1 ) | | x ( t ( M ) i - 1 ) | | , t &Element; [ t ( M ) i - 1 , t ( M ) i ) &kappa; N M 1 2 e - &gamma; ( M ) N M 2 ( t - t ( M ) N M ) | | x ( t ( M ) N M ) | | , t &Element; [ t ( M ) N M , &infin; )
即对于i∈I[1,NM],当t∈[t(M)i-1,t(M)i),状态x(t(M)i-1)从椭球的边界指数收敛到的边界,当时,状态指数收敛到原点,因此系统(3)是指数稳定的。
具体实施方式二:本实施方式所述的步骤2.1中γ(1)0由等式(13)得出
n&gamma; ( 1 ) 0 x ( 1 ) 0 T P ( &gamma; ( 1 ) 0 ) x ( 1 ) 0 = 1 - - - ( 13 )
且需要满足下面约束
&gamma; ( 1 ) 0 > max { 0,2 Re { &lambda; max { - A 1 } } }
其中,λmax为矩阵的最大特征值,Re{·}是特征值的实部。
其它步骤与具体实施方式一相同。
具体实施方式三:本实施方式利用具体实施方式一所述的离散增益调度控制器实现BTT导弹控制的方法包括下述步骤:
步骤1:选取x为BTT导弹多平衡点饱和切换系统的状态向量,建立多平衡点线性切换系统,如公式(2-1)所示
x &CenterDot; = A ( t ) x + B ( t ) u - - - ( 2 - 1 )
x=[ωz α ωyβ]T为BTT导弹俯仰/偏航通道控制系统的状态向量,u=[δz δy]T为的输入向量,为x的导数;
其中,
A ( t ) = 1 J z ( 1 2 V m mq L + m z &alpha; &CenterDot; ) qSL 1 J z m z &alpha; qSL J x - J y J z &omega; x 1 J z ( m z &beta; + m z &alpha; &CenterDot; &omega; x ) qSL 1 - 1 Vm c y &alpha; qS 0 - &omega; x - 1 Vm c y &beta; qS J x - J y J z &omega; x 1 J y ( m y &alpha; + m y &beta; &CenterDot; &omega; x ) qSL 1 J y ( 1 2 V m mr L + m y &beta; &CenterDot; ) qSL 1 J y m y &beta; qSL 0 &omega; x + 1 Vm c z &alpha; qS 1 1 Vm c z &beta; qS
B ( t ) = 1 J z m z &delta; z qSL 1 J z m z &delta; y qSL - 1 mV c y &delta; z qS - 1 mV c y &delta; y qS 1 J y m y &delta; z qSL 1 J y m y &delta; y qSL 1 mV c z &delta; z qS 1 mV c z &delta; y qS
式中,V为导弹质心速度,m为导弹质量,α为攻角,β为侧滑角,δy和δz分别为方向舵偏角和升降舵偏角,ωx和ωy为导弹的转动角速度在弹体坐标系上的投影,Jx,Jy和Jz为导弹的惯性张量在弹体坐标系上的投影,m为导弹质量,cy和cz为导弹所受的气动力在速度坐标系中的气动系数,ρ为导弹所处高度的空间密度,S为特征面积,气动系数可以表示如下:
c y = c y 0 + c y &alpha; &alpha; + c y &beta; &beta; + c y &delta; z &delta; z + c y &delta; y &delta; y c z = c z &alpha; &alpha; + c z &beta; &beta; + c z &delta; z &delta; z + c z &delta; y &delta; y - - - ( 2 - 2 )
其中,cy0为攻角和升降舵偏角均为零时的升力系数,本发明研究的轴对称导弹有cy0=0,为气动系数cy中对应的偏导小系数,为气动系数cz中偏导对应小系数,my和mz为作用与导弹上的所有外力对质心之力矩在弹体坐标系各轴上分量中的力矩系数,L为特征长度,对于气动轴对称的导弹, 和mnr为力矩系数my中对应的偏导小系数,和mmq为力矩系数mz中对应的偏导小系数,力矩系数可近似表示为
m y = m y &alpha; &alpha; + m y &beta; + + m y &beta; &CenterDot; &beta; &CenterDot; + m y &delta; z &delta; z + c y &delta; y &delta; y + m nr L 2 V &omega; y m z = m z &alpha; &alpha; + m z &alpha; &CenterDot; &alpha; &CenterDot; + m z &beta; &beta; + m z &delta; z &delta; z + m z &delta; y &delta; y + m mq L 2 V &omega; z - - - ( 2 - 3 )
步骤2:多平衡点BTT导弹离散增益调度控制器设计:
假设(Aj,Bj)可控(j=1,2),多平衡点BTT导弹离散增益调度控制器设计具体实现过程如下:
步骤2.1:定义集合 &Gamma; N 1 = { &gamma; ( 1 ) 0 , &gamma; ( 1 ) 1 , &CenterDot; &CenterDot; &CenterDot; , &gamma; ( 1 ) N j } , &gamma; ( 1 ) i - 1 < &gamma; ( 1 ) i , i &Element; I [ 1 , N 1 ] , 满足集合ΓN1的γ(1)i的选取方法是:
&gamma; ( 1 ) i = &gamma; ( 1 ) 0 + i N j ( &gamma; ( 1 ) N j - &gamma; ( 1 ) 0 ) , i &Element; I [ 1 , N 1 ] - - - ( 2-4 )
其中,γ(1)0得出且满足γ(1)0>max{0,2Re{λmax{-A1}}},矩阵P(γ(1)i)是下面参量Riccati方程的唯一对称正定解
A 1 T P ( &gamma; ( 1 ) i ) + P ( &gamma; ( 1 ) i ) A 1 - P ( &gamma; ( 1 ) i ) B 1 B 1 T P ( &gamma; ( 1 ) i ) = - &gamma; ( 1 ) i P ( &gamma; ( 1 ) i )
令P(γ(1)i)=W-1(1)i),那么解参量Riccati方程可转化为解参量Lyapunov方程(2-5)
( A 1 + &gamma; ( 1 ) i 2 I n ) W ( &gamma; ( 1 ) i ) + W ( &gamma; ( 1 ) i ) ( A 1 + &gamma; ( 1 ) i 2 I n ) T = BB T - - - ( 2-5 )
其中,In是单位矩阵;
步骤2.2:根据椭球的标准定义形式ε(P,1)={x:xTPx≤1},假设子系统1内有N1个椭球,且这组椭球是嵌套的;即
&epsiv; ( P ( 1 ) &gamma; 0 ) &Superset; &epsiv; ( P ( 1 ) &gamma; 1 ) &Superset; &CenterDot; &CenterDot; &CenterDot; &Superset; &epsiv; ( P ( 1 ) &gamma; N j ) - - - ( 2 - 6 )
假设在t(2)0=2.5s时刻,系统由1子系统切换到2子系统;可以定义当子系统发生切换时,第1子系统有如下N1=20个有界的集合:
E ( 1 ) i - 1 = &epsiv; ( P ( 1 ) &gamma; i - 1 ) \ &epsiv; ( P ( 1 ) &gamma; i ) , i &Element; I [ 1 , N 1 ]
当t∈[t(1)0,t(2)0)时,子系统1发生作用,系统(2-1)的控制器为如下形式
u 1 = u ( 1 ) N 1 = - B 1 T P ( &gamma; ( 1 ) N 1 ) x , x &Element; &epsiv; ( P ( 1 ) &gamma; N 1 ) u ( 1 ) N 1 - 1 = - B 1 T P ( &gamma; ( 1 ) N 1 - 1 ) x , x &Element; &epsiv; ( P ( 1 ) &gamma; N 1 - 1 ) \ &epsiv; ( P ( 1 ) &gamma; N 1 ) &CenterDot; &CenterDot; &CenterDot; u ( 1 ) 0 = - B 1 T P ( &gamma; ( 1 ) 0 ) x , x &Element; &epsiv; ( P ( 1 ) &gamma; 0 ) \ &epsiv; ( P ( 1 ) &gamma; 1 ) - - - ( 2 - 8 )
步骤2.3:对子系统1,取下面的Lyapunov函数
V ( 1 ) i - 1 ( x ( t ) ) = n&gamma; ( 1 ) i - 1 x T ( t ) P ( &gamma; ( 1 ) i - 1 ) x ( t ) , &ForAll; x ( t ) &Element; E ( 1 ) i - 1
给出子系统2的初值即瞬间切换的初始条件x(t(2)0)和γ(2)0的估计值,
V(1)i-1(x(t))是时不变的,对V(1)i-1(x(t))求导,可知:对于i∈I[1,N1],有
| | x ( t ) | | &le; &kappa; i - 1 1 2 e - &gamma; ( 1 ) i - 1 2 ( t - t ( 1 ) i - 1 ) | | x ( t ( 1 ) i - 1 ) | | , t &Element; [ t ( 1 ) i - 1 , t ( 1 ) i ) &kappa; N 1 1 2 e - &gamma; ( 1 ) N 1 2 ( t - t ( 1 ) N 1 ) | | x ( t ( 1 ) N 1 ) | | , t &Element; [ t ( 1 ) N 1 , t ( 2 ) 0 ) - - - ( 2 - 10 )
其中, &kappa; i = &lambda; max { P ( &gamma; ( 1 ) i ) } &lambda; min { P ( &gamma; ( 1 ) i ) } , i &Element; I [ 1 , N 1 ] ;
在t(2)0时刻,子系统1切换到子系统2, | | x &OverBar; ( t ( 2 ) 0 ) - x j * | | &le; &kappa; N 1 1 2 e - &gamma; ( 1 ) N 1 2 ( t ( 2 ) 0 - t ( 1 ) N 1 ) | | x ( t ( 1 ) N 1 ) | | ;
z 1 = x &OverBar; ( t ( 2 ) 0 ) - x 1 * , 可以得出
| | x ( t ( 2 ) 0 ) | | &le; | | z 1 | | + | | x &OverBar; 1 * - x &OverBar; 2 * | | - - - ( 2 - 11 )
当子系统2的初值即瞬间切换的初始条件x(t(2)0)满足式子(2-11)时,可以得到γ(2)0的估计值
&gamma; ( 2 ) 0 &lambda; max ( P ( &gamma; ( 2 ) 0 ) ) &GreaterEqual; 1 | | x ( t ( 2 ) 0 ) | | 2 &gamma; ( 2 ) 0 > max { 0,2 Re { &lambda; max { - A 2 } } } - - - ( 2 - 12 )
式子(2-11)和式子(2-12)保证了子系统2的初值在椭球边界上,且
&epsiv; ( P ( 2 ) &gamma; 0 ) &cap; &epsiv; ( P ( 1 ) &gamma; N 1 ) &NotEqual; &epsiv; ( P ( 1 ) &gamma; N 1 )
当切换到子系统2时,重复子系统1控制器的设计过程,那么当t∈[t(2)0,∞)时,系统(2-1)的控制器切换为下面形式的控制器
u 2 = u ( 2 ) N 2 = - B 2 T P ( &gamma; ( 2 ) N 2 ) x , x &Element; &epsiv; ( P ( 2 ) &gamma; N 2 ) u ( 2 ) N 2 - 1 = - B 2 T P ( &gamma; ( 2 ) N 2 - 1 ) x , x &Element; &epsiv; ( P ( 2 ) &gamma; N 2 - 1 ) \ &epsiv; ( P ( 2 ) &gamma; N 2 ) &CenterDot; &CenterDot; &CenterDot; u ( 2 ) 0 = - B 2 T P ( &gamma; ( 2 ) 0 ) x , x &Element; &epsiv; ( P ( 2 ) &gamma; 0 ) \ &epsiv; ( P ( 2 ) &gamma; 1 )
多平衡点切换系统的稳定性分析:
当子系统2的初值即瞬间切换的初始条件x(t(2)0)满足式子(2-11)时,γ(2)0满足式子(2-12)时,可以看出对于的i∈I[1,N1],当t∈[t(1)i-1,t(1)i),状态x(t(1)i-1)从椭球的边界指数收敛到的边界,当时,从椭球的边界收敛到的边界;
针对第2个子系统设计一组嵌套的椭球,即N2=10
式子(2-11)和式子(2-12)保证了子系统2的初值在椭球边界上;类似于子系统1的稳定性,对于子系统2,则有
| | x ( t ) | | &le; &kappa; i - 1 1 2 e - &gamma; ( 2 ) i - 1 2 ( t - t ( 2 ) i - 1 ) | | x ( t ( 2 ) i - 1 ) | | , t &Element; [ t ( 2 ) i - 1 , t ( 2 ) i ) &kappa; N 2 1 2 e - &gamma; ( 2 ) N 2 2 ( t - t ( 2 ) N 2 ) | | x ( t ( 2 ) N 2 ) | | , t &Element; [ t ( 2 ) N 2 , &infin; )
其中, &kappa; i = &lambda; max { P ( &gamma; ( 2 ) i ) } &lambda; min { P ( &gamma; ( 2 ) i ) } , i &Element; I [ 1 , N 2 ] ;
也就是说对于的i∈I[1,N2],当t∈[t(2)i-1,t(2)i)时,状态x(t(2)i-1)从椭球的边界指数收敛到的边界,当时,状态指数收敛到原点,因此闭环系统(2-1)是指数稳定的。
具体实施例
步骤1:BTT导弹俯仰/偏航通道控制系统的数学模型为:
d ( x &OverBar; ( t ) - x &OverBar; &delta; ( t ) * ) dt = A &delta; ( t ) ( x &OverBar; ( t ) - x &OverBar; &delta; ( t ) * ) + B &delta; ( t ) u &OverBar; &delta; ( t )
A ( t ) = a 1 a 2 J x - J y J z &omega; x a 3 &omega; x 1 a 4 0 - &omega; x 57.3 J z - J x J y &omega; x a 5 &omega; x a 6 a 7 0 &omega; x 57.3 1 a 8 , B ( t ) = b 1 0 b 2 0 0 b 3 0 b 4 - - - ( 2 - 13 )
其中,x=[ωz α ωyβ]T,u=[δz δy]T
上述模型是一个复杂的时变系统。在整个飞行过程中,随着飞行高度及速度的变化,导弹的启动系数是不断闭环的。考虑到导弹控制系统的时变特性和工程上的可实现性,对导弹俯仰/偏航通道的自动驾驶仪系统采用多模型控制器,在特征点上的局部控制器设计完成之后,将其按一定的规则连接起来构成系统的全局控制器。以两个平衡点为例:
A 1 = - 1.8780 - 26.1298 - 5.2356 1.9895 1.0000 - 1.5060 0 - 6.9808 5.2356 - 2.0593 - 1.9500 - 39.7606 0 6.9808 1.0000 - 0.7710 , B 1 = - 172.5729 0 - 0.2430 0 0 - 170.4948 0 - 0.1910 - - - ( 2 - 14 )
对应的平衡点为 x 1 * = 10 0 9 0 T .
A 2 = - 0.4410 - 50.9849 - 5.2356 0.3002 1.0000 - 0.4210 0 - 6.9808 5.2356 - 0.3002 - 0.4410 9.6454 0 6.9808 1.0000 0.2430 , B 2 = - 43.8434 0 - 0.0780 0 0 - 59.5839 0 - 0.0720 - - - ( 2 - 15 )
对应平衡点为 x 2 * = 9.8 0 7 0 T .
步骤2:多平衡点BTT导弹离散增益调度控制器设计:
假设(Aj,Bj)可控(j=1,2),多平衡点BTT导弹离散增益调度控制器设计具体实现过程如下:
步骤2.1:P(γ(1)i)(i∈I[1,N1])的求解
定义集合γ(1)i-1<γ(1)i,i∈I[1,N1],N1=20,满足集合的γ(1)i的选取可以任意设计,其中,x(0)=[23.9566 010.00630]T,那么求得γ(1)0=3.3384,选γ(1)i选取的方法是:
&gamma; ( 1 ) i = &gamma; ( 1 ) 0 + i N 1 ( &gamma; ( 1 ) N 1 - &gamma; ( 1 ) 0 ) , i &Element; I [ 1 , N 1 ]
矩阵P(γ(1)i)是下面参量Riccati方程的唯一对称正定解
A 1 T P ( &gamma; ( 1 ) i ) + P ( &gamma; ( 1 ) i ) A 1 - P ( &gamma; ( 1 ) i ) B 1 B 1 T P ( &gamma; ( 1 ) i ) = - &gamma; ( 1 ) i P ( &gamma; ( 1 ) i )
令P(γ(1)i)=W-1(1)i),那么解参量Riccati方程可转化为解参量Lyapunov方程(2-16)
( A 1 + &gamma; ( 1 ) i 2 I n ) W ( &gamma; ( 1 ) i ) + W ( &gamma; ( 1 ) i ) ( A 1 + &gamma; ( 1 ) i 2 I n ) T = BB T - - - ( 2 - 16 )
步骤2.2:饱和非线性的处理
假设在t(2)0=2.5s时刻,γ(2)0=3.3384,选γ(2)i由式子解得。同理P(γ(2)i)由参量Lyapunov方程给出。系统由1子系统切换到2子系统。可以定义当子系统发生切换时,第1子系统有如下N1=20个有界的集合:
E ( 1 ) i - 1 &epsiv; ( P ( 1 ) &gamma; i - 1 ) \ &epsiv; ( P ( 1 ) &gamma; i ) , i &Element; I [ 1 , N 1 ]
当t∈[t(1)0,t(2)0)时,子系统1发生作用,系统(3)的控制器为如下形式
u 1 = u ( 1 ) N 1 = - B 1 T P ( &gamma; ( 1 ) N 1 ) x , x &Element; &epsiv; ( P ( 1 ) &gamma; N 1 ) u ( 1 ) N 1 - 1 = - B 1 T P ( &gamma; ( 1 ) N 1 - 1 ) x , x &Element; &epsiv; ( P ( 1 ) &gamma; N 1 - 1 ) \ &epsiv; ( P ( 1 ) &gamma; N 1 ) . . . u ( 1 ) 0 = - B 1 T P ( &gamma; ( 1 ) 0 ) x , x &Element; &epsiv; ( P ( 1 ) &gamma; 0 ) \ &epsiv; ( P ( 1 ) &gamma; 1 ) - - - ( 2 - 17 )
对子系统1,取下面的Lyapunov函数
V ( 1 ) i - 1 ( x ( t ) ) = 4 &gamma; ( 1 ) i - 1 x T ( t ) P ( &gamma; ( 1 ) i - 1 ) x ( t ) , &ForAll; x ( t ) &Element; E ( 1 ) i - 1
在t(2)0时刻,子系统1切换到子系统2。
步骤2.3:给出子系统2的初值即瞬间切换的初始条件x(t(2)0)和γ(2)0的估计值
可以看出V(1)i-1(x(t))是时不变的,对V(1)i-1(x(t))求导,可知:对于i∈I[1,N1],有
| | x ( t ) | | &le; &kappa; i - 1 1 2 e - &gamma; ( 1 ) i - 1 2 ( t - t ( 1 ) i - 1 ) | | x ( t ( 1 ) i - 1 ) | | , t &Element; [ t ( 1 ) i - 1 , t ( 1 ) i ) &kappa; N 1 1 2 e - &gamma; ( 1 ) N 1 2 ( t - t ( 1 ) N 1 ) | | x ( t ( 1 ) N 1 ) | | , t &Element; [ t ( 1 ) N 1 , t ( 2 ) 0 ) - - - ( 2 - 18 )
其中, &kappa; i = &lambda; max { P ( &gamma; ( 1 ) i ) } &lambda; min { P ( &gamma; ( 1 ) i ) } , i∈I[1,N1]。
此时,可以得出,
| | x - ( t ( 2 ) 0 ) - x j * | | &le; &kappa; N 1 1 2 e - &gamma; ( 1 ) N 1 2 ( t ( 2 ) 0 - t ( 1 ) N 1 ) | | x ( t ( 1 ) N 1 ) | |
z 1 = x - ( t ( 2 ) 0 ) - x 1 * , 可以得出
| | x ( t ( 2 ) 0 ) | | &le; | | z 1 | | + | | x - 1 * - x - 2 * | | - - - ( 2 - 19 )
当子系统2的初值即瞬间切换的初始条件x(t(2)0)满足式子(2-19)时,可以得到γ(2)0的估计值
&gamma; ( 2 ) 0 &lambda; max ( P ( &gamma; ( 2 ) 0 ) ) &GreaterEqual; 1 | | x ( t ( 2 ) 0 ) | | 2 &gamma; ( 2 ) 0 > max { 0,2 Re { &lambda; max { - A 2 } } } - - - ( 2 - 20 )
式子(2-19)和式子(2-20)保证了子系统2的初值在椭球边界上,且满足
&epsiv; ( P ( 2 ) &gamma; 0 ) &cap; &epsiv; ( P ( 1 ) &gamma; N 1 ) &NotEqual; &epsiv; ( P ( 1 ) &gamma; N 1 )
第2个子系统设计一组嵌套的椭球,即N2=10
当切换到子系统2时,重复子系统1控制器的设计过程,那么当t∈[t(2)0,∞)时,系统(3)的控制器切换为下面形式的控制器
u 2 = u ( 2 ) N 2 = - B 2 T P ( &gamma; ( 2 ) N 2 ) x , x &Element; &epsiv; ( P ( 2 ) &gamma; N 2 ) u ( 2 ) N 2 - 1 = - B 2 T P ( &gamma; ( 2 ) N 2 - 1 ) x , x &Element; &epsiv; ( P ( 2 ) &gamma; N 2 - 1 ) \ &epsiv; ( P ( 2 ) &gamma; N 2 ) . . . u ( 2 ) 0 = - B 2 T P ( &gamma; ( 2 ) 0 ) x , x &Element; &epsiv; ( P ( 2 ) &gamma; 0 ) \ &epsiv; ( P ( 2 ) &gamma; 1 )
仿真效果如图4、图5、图6和图7所示,第一个子系统N1=20,第二个子系统N2=10,可以看出,第一个子系统的收敛时间是小于第二个子系统的,且整个切换系统是稳定的。从仿真效果图2和3可以看出,两个控制量均在要求的范围内。
多平衡点切换系统的稳定性分析:
当子系统2的初值即瞬间切换的初始条件x(t(2)0)满足式子(2-19)时,γ(2)0满足式子(2-20)时,可以看出对于的i∈I[1,N1],当t∈[t(1)i-1,t(1)i),状态x(t(1)i-1)从椭球的边界指数收敛到的边界,当 t &Element; [ t ( 1 ) N 1 , t ( 2 ) 0 ) 时,从椭球的边界收敛到的边界。
针对第2个子系统设计一组嵌套的椭球,即N2=10
式子(2-19)和式子(2-20)保证了子系统2的初值在椭球边界上。类似于子系统1的稳定性,对于子系统2,则有
| | x ( t ) | | &le; &kappa; i - 1 1 2 e - &gamma; ( 2 ) i - 1 2 ( t - t ( 2 ) i - 1 ) | | x ( t ( 2 ) i - 1 ) | | , t &Element; [ t ( 2 ) i - 1 , t ( 2 ) i ) &kappa; N 2 1 2 e - &gamma; ( 2 ) N 2 2 ( t - t ( 2 ) N 2 ) | | x ( t ( 2 ) N 2 ) | | , t &Element; [ t ( 2 ) N 2 , &infin; )
其中, &kappa; i = &lambda; max { P ( &gamma; ( 2 ) i ) } &lambda; min { P ( &gamma; ( 2 ) i ) } , i &Element; I [ 1 , N 2 ] .
也就是说对于的i∈I[1,N2],当t∈[t(2)i-1,t(2)i)时,状态x(t(2)i-1)从椭球的边界指数收敛到的边界,当时,状态指数收敛到原点,因此闭环系统(19)是指数稳定的。

Claims (3)

1.一类多平衡点饱和切换系统的离散增益调度控制器设计方法,其特征在于它包括下述步骤:
步骤1:选取为系统的状态向量,建立多平衡点线性切换系统,如公式(1)所示
其中,为系统的状态向量,Rn为n维欧几里德空间,的导数,Aδ(t)和Bδ(t)是常数矩阵,为系统的输入向量,设计Kδ(t)为控制增益,Rm为m维欧几里德空间,切换信号δ(t):R+→Ι={1,2,…,M}是一个分段时间常值函数,切换信号是与时间相关的,决定了在切换时刻子系统的切换顺序,M>1为子系统个数;是系统的平衡点,当δ(t)=j时,第j个子系统起作用,其中j=1,2,…,M;假设(Aj,Bj)是可控的,Aj∈Rn×n,Bj∈Rn×m,j∈Ι且是第j个子系统的平衡点;
当执行器受限时,公式(1)形式的多平衡点线性切换系统可写为:
假设输入向量受到单位饱和函数的限制,形式如下:
sat(u)=[sat(u1) sat(u2) … sat(um)]T
sat(uk)=sign(uk)min{1,|uk|},k=1,…,m
对于切换信号δ(t),假设切换时间序列为:t(j)0<t(j)1<…<t(j+1)0<t(j+1)1<…<+∞,其中t(j)i-1表示第j个子系统作用时间ti-1,i∈Ι[0,Nj],当δ(t)=j时,子系统j被激活,则Aδ(t)=Aj,Bδ(t)=Bj,t∈[t(j)0,t(j+1)0);
则公式(2)可表示为:
步骤2:多平衡点饱和切换系统离散增益调度控制器设计:
假设(Aj,Bj)(j=1,2,…,M)可控,公式(3)形式的多平衡点饱和切换系统离散增益调度控制器设计具体实现过程如下:
步骤2.1:定义集合满足集合的γ(1)i的选取方法是:
其中,γ(1)0中的初值,大于γ(1)0
矩阵P(γ(1)i)是下面参量Riccati方程的唯一对称正定解
令P(γ(1)i)=W-1(1)i),那么解参量Riccati方程可转化为解参量Lyapunov方程(5)
其中,In是单位矩阵;
步骤2.2:根据椭球的标准定义形式ε(P,1)={x:xTPx≤1},可以写为ε(P),假设子系统1内有N1+1个椭球,且这组椭球是嵌套的;即
在t(2)0时刻,子系统由子系统1切换到子系统2;当子系统发生切换时,定义子系统1有如下N1个有界的集合:
用凸包的方法处理饱和非线性;对于i∈Ι[1,N1],考虑下面的集合
其中,|·|表示绝对值,B(1)k表示B1的第k列,则
从而根据L(1)i的定义有
对于i∈Ι[1,N1],如果则可知x∈L(1)i-1,由公式(7)可知控制律简化成 且||u1||≤1;
针对子系统1,设计如下形式的控制器
当t∈[t(1)0,t(2)0)时,公式(3)形式的多平衡点饱和切换系统的控制器为式(8);
步骤2.3:针对子系统1,取下面的Lyapunov函数
V(1)i-1(x(t))是时不变的,对于t∈[t(1)i-1,t(1)i],i∈Ι[1,N1],有
由式(9)可解得
其中,||·||表示2范数,λmin{P(γ(1)i)}≤P(γ(1)i)≤λmax{P(γ(1)i)},λmin{P(γ(1)i)}表示对称矩阵P(γ(1)i)的最小特征值,λmax{P(γ(1)i)}表示对称矩阵P(γ(1)i)的最大特征值;那么,当i∈Ι[1,N1]时,定义
在t(2)0时刻,子系统由子系统1切换到子系统2时, 
可以得出
当子系统2的初值即瞬间切换的初始条件x(t(2)0)满足公式(11)时,取γ(2)0使得
成立;
当公式(11)成立时,则有γ(2)0的估计值为
公式(11)和公式(12)保证了子系统2的初值在椭球边界上;且满足
针对子系统2进行控制器设计,设计方法重复子系统1的设计过程,直到系统切换到子系统M-1;
(Aj,Bj)可控,当j=1,2,…,M-1时,则控制器u从控制器集合{u1,u2,…,uM-1}依次切换,即,当t∈[t(j)0,t(j+1)0)时,公式(3)形式的多平衡点饱和切换系统的控制器为如下形式
在切换时刻t(j+1)0,子系统j+1的初值x(t(j+1)0)和γ(j+1)0满足下面的公式
系统由子系统j切换到子系统j+1时状态收敛到子系统j+1的第一个椭球的边界上;
当j=M时,系统切换到最后一个子系统,公式(3)形式的多平衡点饱和切换系统的控制器切换为
2.根据权利要求1所述的一类多平衡点饱和切换系统的离散增益调度控制器设计方法,其特征在于,步骤2.1中γ(1)0由等式(13)得出
且需要满足下面约束
γ(1)0>max{0,2Re{λmax{-A1}}}
其中,λmax为矩阵的最大特征值,Re{·}是特征值的实部。
3.一种利用权利要求1所述的离散增益调度控制器实现BTT导弹控制的方法,其特征在于它包括下述步骤:
步骤1:选取x为BTT导弹多平衡点饱和切换系统的状态向量,建立多平衡点线性切换系统,如公式(2-1)所示
x=[ωz α ωy β]T为BTT导弹俯仰/偏航通道控制系统的状态向量,u=[δz δy]T为输入向量,为x的导数;
其中,
式中,V为导弹质心速度,m为导弹质量,α为攻角,β为侧滑角,δy和δz分别为方向舵偏角和升降舵偏角,ωx和ωy为导弹的转动角速度在弹体坐标系上的投影,Jx,Jy和Jz为导弹的惯性张量在弹体坐标系上的投影,m为导弹质量,cy和cz为导弹所受的气动力在速度坐标系中的气动系数,ρ为导弹所处高度的空间密度,S为特征面积,气动系数可以表示如下:
其中,cy0为攻角和升降舵偏角均为零时的升力系数,轴对称导弹有cy0=0, 为气动系数cy中对应的偏导小系数,为气动系数cz中偏导对应小系数,my和mz为作用与导弹上的所有外力对质心之力矩在弹体坐标系各轴上分量中的力矩系数,L为特征长度,对于气动轴对称的导弹,和mnr为力矩系数my中对应的偏导小系数,和mmq为力矩系数mz中对应的偏导小系数,力矩系数可近似表示为
步骤2:多平衡点BTT导弹离散增益调度控制器设计:
假设(Aj,Bj)可控(j=1,2),多平衡点BTT导弹离散增益调度控制器设计具体实现过程如下:
步骤2.1:定义集合满足集合的γ(1)i的选取方法是:
其中,γ(1)0得出且满足γ(1)0>max{0,2Re{λmax{-A1}}},
矩阵P(γ(1)i)是下面参量Riccati方程的唯一对称正定解
令P(γ(1)i)=W-1(1)i),那么解参量Riccati方程可转化为解参量Lyapunov方程(2-5)
其中,In是单位矩阵;
步骤2.2:根据椭球的标准定义形式ε(P,1)={x:xTPx≤1},可以写为ε(P),假设子系统1内有N1+1个椭球,且这组椭球是嵌套的;即
假设在t(2)0=2.5s时刻,系统由子系统1切换到子系统2;可以定义当子系统发生切换时,子系统1有如下N1=20个有界的集合:
当t∈[t(1)0,t(2)0)时,子系统1发生作用,公式(2-1)形式的多平衡点线性切换系统的控制器为如下形式
步骤2.3:对子系统1,取下面的Lyapunov函数
给出子系统2的初值即瞬间切换的初始条件x(t(2)0)和γ(2)0的估计值,
V(1)i-1(x(t))是时不变的,对V(1)i-1(x(t))求导,可知:对于i∈Ι[1,N1],有
其中,
在t(2)0时刻,子系统1切换到子系统2,
可以得出
当子系统2的初值即瞬间切换的初始条件x(t(2)0)满足式子(2-11)时,可以得到γ(2)0的估计值
式子(2-11)和式子(2-12)保证了子系统2的初值在椭球边界上,且
当切换到子系统2时,重复子系统1控制器的设计过程,那么当t∈[t(2)0,∞)时,公式(2-1)形式的多平衡点线性切换系统的控制器切换为下面形式的控制器
CN201410418611.8A 2014-08-22 2014-08-22 一类多平衡点饱和切换系统的离散增益调度控制器设计方法及实现btt导弹控制的方法 Active CN104197792B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410418611.8A CN104197792B (zh) 2014-08-22 2014-08-22 一类多平衡点饱和切换系统的离散增益调度控制器设计方法及实现btt导弹控制的方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410418611.8A CN104197792B (zh) 2014-08-22 2014-08-22 一类多平衡点饱和切换系统的离散增益调度控制器设计方法及实现btt导弹控制的方法

Publications (2)

Publication Number Publication Date
CN104197792A CN104197792A (zh) 2014-12-10
CN104197792B true CN104197792B (zh) 2015-10-07

Family

ID=52083120

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410418611.8A Active CN104197792B (zh) 2014-08-22 2014-08-22 一类多平衡点饱和切换系统的离散增益调度控制器设计方法及实现btt导弹控制的方法

Country Status (1)

Country Link
CN (1) CN104197792B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
MX357387B (es) 2007-12-27 2018-07-06 Evogene Ltd Polipeptidos, polinucleotidos aislados utiles para modificar la eficacia en el uso de agua, eficacia en el uso del fertilizante, la tolerancia al estres biotico/abiotico, el rendimiento y biomasa en plantas.

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0083569A1 (en) * 1982-01-04 1983-07-13 General Electric Company Large angle, gravity compensated, bank-to-turn pursuit controller
CN103995540A (zh) * 2014-05-22 2014-08-20 哈尔滨工业大学 一种高超声速飞行器的有限时间轨迹快速生成方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH04270899A (ja) * 1991-02-26 1992-09-28 Mitsubishi Heavy Ind Ltd 巡航飛しょう体

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0083569A1 (en) * 1982-01-04 1983-07-13 General Electric Company Large angle, gravity compensated, bank-to-turn pursuit controller
CN103995540A (zh) * 2014-05-22 2014-08-20 哈尔滨工业大学 一种高超声速飞行器的有限时间轨迹快速生成方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
Bin Zhou 等.Stabilization of Discrete-Time SystemsWith Multiple Actuator Delays and Saturations.《IEEE TRANSACTIONS ON CIRCUITS AND SYSTEMS I: REGULAR PAPERS》.2013,第60卷(第2期),第389-400页. *
丁保春 等.鲁棒保性能切换控制器设计在BTT导弹中的应用.《黑龙江大学自然科学学报》.2007,第24卷(第5期),第576-582页. *
王茜 等.输入饱和系统的离散增益调度控制及其在在轨交会中的应用.《自动化学报》.2013,第40卷(第2期),第208-218页. *

Also Published As

Publication number Publication date
CN104197792A (zh) 2014-12-10

Similar Documents

Publication Publication Date Title
Bu et al. A prescribed performance control approach guaranteeing small overshoot for air-breathing hypersonic vehicles via neural approximation
Liu et al. Barrier Lyapunov function based reinforcement learning control for air-breathing hypersonic vehicle with variable geometry inlet
Liu et al. Barrier Lyapunov function-based integrated guidance and control with input saturation and state constraints
CN109343549A (zh) 一种飞行器姿态控制方法、系统、介质及设备
CN106094530B (zh) 倒立摆的非线性控制器设计方法
CN104950671A (zh) 基于自适应模糊的再入飞行器pid型滑模姿态控制方法
Zhang et al. Switched linear parameter-varying modeling and tracking control for flexible hypersonic vehicle
Luo et al. On decoupling trajectory tracking control of unmanned powered parafoil using ADRC-based coupling analysis and dynamic feedforward compensation
Shafiei et al. Application of partial sliding mode in guidance problem
Wang et al. Neural control of hypersonic flight dynamics with actuator fault and constraint
Zhang et al. Fixed-time disturbance observer-based nearly optimal control for reusable launch vehicle with input constraints
Puyou et al. Tolerance of aircraft longitudinal control to the loss of scheduling information: toward a performance oriented approach
Melkou et al. Fixed-wing UAV attitude and altitude control via adaptive second-order sliding mode
Xue et al. Compound tracking control based on MPC for quadrotors with disturbances
CN104197792B (zh) 一类多平衡点饱和切换系统的离散增益调度控制器设计方法及实现btt导弹控制的方法
Liu et al. Fuzzy adaptive tracking control within the full envelope for an unmanned aerial vehicle
CN103455035A (zh) 基于反步设计和非线性反馈的pd+姿态控制律设计方法
Liu et al. Soft variable structure controller design for constrained systems based on S-class functions
Verriest et al. Advances in optimal control of differential systems with the state suprema
Rezaei et al. Ship roll stabilization using an adaptive fractional-order sliding mode controller
Bachtiar et al. Nonlinear model predictive missile control with a stabilising terminal constraint
Weiss et al. Linear quadratic minimum-effort, specify-performance approach to missile guidance
Kanade et al. 2 DOF H-infinity loop shaping robust control for rocket attitude stabilization
Tran et al. Back-stepping based flight path angle control algorithm for longitudinal dynamics
CN105197185A (zh) 一种船舶舵机的迭代学习控制算法

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant