[发明专利]一种应用于容错飞行控制系统的鲁棒控制分配方法

摘要

本发明涉及一种应用于容错飞行控制系统的鲁棒控制分配方法，属于航天航空容错飞行控制技术领域，包括将飞行器模型进行线性化，生成控制效率矩阵，确定每个舵面对飞行器三轴姿态控制影响的效率系数；建立故障模型，将故障参数估计问题转化为线性回归问题，从而使用最小二乘线性回归方法估计故障参数；使用故障投影的方法计算每个舵面对应的故障参数估计结果的不确定性，并进行加权平滑；考虑舵面对应的故障参数的不确定性的差别，求解使最差条件下的控制分配误差最小的优化问题，进行鲁棒控制分配，将该优化问题等价转化为一个凸优化问题，并使用原始对偶内点法进行求解得到鲁棒控制分配结果。本发明提高了控制分配结果的鲁棒性。

主权项

一种应用于容错飞行控制系统的鲁棒控制分配方法，其特征在于，该方法包括以下步骤：1)控制效率矩阵生成：对飞行器模型进行线性化，得到控制效率矩阵B，并引入以矩阵形式的故障参数Λ，用以衡量舵面缺失故障对控制效率的损失；2)建立故障模型，进行故障诊断，估计故障参数：针对舵面缺失故障，建立故障模型，将故障参数Λ转化为线性回归的形式，并使用最小二乘线性回归方法，计算得到故障参数估计结果3)使用故障投影的方法计算每个舵面对应的故障参数估计结果的不确定性ΔΛ，并进行加权平滑：由线性回归模型计算得到力矩偏差该力矩偏差表示根据飞行器运动传感器测量计算的控制力矩y与根据控制效率矩阵计算得到的力矩的差值，为故障参数的估计结果的向量形式；将BuU表示为BuU＝[b1,b2,...,bm]，其中，b1,b2,...,bm均为列向量；如果Δy≠0且Δy和bj的向量夹角小于一个阈值，该阈值取值范围5°～20°，则对Δy向bj按式(10)进行投影：Δλ~j=(Δy·bj)/||bj||---(10)]]>对式(10)投影得到的结果进行加权平滑，得到故障参数估计结果的不确定性Δλj，如式(11)所示：Δλj(t+1)=wΔλj(t)+(1-w)Δλ~j(t)---(11)]]>其中，w为加权系数，取值范围0.8～0.99；t表示第t个控制周期；Δλj的初值为0，即Δλj(0)＝0；不确定性Δλj表示故障参数λj的真实值属于一个区间内，即其中为向量中第j个元素；4)根据舵面对应的故障参数的不确定性，求解使最差条件下的控制分配误差最小的优化问题，将该优化问题等价转化为一个凸优化问题，并使用原始对偶内点法进行求解，进行鲁棒控制分配：通过调整控制变量u使得当故障参数变化时最差的条件下的||BΛu‑vc||最小，vc为控制器生成期望的三轴控制力矩指令，求解优化问题如式(12)所示：minumaxΛ||BΛu-vc||s.t.ui,min≤ui≤ui,maxλ^i-Δλi≤λi≤λ^i+Δλii=1,2,...,m---(12)]]>其中，ui,min和ui,max表示u向量中第i个元素ui的最小值和最大值；为向量中第i个元素，Δλi为故障参数估计结果的不确定性；根据步骤3)得到λi的取值范围的最小值和最大值分别为：和将优化问题式(12)等价转化为式(13)所示的凸优化问题：minu,ττs.t.||BΛiu-vc||≤τ,Λi∈B(Λ^,ΔΛ),i=1,2,...,2muj,min≤uj≤uj,max,j=1,2,...,m---(13)]]>其中，τ表示当Λ变化时||BΛu‑vc||的上界；uj,min和uj,max分别为u向量中第j个元素uj的最小值和最大值；ΔΛ＝diag([Δλ1,Δλ2,...,Δλm])表示故障参数估计结果的不确定性；表示在取值范围内的所有Λ组成的凸包的顶点组成的集合，其定义如式(14)所示：B(Λ^,ΔΛ)={Λ=diag(λ1,...,λm)|λi∈{λ^i-Δλi,λ^i+Δλi},Δλi≥0,i=1,...,m}---(14)]]>使用原始对偶内点法求解式(13)所示的优化问题，引入Lagrangian函数L(u,τ,μ)，将式(13)带有约束的优化问题转化为无约束的优化问题，如式(15)所示：L(u,τ,μ)=τ-μΣi=1mbln(τ2-||BΛiu-vc||2)-μΣj=1mln(uj-uj,min)-μΣk=1mln(uk,max-uk)-μlnτ---(15)]]>其中，mb＝2m；μ为障碍参数，当μ→0时，Lagrangian函数的最优值与原优化问题最优值相等；定义原始变量x＝[uT,τ]T和约束矢量函数c(x)如式(16)所示；c(x)=-||BΛ1u-vc||2-τ2...||BΛmbu-vc||2-τ2u1,min-u1...um,min-umu1-u1,max...um-um,max-τ---(16)]]>定义对偶变量满足zTc(x)＝μ，其中R表示实数集；根据Karush‑Kuhn‑Tucker(KKT)条件，当优化问题取得最优值时满足式(17)所示条件：c(x)≥0z≥0zTc(x)=0▿L(u,τ)|μ=0---(17)]]>定义对偶残差求解优化问题式(13)，具体包括以下步骤：41)计算控制变量u的优化迭代初值u0＝BT(BBT)‑1vc，若向量u0中元素u0,i＞ui,max，则该元素调整取最大值，即u0,i＝ui,max；若存在元素u0,i＜ui,min，则该元素调整取最小值，即u0,i＝ui,min；42)调整向量u0所有取值为边界值的元素，若u0,j＝uj,max，则调整为uj＝uj,min+η(uj,max‑uj,min)，其中uj为u中第j个元素，也即第j个舵面的偏转角度；若u0,j＝uj,min，则u0,j＝uj,min+(1‑η)(uj,max‑uj,min)；η的取值范围为0.8～0.98；使用调整后的u0计算τ的优化迭代初值如式(18)；τ0=maxΛ∈B(Λ^,ΔΛ)||BΛu0-vc||+1---(18)]]>43)计算障碍参数μ＝0.1·zTc(x)/mc，其中mc＝2m+2m+1表示优化变量总数，取对偶变量z的初值元素全为1，约束矢量函数c(x)计算如式(16)所示；44)计算搜索方向如式(19)所示：Δx=ΔuΔτ=-H-1rdualΔz=diag(c(x))-1(rc-diag(z)▿c(x)Δx)---(19)]]>其中，中心残差rc＝‑zTc(x)+μ1，1表示元素全为1的向量，根据rc的维度，可以确定μ1为mb+2m+1维向量且其每个元素均为μ；Hessian矩阵45)沿步骤44)中方向搜索，初始搜索步长α＝min{‑ui/Δui,‑τ/Δτ,‑zj/Δzj,1}(i＝1,…,m,j＝1,…,mc)；如果不满足式(17)的约束条件，则按照式(20)所示方式收缩搜索步长，直至满足约束：u+＝u+ραΔu,τ+＝τ+ραΔτ,z+＝z+ραΔz   (20)收缩系数ρ的取值范围为0.9～0.999；46)使用步骤45)中更新后的控制变量u+,τ+和z+计算更新和如果和满足ε的取值范围为0.1～0.00001，输出u+,u+即为鲁棒控制分配器的输出结果；否则重复步骤42)—45)进行迭代，直至满足步骤46)中条件或超过最大迭代步数，最大迭代步数取值范围20～200，输出u+；将u+作为控制分配的输出值发送给舵面以控制各个舵面的偏转角度。