CN102435192B - 基于角速度的欧拉角任意步长正交级数指数型近似输出方法 - Google Patents
基于角速度的欧拉角任意步长正交级数指数型近似输出方法 Download PDFInfo
- Publication number
- CN102435192B CN102435192B CN 201110380055 CN201110380055A CN102435192B CN 102435192 B CN102435192 B CN 102435192B CN 201110380055 CN201110380055 CN 201110380055 CN 201110380055 A CN201110380055 A CN 201110380055A CN 102435192 B CN102435192 B CN 102435192B
- Authority
- CN
- China
- Prior art keywords
- angle
- eulerian
- pitch
- cos
- formula
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Abstract
本发明公开了一种基于角速度的欧拉角任意步长正交级数指数型近似输出方法,用于解决现有的飞行器机动飞行时欧拉角输出精度差的技术问题。技术方案是通过引入多个参数并将滚转、俯仰、偏航角速度采用改进的类似切比雪夫正交多项式的递推形式展开逼近,按照依次求解俯仰角、滚转角、偏航角,直接对欧拉角的表达式进行高阶逼近积分,使得欧拉角的求解按照超线性逼近,保证了确定欧拉角的时间更新迭代计算精度,从而提高了惯性设备输出飞行姿态的准确性。
Description
技术领域
本发明涉及一种飞行器机动飞行姿态确定方法,特别是涉及一种基于角速度的欧拉角任意步长正交级数指数型近似输出方法。
背景技术
惯性设备在运动体导航和控制中具有重要作用;刚体运动的加速度、角速度和姿态等通常都依赖于惯性设备输出,因此提高惯性设备的输出精度具有明确的实际意义;在惯性设备中,加速度采用加速度计、角速度采用角速率陀螺直接测量方式,刚体的姿态精度要求很高时如飞行试验等采用姿态陀螺测量,但在很多应用领域都有角速度等测量直接解算输出;主要原因是由于动态姿态传感器价格昂贵、体积大,导致很多飞行器采用角速率陀螺等解算三个欧拉角,使得姿态时间更新输出成为导航等核心内容,也使其成为影响惯导系统精度的主要因素之一,因此设计和采用合理的姿态时间更新输出方法就成为研究的热点课题;从公开发表的文献中对姿态输出主要基于角速度采用欧拉方程直接近似法或采用近似龙格库塔方法解算(孙丽、秦永元,捷联惯导系统姿态算法比较,中国惯性技术学报,2006,Vol.14(3):6-10;Pu Li,Wang TianMiao,Liang JianHong,Wang Song,An Attitude Estimate Approach using MEMS Sensors forSmall UAVs,2006,IEEE International Conference on Industrial Informatics,1113-1117);由于欧拉方程中三个欧拉角互相耦合,属于非线性微分方程,在不同初始条件和不同飞行状态下的误差范围不同,难以保证实际工程要求的精度。
发明内容
为了克服现有的飞行器机动飞行时欧拉角输出精度差的问题,本发明提供一种基于角速度的欧拉角任意步长正交级数指数型近似输出方法。该方法通过引入多个参数并将滚转、俯仰、偏航角速度采用改进的类似切比雪夫正交多项式的递推形式展开逼近,通过按照依次求解俯仰角、滚转角、偏航角,直接对欧拉角的表达式进行高阶逼近积分,使得欧拉角的求解按照超线性逼近,从而保证了确定欧拉角的时间更新迭代计算精度和惯性单元的输出精度。
本发明解决其技术问题所采用的技术方案是:一种基于角速度的欧拉角任意步长正交级数指数型近似输出方法,其特点是包括以下步骤:
1、(a)根据欧拉方程:
式中:ψ分别指滚转、俯仰、偏航角;p,q,r分别为滚转、俯仰、偏航角速度;全文参数定义相同;这三个欧拉角的计算按照依次求解俯仰角、滚转角、偏航角的步骤进行;滚转、俯仰、偏航角速度p,q,r的展开式分别为
p(t)=pξ,q(t)=qξ,r(t)=rξ
其中
p=[p0p1...pn-1pn]q=[q0q1qn-1qn]
r=[r0r1...rn-1rn]ξ=[ξ0(t)ξ1(t)...ξn-1(t)ξn(t)]T
为改进的类似切比雪夫正交多项式的递推形式,a为任意实数,T为采样周期;
(b)俯仰角的时间更新求解式为:
式中:
a1=(qζ)2+(rζ)2-(pζ)2
a2=pΩrT
a3=pΩqT
2、在已知俯仰角的情况下,滚转角的时间更新求解式为:
其中
a4=(pζ)2+(rζ)2-(qζ)2
a5=qΩpT
a6=qΩrT
3、在俯仰角、滚转角已知情况下,偏航角的求解式为:
式中:
本发明的有益效果是:由于引入多个参数并将滚转、俯仰、偏航角速度采用改进的类似切比雪夫正交多项式的递推形式展开逼近,通过按照依次求解俯仰角、滚转角、偏航角,直接对欧拉角的表达式进行高阶逼近积分,使得欧拉角的求解按照超线性逼近,从而保证了确定欧拉角的时间更新迭代计算精度和惯性单元的输出精度。
下面结合具体实施方式对本发明作详细说明。
具体实施方式
1、(a)根据刚体姿态方程(欧拉方程):
式中:ψ分别指滚转、俯仰、偏航角;p,q,r分别为滚转、俯仰、偏航角速度;全文参数定义相同;这三个欧拉角的计算按照依次求解俯仰角、滚转角、偏航角的步骤进行;滚转、俯仰、偏航角速度p,q,r的展开式分别为
p(t)=pξ,q(t)=qξ,r(t)=rξ
其中
p=[p0p1...pn-1pn]q=[q0q1...qn-1qn]
r=[r0r1...rn-1rn]ξ=[ξ0(t)ξ1(t)...ξn-1(t)ξn(t)]T
为改进的类似Chebyshev(切比雪夫)正交多项式的递推形式,a为任意实数,T为采样周期;
(b)俯仰角的时间更新求解式为:
式中:
a1=(qζ)2+(rζ)2-(pζ)2
a2=pΩrT
a3=pΩqT
2、在已知俯仰角的情况下,滚转角的时间更新求解式为:
其中
a4=(pζ)2+(rζ)2-(qζ)2
a5=qΩpT
a6=qΩrT
3、在俯仰角、滚转角已知情况下,偏航角的求解式为:
式中:
当对惯性设备直接输出滚转、俯仰、偏航角速度p,q,r采用三阶逼近描述时,所得结果也接近O(T3),相比欧拉方程直接近似法或采用近似龙格库塔方法解算等方法的O(T2)精度要高。
Claims (1)
1.一种基于角速度的欧拉角任意步长正交级数指数型近似输出方法,其特征在于包括以下步骤:
步骤1、(a)根据欧拉方程:
式中: ,Ψ分别指滚转角、俯仰角、偏航角;p,q,r分别为滚转角速度、俯仰角速度、偏航角速度;这三个欧拉角的计算按照依次求解俯仰角、滚转角、偏航角的步骤进行;滚转角速度、俯仰角速度、偏航角速度p,q,r的展开式分别为
p(t)=pξ,q(t)=qξ,r(t)=rξ
其中
p=[p0 p1 … pn-1 pn]q=[q0 q1 … qn-1 qn]
r=[r0 r1 … rn-1 rn]ξ=[ξ0(t) ξ1(t) … ξn-1(t) ξn(t)]T
为改进的类似切比雪夫正交多项式的递推形式,a为任意实数,T为采样周期;
(b)俯仰角的时间更新求解式为:
式中:
a1=(qζ)2+(rζ)2-(pζ)2
a2=pΩrT
a3=pΩqT
步骤2、在已知俯仰角的情况下,滚转角的时间更新求解式为:
其中
a4=(pζ)2+(rζ)2-(qζ)2
a5=qΩpT
a6=qΩrT
步骤3、在俯仰角、滚转角已知情况下,偏航角的求解式为:
式中:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 201110380055 CN102435192B (zh) | 2011-11-25 | 2011-11-25 | 基于角速度的欧拉角任意步长正交级数指数型近似输出方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 201110380055 CN102435192B (zh) | 2011-11-25 | 2011-11-25 | 基于角速度的欧拉角任意步长正交级数指数型近似输出方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102435192A CN102435192A (zh) | 2012-05-02 |
CN102435192B true CN102435192B (zh) | 2013-10-09 |
Family
ID=45983395
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN 201110380055 Expired - Fee Related CN102435192B (zh) | 2011-11-25 | 2011-11-25 | 基于角速度的欧拉角任意步长正交级数指数型近似输出方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102435192B (zh) |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001141507A (ja) * | 1999-11-11 | 2001-05-25 | Yokogawa Denshikiki Co Ltd | 慣性航法装置 |
CA2338075A1 (en) * | 2001-01-19 | 2002-07-19 | University Technologies International Inc. | Continuous measurement-while-drilling surveying |
RU2256881C2 (ru) * | 2003-03-21 | 2005-07-20 | Федеральное государственное унитарное предприятие "Научно-исследовательский институт ПРИКЛАДНОЙ МЕХАНИКИ имени академика В.И. Кузнецова" | Способ определения параметров ориентации и навигации и бесплатформенная инерциальная навигационная система для быстровращающихся объектов |
KR100711261B1 (ko) * | 2006-06-21 | 2007-04-25 | (주)마이크로인피니티 | 입력 장치의 공간 인식 방법 및 그 장치 |
FR2933212B1 (fr) * | 2008-06-27 | 2013-07-05 | Movea Sa | Pointeur a capture de mouvement resolue par fusion de donnees |
US8989982B2 (en) * | 2008-08-29 | 2015-03-24 | Sony Corporation | Velocity calculation device, velocity calculation method, and navigation device |
CN101726295B (zh) * | 2008-10-24 | 2011-09-07 | 中国科学院自动化研究所 | 考虑加速度补偿和基于无迹卡尔曼滤波的惯性位姿跟踪方法 |
CN101696883A (zh) * | 2009-10-29 | 2010-04-21 | 哈尔滨工程大学 | 光纤陀螺捷联惯性导航系统阻尼方法 |
-
2011
- 2011-11-25 CN CN 201110380055 patent/CN102435192B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN102435192A (zh) | 2012-05-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102645223B (zh) | 一种基于比力观测的捷联惯导真空滤波修正方法 | |
CN105241319B (zh) | 一种高速自旋制导炮弹空中实时对准方法 | |
CN109211232B (zh) | 一种基于最小二乘滤波的炮弹姿态估计方法 | |
CN102436437B (zh) | 基于角速度的飞行器极限飞行时四元数傅里埃近似输出方法 | |
CN102519466A (zh) | 基于角速度的欧拉角勒让德指数近似输出方法 | |
CN102494690A (zh) | 基于角速度的欧拉角任意步长正交级数近似输出方法 | |
CN104613984B (zh) | 临近空间飞行器传递对准模型不确定性的鲁棒滤波方法 | |
CN102435192B (zh) | 基于角速度的欧拉角任意步长正交级数指数型近似输出方法 | |
CN102519467B (zh) | 基于角速度的欧拉角切比雪夫指数近似输出方法 | |
CN102495828B (zh) | 基于角速度的欧拉角Hartley近似输出方法 | |
CN112304309B (zh) | 一种基于心动阵列的高超飞行器组合导航信息解算方法 | |
CN102506873A (zh) | 基于角速度的欧拉角拉盖尔近似输出方法 | |
CN102506870A (zh) | 基于角速度的欧拉角埃米特指数近似输出方法 | |
CN102519465B (zh) | 基于角速度的欧拉角傅里埃指数近似输出方法 | |
CN102519457B (zh) | 基于角速度的欧拉角傅里埃近似输出方法 | |
CN102495827B (zh) | 基于角速度的欧拉角埃米特近似输出方法 | |
CN102495826B (zh) | 基于角速度的欧拉角切比雪夫近似输出方法 | |
CN102519464B (zh) | 基于角速度的欧拉角Hartley指数近似输出方法 | |
CN102519462A (zh) | 基于角速度的欧拉角指数输出方法 | |
CN102506869A (zh) | 基于角速度的欧拉角多项式类指数近似输出方法 | |
CN102519468B (zh) | 基于角速度的欧拉角拉盖尔指数近似输出方法 | |
CN102494689A (zh) | 基于角速度的欧拉角多项式类近似输出方法 | |
CN102506864B (zh) | 飞行器极限飞行时四元数任意步长正交级数近似输出方法 | |
CN102506874A (zh) | 基于角速度的欧拉角超线性输出方法 | |
CN102519461B (zh) | 基于角速度的欧拉角沃尔什指数近似输出方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20131009 Termination date: 20211125 |
|
CF01 | Termination of patent right due to non-payment of annual fee |