CN102519464A - 基于角速度的欧拉角Hartley指数近似输出方法 - Google Patents
基于角速度的欧拉角Hartley指数近似输出方法 Download PDFInfo
- Publication number
- CN102519464A CN102519464A CN2011103799031A CN201110379903A CN102519464A CN 102519464 A CN102519464 A CN 102519464A CN 2011103799031 A CN2011103799031 A CN 2011103799031A CN 201110379903 A CN201110379903 A CN 201110379903A CN 102519464 A CN102519464 A CN 102519464A
- Authority
- CN
- China
- Prior art keywords
- omega
- angle
- cos
- sin
- 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.)
- Granted
Links
Landscapes
- Navigation (AREA)
Abstract
本发明公开了一种基于角速度的欧拉角Hartley指数近似输出方法,用于解决现有的飞行器机动飞行时欧拉角输出精度差的技术问题。技术方案是通过引入多个参数并采用Hartley函数的多项式对滚转、俯仰、偏航角速度p,q,r进行近似逼近描述,通过按照依次求解俯仰角、滚转角、偏航角,直接对欧拉角的表达式进行高阶逼近积分,使得欧拉角的求解按照超线性逼近,从而保证了确定欧拉角的时间更新迭代计算精度和惯性单元的输出精度。
Description
技术领域
本发明涉及一种飞行器机动飞行姿态确定方法,特别是涉及一种基于角速度的欧拉角Hartley指数近似输出方法。
背景技术
惯性设备在运动体导航和控制中具有重要作用;刚体运动的加速度、角速度和姿态等通常都依赖于惯性设备输出,因此提高惯性设备的输出精度具有明确的实际意义;在惯性设备中,加速度采用加速度计、角速度采用角速率陀螺直接测量方式,刚体的姿态精度要求很高时如飞行试验等采用姿态陀螺测量,但在很多应用领域都有角速度等测量直接解算输出;主要原因是由于动态姿态传感器价格昂贵、体积大,导致很多飞行器采用角速率陀螺等解算三个欧拉角,使得姿态时间更新输出成为导航等核心内容,也使其成为影响惯导系统精度的主要因素之一,因此设计和采用合理的姿态时间更新输出方法就成为研究的热点课题;从公开发表的文献中对姿态输出主要基于角速度采用欧拉方程直接近似法或采用近似龙格库塔方法解算(孙丽、秦永元,捷联惯导系统姿态算法比较,中国惯性技术学报,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);由于欧拉方程中三个欧拉角互相耦合,属于非线性微分方程,在不同初始条件和不同飞行状态下的误差范围不同,难以保证实际工程要求的精度。
发明内容
为了克服现有的飞行器机动飞行时欧拉角输出精度差的问题,本发明提供一种基于角速度的欧拉角Hartley指数近似输出方法。该方法通过引入多个参数并采用Hartley函数的多项式对滚转、俯仰、偏航角速度p,q,r进行近似逼近描述,通过按照依次求解俯仰角、滚转角、偏航角,直接对欧拉角的表达式进行高阶逼近积分,使得欧拉角的求解按照超线性逼近,从而可以保证确定欧拉角的时间更新迭代计算精度和惯性单元的输出精度。
本发明解决其技术问题所采用的技术方案是:一种基于角速度的欧拉角Hartley指数近似输出方法,其特点是包括以下步骤:
1、(a)根据欧拉方程:
式中: ψ分别指滚转、俯仰、偏航角;p,q,r分别为滚转、俯仰、偏航角速度;全文参数定义相同;这三个欧拉角的计算按照依次求解俯仰角、滚转角、偏航角的步骤进行;滚转、俯仰、偏航角速度p,q,r的展开式分别为
p(t)=pξ,q(t)=qξ,r(t)=rξ
其中
p=[p0 p1 L pn-1 pn] q=[q0 q1 L qn-1 qn]
r=[r0 r1 L rn-1 rn] ξ=[ξ0(t) ξ1(t) L ξn-1(t) ξn(t)]T
ξi(t)=cas(iωt)=cos(iωt)+sin(iωt),(i=-n,-n+1,L,-1,0,1,2,L,n),ω为角频率;
(b)俯仰角的时间更新求解式为:
式中:T为采样周期,全文符号定义相同;
2、在已知俯仰角的情况下,滚转角的时间更新求解式为:
其中
3、在俯仰角、滚转角已知情况下,偏航角的求解式为:
式中:
本发明的有益效果是:由于通过引入多个参数并采用Hartley函数的多项式对滚转、俯仰、偏航角速度p,q,r进行近似逼近描述,通过按照依次求解俯仰角、滚转角、偏航角,直接对欧拉角的表达式进行高阶逼近积分,使得欧拉角的求解按照超线性逼近,从而保证了确定欧拉角的时间更新迭代计算精度和惯性单元的输出精度。
下面结合具体实施方式对本发明作详细说明。
具体实施方式
1、(a)根据刚体姿态方程(欧拉方程):
其中: ψ分别指滚转、俯仰、偏航角;p,q,r分别为滚转、俯仰、偏航角速度;全文参数定义相同;这三个欧拉角的计算按照依次求解俯仰角、滚转角、偏航角的步骤进行;滚转、俯仰、偏航角速度p,q,r的展开式分别为
p(t)=pξ,q(t)=qξ,r(t)=rξ
其中
p=[p0 p1 L pn-1 pn] q=[q0 q1 L qn-1 qn]
r=[r0 r1 L rn-1 rn] ξ=[ξ0(t) ξ1(t) L ξn-1(t) ξn(t)]T
ξi(t)=cas(iωt)=cos(iωt)+sin(iωt),(i=-n,-n+1,L,-1,0,1,2,L,n);
(b)俯仰角的时间更新求解式为:
式中:
2、在已知俯仰角的情况下,滚转角的时间更新求解式为:
其中
3、在俯仰角、滚转角已知情况下,偏航角的求解式为:
式中:
当对惯性设备直接输出滚转、俯仰、偏航角速度p,q,r采用三阶逼近描述时,所得结果也接近O(T3),相比欧拉方程直接近似法或采用近似龙格库塔方法解算等方法的O(T2)精度要高。
Claims (1)
1.一种基于角速度的欧拉角Hartley指数近似输出方法,其特征在于包括以下步骤:
步骤1、(a)根据欧拉方程:
式中: ψ分别指滚转、俯仰、偏航角;p,q,r分别为滚转、俯仰、偏航角速度;全文参数定义相同;这三个欧拉角的计算按照依次求解俯仰角、滚转角、偏航角的步骤进行;滚转、俯仰、偏航角速度p,q,r的展开式分别为
p(t)=pξ,q(t)=qξ,r(t)=rξ
其中
p=[p0 p1 L pn-1 pn] q=[q0 q1 L qn-1 qn]
r=[r0 r1 L rn-1 rn] ξ=[ξ0(t) ξ1(t) L ξn-1(t) ξn(t)]T
ξi(t)=cas(iωt)=cos(iωt)+sin(iωt),(i=-n,-n+1,L,-1,0,1,2,L,n),ω为角频率;
(b)俯仰角的时间更新求解式为:
式中:T为采样周期,全文符号定义相同;
步骤2、在已知俯仰角的情况下,滚转角的时间更新求解式为:
其中
步骤3、在俯仰角、滚转角已知情况下,偏航角的求解式为:
式中:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110379903.1A CN102519464B (zh) | 2011-11-25 | 2011-11-25 | 基于角速度的欧拉角Hartley指数近似输出方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110379903.1A CN102519464B (zh) | 2011-11-25 | 2011-11-25 | 基于角速度的欧拉角Hartley指数近似输出方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102519464A true CN102519464A (zh) | 2012-06-27 |
CN102519464B CN102519464B (zh) | 2014-07-16 |
Family
ID=46290467
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201110379903.1A Expired - Fee Related CN102519464B (zh) | 2011-11-25 | 2011-11-25 | 基于角速度的欧拉角Hartley指数近似输出方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102519464B (zh) |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080315039A1 (en) * | 2007-06-21 | 2008-12-25 | Lael Rudd | System and methods for space vehicle torque balancing |
CN101825468A (zh) * | 2010-04-23 | 2010-09-08 | 东南大学 | 基于频域分析方法的对偶四元数捷联惯导方法 |
CN101941528A (zh) * | 2010-09-30 | 2011-01-12 | 哈尔滨工业大学 | 基于飞轮的卫星绕瞬时欧拉轴逐次逼近姿态机动控制装置及其控制方法 |
-
2011
- 2011-11-25 CN CN201110379903.1A patent/CN102519464B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080315039A1 (en) * | 2007-06-21 | 2008-12-25 | Lael Rudd | System and methods for space vehicle torque balancing |
CN101825468A (zh) * | 2010-04-23 | 2010-09-08 | 东南大学 | 基于频域分析方法的对偶四元数捷联惯导方法 |
CN101941528A (zh) * | 2010-09-30 | 2011-01-12 | 哈尔滨工业大学 | 基于飞轮的卫星绕瞬时欧拉轴逐次逼近姿态机动控制装置及其控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN102519464B (zh) | 2014-07-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104019828A (zh) | 高动态环境下惯性导航系统杆臂效应误差在线标定方法 | |
CN108318038A (zh) | 一种四元数高斯粒子滤波移动机器人姿态解算方法 | |
CN103900574A (zh) | 一种基于迭代容积卡尔曼滤波姿态估计方法 | |
CN102654406A (zh) | 基于非线性预测滤波与求容积卡尔曼滤波相结合的动基座初始对准方法 | |
CN102645223B (zh) | 一种基于比力观测的捷联惯导真空滤波修正方法 | |
CN102519466A (zh) | 基于角速度的欧拉角勒让德指数近似输出方法 | |
CN102519467B (zh) | 基于角速度的欧拉角切比雪夫指数近似输出方法 | |
CN102495828B (zh) | 基于角速度的欧拉角Hartley近似输出方法 | |
CN102494690A (zh) | 基于角速度的欧拉角任意步长正交级数近似输出方法 | |
CN102519464B (zh) | 基于角速度的欧拉角Hartley指数近似输出方法 | |
CN102506870A (zh) | 基于角速度的欧拉角埃米特指数近似输出方法 | |
CN102607556B (zh) | 一种基于雷速的中精度航姿系统组合导航方法 | |
CN102435192B (zh) | 基于角速度的欧拉角任意步长正交级数指数型近似输出方法 | |
CN102519462B (zh) | 基于角速度的欧拉角指数输出方法 | |
CN102519457B (zh) | 基于角速度的欧拉角傅里埃近似输出方法 | |
CN102519465B (zh) | 基于角速度的欧拉角傅里埃指数近似输出方法 | |
CN102495827B (zh) | 基于角速度的欧拉角埃米特近似输出方法 | |
CN102506873B (zh) | 基于角速度的欧拉角拉盖尔近似输出方法 | |
CN102519468A (zh) | 基于角速度的欧拉角拉盖尔指数近似输出方法 | |
CN102495826B (zh) | 基于角速度的欧拉角切比雪夫近似输出方法 | |
CN102519461B (zh) | 基于角速度的欧拉角沃尔什指数近似输出方法 | |
CN102564423B (zh) | 基于角速度的欧拉角沃尔什近似输出方法 | |
CN102494689A (zh) | 基于角速度的欧拉角多项式类近似输出方法 | |
CN102506869A (zh) | 基于角速度的欧拉角多项式类指数近似输出方法 | |
CN102506874A (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: 20140716 Termination date: 20211125 |
|
CF01 | Termination of patent right due to non-payment of annual fee |