[发明专利]基于角速度的飞行器极限飞行时四元数埃米特近似输出方法

摘要

本发明公开了一种基于角速度的飞行器极限飞行时四元数埃米特近似输出方法，用于解决现有的飞行器极限飞行时惯性设备输出四元数精度差的技术问题。技术方案是采用埃米特正交多项式对滚转、俯仰、偏航角速度p，q，r进行近似逼近描述，直接得到了四元数状态转移矩阵，从而保证了确定四元数的迭代计算精度；本发明的有益效果是：可以根据工程精度的要求，确定对滚转、俯仰、偏航角速度p，q，r埃米特正交多项式的阶次，实现对四元数状态方程转移矩阵Фe[(k+1)T，kT]的超线性逼近，保证了确定四元数的迭代计算精度，从而提高了飞行器极限飞行时惯性设备输出精度。

主权项

1.一种基于角速度的飞行器极限飞行时四元数埃米特近似输出方法，其特征在于包括以下步骤：根据四元数连续状态方程e·=Aee]]>和离散状态方程e(k+1)＝Φ_e[(k+1)T，kT]e(k)其中e＝[e₁，e₂，e₃，e₄]^TAe=120-p-q-rp0r-qq-r0prq-p0]]>Ф_e[(k+1)T，kT]为A_e的状态转移矩阵，T为采样周期，全文符号定义相同；p，q，r分别为滚转、俯仰、偏航角速度；欧拉角θ，ψ分别指滚转、俯仰、偏航角；状态转移矩阵按照逼近式Φe[(k+1)T,kT]≈I+ΠHξ(t)|kT(k+1)T+Π∫kT(k+1)T[ξ(t)ξT(t)]dtHTΠ1-ΠHξ(t)|kT(k+1)TΠHξ(kT)]]>及e(k+1)＝Φ_e[(k+1)T，kT]e(k)得到四元数的时间更新值；其中I=1000010000100001,]]>ξ(t)＝[ξ₀(t)ξ₁(t)…ξ_n-1(t)ξ_n(t)]^Tξ0(t)=1ξ1(t)=2tξ2(t)=4t2-2ξ3(t)=8t3-12tξ4(t)=16t4-48t2+12ξ5(t)=32t5-160t3+120tξ6(t)=64t6-480t4+720t-120...ξi+1(t)=2tξi(t)-2iξi-1(t)]]>i＝2，3，…，n-1为埃米特正交多项式的递推形式，滚转、俯仰、偏航角速度p，q，r的展开式分别为p(t)＝[p₀ p₁…p_n-1 p_n][ξ₀(t)ξ₁(t)…ξ_n-1(t)ξ_n(t)]^Tq(t)＝[q₀ q₁…q_n-1 q_n][ξ₀(t)ξ₁(t)…ξ_n-1(t)ξ_n(t)]^Tr(t)＝[r₀ r₁…r_n-1 r_n][ξ₀(t)ξ₁(t)…ξ_n-1(t)ξ_n(t)]^TΠ=12{0-1001000000100-10p0p1...pn-1pn]]>+00-10000-110000100q0q1...qn-1qn+000-100100-1001000r0r1...rn-1rn}]]>Π1=12{p0p1...pn-1pnT0-1001000000100-10]]>+q0q1...qn-1qnT00-10000-110000100+r0r1...rn-1rnT000-100100-1001000}]]>h₁₂＝0.5，h₂₃＝0.25，hi(i+1)=h(i-1)i1+2h(i-1)i,]]>…h₂₁＝0.5，h₄₁＝-1.5，h(2i)1=4ih(2i-2)11+2h(2i)(2i+1),]]>…其余h_ij＝0。