本发明专利技术公开了一种基于角速度的欧拉角拉盖尔近似输出方法，用于解决现有的飞行器机动飞行时欧拉角输出精度差的技术问题。技术方案是通过引入多个参数并将滚转、俯仰、偏航角速度按照拉盖尔正交多项式展开，按照依次求解俯仰角、滚转角、偏航角，直接对欧拉角的表达式进行高阶逼近积分，使得欧拉角的求解按照超线性逼近，保证了确定欧拉角的时间更新迭代计算精度，从而提高了惯性设备输出飞行姿态的准确性。
【技术实现步骤摘要】
本专利技术涉及一种飞行器机动飞行姿态确定方法，特别是涉及一种。
技术介绍
惯性设备在运动体导航和控制中具有重要作用；刚体运动的加速度、角速度和姿态等通常都依赖于惯性设备输出，因此提高惯性设备的输出精度具有明确的实际意义；在惯性设备中，加速度采用加速度计、角速度采用角速率陀螺直接测量方式，刚体的姿态精度要求很高时如飞行试验等采用姿态陀螺测量，但在很多应用领域都有角速度等测量直接解算输出；主要原因是由于动态姿态传感器价格昂贵、体积大，导致很多飞行器采用角速率陀螺等解算三个欧拉角，使得姿态时间更新输出成为导航等核心内容，也使其成为影响惯导系统精度的主要因素之一，因此设计和采用合理的姿态时间更新输出方法就成为研究的热点课题；从公开发表的文献中对姿态输出主要基于角速度采用欧拉方程直接近似法或采用近似龙格库塔方法解算(孙丽、秦永元，捷联惯导系统姿态算法比较，中国惯性技术学报， 2006, Vol. 14(3) :6-10 ；Pu Li, Wang TianMiao,Liang JianHong, Wang Song, An Attitude Estimate Approach using MEMS Sensors for Small UAVs,2006, IEEE International Conference on Industrial Informatics, 1113-1117)；由于欧拉方程中三个欧拉角互相耦合，属于非线性微分方程，在不同初始条件和不同飞行状态下的误差范围不同，难以保证实际工程要求的精度。
技术实现思路
为了克服现有的飞行器机动飞行时欧拉角输出精度差的问题，本专利技术提供一种。该方法通过引入多个参数并将滚转、俯仰、偏航角速度按照拉盖尔正交多项式展开，通过按照依次求解俯仰角、滚转角、偏航角，直接对欧拉角的表达式进行高阶逼近积分，使得欧拉角的求解按照超线性逼近，从而可以保证确定欧拉角的时间更新迭代计算精度和惯性单元的输出精度。本专利技术解决其技术问题所采用的技术方案是一种，其特点是包括以下步骤1、(a)根据欧拉方程权利要求1. 一种，其特征在于包括以下步骤 步骤1、(a)根据欧拉方程斧(^sin 沪+/ToS 劝/cos ^fc= ^+(^sm^+mDS^tan^式中φ,θ,ψ分别指滚转、俯仰、偏航角；p，q，r分别为滚转、俯仰、偏航角速度；全文参数定义相同；这三个欧拉角的计算按照依次求解俯仰角、滚转角、偏航角的步骤进行；滚转、俯仰、偏航角速度P，q，r的展开式分别为p(t)= q(t)= r(t)= 其中4(0 = 1 帥)=1-/4(0 = 1-2/+0.5/2/=2,3,L , -1M( +1)ξ +ι( ) = (1 + 2 - )ξ ( )- ξ _ι( ) 为拉盖尔正交多项式的递推形式，τ为采样周期，全文符号相同； (b)俯仰角的时间更新求解式为+1)] Q1 sin + a2coscos - a3sin式中O1 = 1 -P1 L P“ ρη]\1+1)ΤjlkT+1)Tm^(tmHT+卜。Lr“ |4(Γ4+1)ΓΛΗτ L .4ΓΗτ ξJf) ι L <h-i In|(4+1)ΓIir(4+1)Γ kT-ι( ) L ξn{t)ξπ+1( )]ξJf) +1(θ]4ΓΗτΗ 丨(4+1)ΓIkT 丨(4+1)Γ。。]啡。⑴ m L ξ ( ) ξη+1( )} I^1 ]难(0 ξλ{ ) L ξη( ) UO]1\kT \(k+l)T(k+l)T-0.5]^+1)7[ξ(0ξτ(0 诚Ht [凡 ρ, L Pn_x Pnf2. (a)在已知俯仰角的情况下，滚转角的时间更新求解式为=a4cos + a5cos + a6 sin其中全文摘要本专利技术公开了一种，用于解决现有的飞行器机动飞行时欧拉角输出精度差的技术问题。技术方案是通过引入多个参数并将滚转、俯仰、偏航角速度按照拉盖尔正交多项式展开，按照依次求解俯仰角、滚转角、偏航角，直接对欧拉角的表达式进行高阶逼近积分，使得欧拉角的求解按照超线性逼近，保证了确定欧拉角的时间更新迭代计算精度，从而提高了惯性设备输出飞行姿态的准确性。文档编号G01C21/24GK102506873SQ201110388550公开日2012年6月20日 申请日期2011年11月30日 优先权日2011年11月30日专利技术者史忠科 申请人:西北工业大学本文档来自技高网...
【技术保护点】
【技术特征摘要】
【专利技术属性】
技术研发人员：史忠科，
申请(专利权)人：西北工业大学，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。