CN102495828B - 基于角速度的欧拉角Hartley近似输出方法 - Google Patents
基于角速度的欧拉角Hartley近似输出方法 Download PDFInfo
- Publication number
- CN102495828B CN102495828B CN201110388548.4A CN201110388548A CN102495828B CN 102495828 B CN102495828 B CN 102495828B CN 201110388548 A CN201110388548 A CN 201110388548A CN 102495828 B CN102495828 B CN 102495828B
- Authority
- CN
- China
- Prior art keywords
- angle
- omega
- centerdot
- pitching
- 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
Landscapes
- Navigation (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明公开了一种基于角速度的欧拉角Hartley近似输出方法,用于解决现有的飞行器机动飞行时欧拉角输出精度差的技术问题。技术方案是引入多个参数并采用Hartley函数的多项式对滚转、俯仰、偏航角速度p,q,r进行近似逼近描述,可以根据工程精度的要求,确定对滚转、俯仰、偏航角速度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-n L p-1 p0 p1 L pn][ξ-n(t) L ξ-1(t) ξ0(t) ξ1(t) L ξn(t)]T
q(t)=[q-n L q-1 q0 q1 L qn][ξ-n(t) L ξ-1(t) ξ0(t) ξ1(t) L ξn(t)]T
r(t)=[r-n L r-1 r0 r1 L rn][ξ-n(t) L ξ-1(t) ξ0(t) ξ1(t) L ξ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、(a)在已知俯仰角的情况下,滚转角的时间更新求解式为:
其中
(b)在俯仰角、滚转角已知情况下,偏航角的求解式为:
式中:
本发明的有益效果是:由于引入多个参数并采用Hartley函数的多项式对滚转、俯仰、偏航角速度p,q,r进行近似逼近描述,通过按照依次求解俯仰角、滚转角、偏航角,直接对欧拉角的表达式进行高阶逼近积分,使得欧拉角的求解按照超线性逼近,从而保证了确定欧拉角的时间更新迭代计算精度和惯性单元的输出精度。
下面结合具体实施方式对本发明作详细说明。
具体实施方式
1、(a)根据刚体姿态方程(欧拉方程):
式中:分别指滚转、俯仰、偏航角;p,q,r分别为滚转、俯仰、偏航角速度;全文参数定义相同;这三个欧拉角的计算按照依次求解俯仰角、滚转角、偏航角的步骤进行;滚转、俯仰、偏航角速度p,q,r的展开式分别为
p(t)=[p-n L p-1 p0 p1 L pn][ξ-n(t) L ξ-1(t) ξ0(t) ξ1(t) L ξn(t)]T
q(t)=[q-n L q-1 q0 q1 L qn][ξ-n(t) L ξ-1(t) ξ0(t) ξ1(t) L ξn(t)]T
r(t)=[r-n L r-1 r0 r1 L rn][ξ-n(t) L ξ-1(t) ξ0(t) ξ1(t) L ξ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),定义T为采样周期;
(b)俯仰角的时间更新求解式为:
式中:
2、(a)在已知俯仰角的情况下,滚转角的时间更新求解式为:
其中
(b)在俯仰角、滚转角已知情况下,偏航角的求解式为:
式中:
当对惯性设备直接输出滚转、俯仰、偏航角速度p,q,r采用三阶逼近描述时,所得结果也接近O(T3),相比欧拉方程直接近似法或采用近似龙格库塔解算等方法的O(T2)精度要高。
Claims (1)
1.一种基于角速度的飞行器欧拉角Hartley近似输出方法,其特征在于包括以下步骤:
步骤1、(a)根据欧拉方程:
式中:分别指滚转、俯仰、偏航角;p,q,r分别为滚转、俯仰、偏航角速度;这三个欧拉角的计算按照依次求解俯仰角、滚转角、偏航角的步骤进行;滚转、俯仰、偏航角速度p,q,r的展开式分别为
p(t)=[p-n … p-1 p0 p1 … pn][ξ-n(t) … ξ-1(t) ξ0(t) ξ1(t) … ξn(t)]T
q(t)=[q-n … q-1 q0 q1 … qn][ξ-n(t) … ξ-1(t) ξ0(t) ξ1(t) … ξn(t)]T
r(t)=[r-n … r-1 r0 r1 … rn][ξ-n(t) … ξ-1(t) ξ0(t) ξ1(t) … ξn(t)]T
其中:ξi(t)=cas(iωt)=cos(iωt)+sin(iωt),(i=-n,-n+1,…,-1,0,1,2,…,n),ω为角频率;
(b)俯仰角的时间更新求解式为:
式中:
T为采样周期;
步骤2、(a)在已知俯仰角的情况下,滚转角的时间更新求解式为:
其中
(b)在俯仰角、滚转角已知情况下,偏航角的求解式为:
式中:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110388548.4A CN102495828B (zh) | 2011-11-30 | 2011-11-30 | 基于角速度的欧拉角Hartley近似输出方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110388548.4A CN102495828B (zh) | 2011-11-30 | 2011-11-30 | 基于角速度的欧拉角Hartley近似输出方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102495828A CN102495828A (zh) | 2012-06-13 |
CN102495828B true CN102495828B (zh) | 2014-10-29 |
Family
ID=46187653
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201110388548.4A Expired - Fee Related CN102495828B (zh) | 2011-11-30 | 2011-11-30 | 基于角速度的欧拉角Hartley近似输出方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102495828B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102841346B (zh) * | 2012-09-03 | 2014-06-18 | 西北工业大学 | 基于Hartley基带信号的距离、速度探测方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US734221A (en) * | 1902-08-16 | 1903-07-21 | Andrew G Cassidy | Grinding-machine. |
CN101726295A (zh) * | 2008-10-24 | 2010-06-09 | 中国科学院自动化研究所 | 考虑加速度补偿和基于无迹卡尔曼滤波的惯性位姿跟踪方法 |
CN101941528A (zh) * | 2010-09-30 | 2011-01-12 | 哈尔滨工业大学 | 基于飞轮的卫星绕瞬时欧拉轴逐次逼近姿态机动控制装置及其控制方法 |
-
2011
- 2011-11-30 CN CN201110388548.4A patent/CN102495828B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US734221A (en) * | 1902-08-16 | 1903-07-21 | Andrew G Cassidy | Grinding-machine. |
CN101726295A (zh) * | 2008-10-24 | 2010-06-09 | 中国科学院自动化研究所 | 考虑加速度补偿和基于无迹卡尔曼滤波的惯性位姿跟踪方法 |
CN101941528A (zh) * | 2010-09-30 | 2011-01-12 | 哈尔滨工业大学 | 基于飞轮的卫星绕瞬时欧拉轴逐次逼近姿态机动控制装置及其控制方法 |
Non-Patent Citations (2)
Title |
---|
基于四元数法的捷联式惯性导航系统的姿态解算;张荣辉等;《光学精密工程》;20081031;第16卷(第10期);第1963-1970页 * |
张荣辉等.基于四元数法的捷联式惯性导航系统的姿态解算.《光学精密工程》.2008,第16卷(第10期),第1963-1970页. |
Also Published As
Publication number | Publication date |
---|---|
CN102495828A (zh) | 2012-06-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106052685B (zh) | 一种两级分离融合的姿态和航向估计方法 | |
CN105242676A (zh) | 一种有限时间收敛时变滑模姿态控制方法 | |
CN102645223B (zh) | 一种基于比力观测的捷联惯导真空滤波修正方法 | |
CN102937450B (zh) | 一种基于陀螺测量信息的相对姿态确定方法 | |
CN103033197A (zh) | 一种mems陀螺零位飘移的校正方法 | |
CN102495828B (zh) | 基于角速度的欧拉角Hartley近似输出方法 | |
CN102519466A (zh) | 基于角速度的欧拉角勒让德指数近似输出方法 | |
CN102519467B (zh) | 基于角速度的欧拉角切比雪夫指数近似输出方法 | |
CN102494690A (zh) | 基于角速度的欧拉角任意步长正交级数近似输出方法 | |
CN102495827B (zh) | 基于角速度的欧拉角埃米特近似输出方法 | |
CN102506870B (zh) | 基于角速度的欧拉角埃米特指数近似输出方法 | |
CN102519462B (zh) | 基于角速度的欧拉角指数输出方法 | |
CN102506873B (zh) | 基于角速度的欧拉角拉盖尔近似输出方法 | |
CN102519464B (zh) | 基于角速度的欧拉角Hartley指数近似输出方法 | |
CN102519457B (zh) | 基于角速度的欧拉角傅里埃近似输出方法 | |
CN102495826B (zh) | 基于角速度的欧拉角切比雪夫近似输出方法 | |
CN102519465B (zh) | 基于角速度的欧拉角傅里埃指数近似输出方法 | |
CN102564423B (zh) | 基于角速度的欧拉角沃尔什近似输出方法 | |
CN113701755B (zh) | 一种无高精度陀螺的光学遥感卫星姿态确定方法 | |
CN102519461B (zh) | 基于角速度的欧拉角沃尔什指数近似输出方法 | |
CN102435192B (zh) | 基于角速度的欧拉角任意步长正交级数指数型近似输出方法 | |
CN105260341B (zh) | 基于角速度的欧拉角勒让德近似输出方法 | |
CN102519468B (zh) | 基于角速度的欧拉角拉盖尔指数近似输出方法 | |
CN102506874B (zh) | 基于角速度的欧拉角超线性输出模型建模方法 | |
CN102506869B (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: 20141029 Termination date: 20191130 |
|
CF01 | Termination of patent right due to non-payment of annual fee |