[发明专利]纵向飞行模型簇人机闭环复合根轨迹多级PID鲁棒控制器设计方法

摘要

本发明提供了一种纵向飞行模型簇人机闭环复合根轨迹多级PID鲁棒控制器设计方法，该方法在给定不同高度、马赫数条件下通过扫频飞行试验直接确定获得全包线内的幅频和相频特性构成的模型簇；根据飞行包线内的幅频裕度和相位裕度军标要求，给出了对应根轨迹描述下的闭环极点分布限制指标，通过加入多级PID控制器并在飞行器全包线内的闭环极点分布限制指标和系统辨识中的模型辨识方法确定多级PID鲁棒控制器级数和参数值；从根轨迹描述下的闭环极点分布限制的概念出发设计出符合全飞行包线的无驾驶员诱发振荡、超调量小、平稳的低空飞行控制器。

主权项

1.一种纵向飞行模型簇人机闭环复合根轨迹多级PID鲁棒控制器设计方法，其特点是包括以下步骤：1)给定不同高度、马赫数下通过扫频飞行试验直接由允许飞行的全包线内的幅频和相频特性构成飞行器全包线内的升降舵与飞行高度之模型簇，对应的飞行器升降舵与飞行高度之间开环传递函数簇描述为： G 0 ( S ) = e - σ ( h , M ) s K ( h , M ) A ( h , M , s ) B ( h , M , s ) [ 1 + Δ ( s ) ] ]]>其中A(h,M,s)=s^m+a_m-1(h,M)s^m-1+a_m-2(h,M)s^m-2+…+a₁(h,M)s+a₀(h,M)、B(h,M,s)=sⁿ+b_n-1(h,M)s^n-1+b_n-2(h,M)s^n-2+…+b₁(h,M)s+b₀(h,M)为多项式，s为传递函数中常用的拉普拉斯变化后的变量，h,M分别为飞行高度和马赫数，σ(h,M)是俯仰回路的延迟时间，K(h,M)为随h,M变化的增益，a_l(h,M),l=0,1,2,…,m-1为多项式A(h,M,s)中随h,M变化的系数簇，b_i(h,M),i=0,1,2,…,n-1为多项式B(h,M,s)中随h,M变化的系数簇，△k(s)为模型的不确定项；考虑人机闭环特性时驾驶员模型: Y p ( s ) = K p T D s + 1 T I s + 1 e - τs ]]>和系统开环传递函数或频率特性来估计人机闭环特性；其中：K_p为驾驶员环节的静态增益、τ为驾驶员的固有延时特性、T_D为驾驶员超前补偿时间常数、T_I为驾驶员滞后补偿时间常数；这样，人机系统的开环模型就变为： G ( s ) = K p T D s + 1 T I s + 1 e - τs e - σ ( h , M ) s K ( h , M ) A ( h , M , s ) B ( h , M , s ) [ 1 + Δk ( s ) ] ]]>2)候选多级PID控制器的传递函数为： G c ( s ) = Π i = 1 N [ k p ( i ) + k I ( i ) / s + k D ( i ) · s ] ]]>式中，k_c为待确定的常数增益，N为整数，表示待确定的多级PID控制器的级数，k_P(i)、k_I(i)、k_D(i)i=1,2,…,N为待确定的常数；加入多级PID控制器后，整个系统的开环传递函数为： G ( s ) G c ( s ) = K p T D s + 1 T I s + 1 e - τs e - σ ( h , M ) s K ( h , M ) A ( h , M , s ) B ( h , M , s ) [ 1 + Δk ( s ) ] Π i = 1 N [ k p ( i ) + k I ( i ) / s + k D ( i ) · s ] ]]>对应的根轨迹方程为： K p e - τs e - σ ( h , M ) s K ( h , M ) A ( h , M , s ) · ( T D s + 1 ) [ 1 + Δk ( s ) ] Π i = 1 N [ k p ( i ) · s + k I ( i ) + k D ( i ) · s 2 ] ; = - s · ( T I s + 1 ) · B ( h , M , s ) ]]>3)设s=σ+jω，其中：σ为s的实部，ω为s的虚部，j为虚部符号；系统的稳定裕度指标设定为：其中，为非零实数，ξ给定数；根据飞行试验或风洞试验建立模型不确定项造成的滞后相角弧度，幅值系统的稳定裕度指标调整为：和其中，△_M和△_a均为整实数；这样，系统的稳定裕度指标可以转化为：根据 { K p e - τs e - σ ( h , M ) s K ( h , M ) A ( h , M , s ) · ( T D s + 1 ) [ 1 + Δk ( s ) ] Π i = 1 N [ k p ( i ) · s + k I ( i ) + k D ( i ) · s 2 ] } s = σ + jω = - { s · ( T I s + 1 ) · B ( h , M , s ) } s = σ + jω ]]>或 Re { { K p e - τs e - σ ( h , M ) s k ( h , M ) A ( h , M , s ) · ( T D s + 1 ) [ 1 + Δk ( s ) ] Π i = 1 N [ k p ( i ) · s + k I ( i ) + k D ( i ) · s 2 ] } s = σ + jω } = - Re { { s · ( T I s + 1 ) · B ( h , M , s ) } s = σ + jω } Im { { K p e - τs e - σ ( h , M ) s K ( h , M ) A ( h , M , s ) · ( T D s + 1 ) [ 1 + Δk ( s ) ] Π i = 1 N [ k p ( i ) · s + K I ( i ) + K D ( i ) · s 2 ] } s = σ + jω } = Im { { s · ( T I s + 1 · B ( h , M , s ) 1 } s = σ + jω } ]]>所得到的根轨迹必须满足根据该指标和极大似然准则或其它准则共同约束下，可以根据系统模型结构辨识中的极大似然方法或辨识方法确定多级PID控制器的级数N、常数k_P(i)、k_I(i)、k_D(i)i=1,2,…,N。