[发明专利]飞行器极限飞行时四元数任意步长正交级数近似输出方法有效
申请号: | 201110366546.5 | 申请日: | 2011-11-17 |
公开(公告)号: | CN102506864A | 公开(公告)日: | 2012-06-20 |
发明(设计)人: | 史忠科 | 申请(专利权)人: | 西北工业大学 |
主分类号: | G01C21/24 | 分类号: | G01C21/24 |
代理公司: | 暂无信息 | 代理人: | 暂无信息 |
地址: | 710072 *** | 国省代码: | 陕西;61 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | 本发明公开了一种飞行器极限飞行时四元数任意步长正交级数近似输出方法,用于解决现有的飞行器极限飞行时惯性设备输出四元数精度差的技术问题。技术方案是通过引入多个参数并将对滚转、俯仰、偏航角速度p,q,r采用改进的类似切比雪夫正交多项式的递推形式展开逼近,直接得到了四元数状态转移矩阵,保证了确定四元数的迭代计算精度。本发明根据工程精度的要求,确定对滚转、俯仰、偏航角速度p,q,r的任意步长正交多项式阶次,实现了对四元数状态方程转移矩阵Φe[(k+1)T,kT]的超线性逼近,保证了确定四元数的迭代计算精度,从而提高了飞行器极限飞行时惯性设备输出精度。 | ||
搜索关键词: | 飞行器 极限 飞行 时四元数 任意 步长 正交 级数 近似 输出 方法 | ||
【主权项】:
1.一种飞行器极限飞行时四元数任意步长正交级数近似输出方法,其特征在于包括以下步骤:根据四元数连续状态方程e · = A e e ]]> 和离散状态方程e(k+1)=Φe[(k+1)T,kT]e(k)其中e=[e1,e2,e3,e4]TA e = 1 2 0 - p - q - r p 0 r - q q - r 0 p r q - p 0 ]]> Φe[(k+1)T,kT]为Ae的状态转移矩阵,T为采样周期,
p,q,r分别为滚转、俯仰、偏航角速度;欧拉角
ψ分别指滚转、俯仰、偏航角;状态转移矩阵按照逼近式Φe[(k+1)T,kT]≈I+∏ζ+∏Ω∏1及e(k+1)=Φe[(k+1)T,kT]e(k)得到四元数的时间更新值;其中I = 1 0 0 0 0 1 0 0 0 0 1 0 0 0 0 1 , ]]> ξ(t)=[ξ0(t)ξ1(t)…ξn-1(t)ξn(t)]Tξ 0 ( t ) = 1 ξ 1 ( t ) = cos [ a cos - 1 ( 1 - 2 t / b ) ] ξ 2 ( t ) = 2 ξ 1 ( t ) · ξ 1 ( t ) - 1 · · · ξ i + 1 ( t ) = 2 ξ 1 ( t ) ξ 1 ( t ) - ξ i - 1 ( t ) ]]> i=2,3,…,n-1,0≤t≤NT,b=NT为Chebyshev(切比雪夫)正交多项式的递推形式,a为任意实数,b≥NT,滚转、俯仰、偏航角速度p,q,r的n阶展开式分别为p(t)=[p0 p1…pn-1 pn][ξ0(t)ξ1(t)…ξn-1(t)ξn(t)]Tq(t)=[q0 q1…qn-1 qn][ξ0(t)ξ1(t)…ξn-1(t)ξn(t)]Tr(t)=[r0 r1…rn-1 rn][ξ0(t)ξ1(t)…ξn-1(t)ξn(t)]TΠ = 1 2 { 0 - 1 0 0 1 0 0 0 0 0 0 1 0 0 - 1 0 p 0 p 1 · · · p n - 1 p n ]]>+ 0 0 - 1 0 0 0 0 - 1 1 0 0 0 0 1 0 0 q 0 q 1 · · · q n - 1 q n + 0 0 0 - 1 0 0 1 0 0 - 1 0 0 1 0 0 0 r 0 r 1 · · · r n - 1 r n } ]]>Π 1 = 1 2 { p 0 p 1 · · · p n - 1 p n T 0 - 1 0 0 1 0 0 0 0 0 0 1 0 0 - 1 0 ]]>+ q 0 q 1 · · · q n - 1 q n T 0 0 - 1 0 0 0 0 - 1 1 0 0 0 0 1 0 0 + r 0 r 1 · · · r n - 1 r n T 0 0 0 - 1 0 0 1 0 0 - 1 0 0 1 0 0 0 } ]]>ζ = ζ 0 ζ 1 · · · ζ n T = ∫ kT ( k + 1 ) T ξ ( t ) dt ]]>ζ i = ∫ kT ( k + 1 ) T ξ i ( t ) dt = ∫ kT ( k + 1 ) T cos [ ai cos - 1 ( 1 - 2 t / b ) ] dt ]]>= b 4 { 1 ai - 1 cos [ ( ai - 1 ) cos - 1 ( 1 - 2 t / b ) ] ]]>- 1 ai + 1 cos [ ( ai + 1 ) cos - 1 ( 1 - 2 t / b ) ] } | kT ( k + 1 ) T ]]>Ω = { Ω ji } j = 0,1 , · · · , n , i = 1,2 , · · · , n = ∫ kT ( k + 1 ) T ξ ( t ) ∫ kT T ξ ( τ ) dτdt ]]>Ω ji = ∫ kT ( k + 1 ) T ξ j ( t ) ∫ kT t ξ i ( τ ) dτdt ]]>= b 8 { 1 ai - 1 ∫ kT ( k + 1 ) T { cos [ ( aj - ai + 1 ) cos - 1 ( 1 - 2 t / b ) ] + cos [ ( aj + ai - 1 ) cos - 1 ( 1 - 2 t / b ) ] } dt ]]>- 1 ai + 1 ∫ kT ( k + 1 ) T { cos [ ( aj - ai - 1 ) cos - 1 ( 1 - 2 t / b ) ] + cos [ ( aj + ai + 1 ) cos - 1 ( 1 - 2 t / b ) ] } dt } ]]>- b 4 { 1 ai - 1 cos [ ( ai - 1 ) cos - 1 ( 1 - 2 kT / b ) ] ]]>- 1 ai + 1 cos [ ( ai + 1 ) cos - 1 ( 1 - 2 kT / b ) ] } ∫ kT ( k + 1 ) T cos [ aj cos - 1 ( 1 - 2 t / b ) ] dt . ]]>
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于西北工业大学,未经西北工业大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/201110366546.5/,转载请声明来源钻瓜专利网。