CN102436437A - 基于角速度的飞行器极限飞行时四元数傅里埃近似输出方法 - Google Patents
基于角速度的飞行器极限飞行时四元数傅里埃近似输出方法 Download PDFInfo
- Publication number
- CN102436437A CN102436437A CN2011103667371A CN201110366737A CN102436437A CN 102436437 A CN102436437 A CN 102436437A CN 2011103667371 A CN2011103667371 A CN 2011103667371A CN 201110366737 A CN201110366737 A CN 201110366737A CN 102436437 A CN102436437 A CN 102436437A
- Authority
- CN
- China
- Prior art keywords
- centerdot
- sin
- cos
- nωt
- quaternion
- 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
Abstract
本发明公开了一种基于角速度的飞行器极限飞行时四元数傅里埃近似输出方法,用于解决现有的飞行器极限飞行时惯性设备输出四元数精度差的技术问题。技术方案是采用傅里埃级数的多项式对滚转、俯仰、偏航角速度p,q,r进行近似逼近描述,直接得到了四元数状态转移矩阵,保证了确定四元数的迭代计算精度;本发明根据工程精度的要求,确定对滚转、俯仰、偏航角速度p,q,r傅里埃级数的多项式的阶次,实现了对四元数状态方程转移矩阵Φe[(k+1)T,kT]的超线性逼近,保证了确定四元数的迭代计算精度,从而提高了飞行器极限飞行时惯性设备输出四元数精度。
Description
技术领域
本发明涉及一种飞行器机载惯性设备的姿态输出方法,特别涉及一种基于角速度的飞行器极限飞行时四元数傅里埃近似输出方法。
背景技术
通常,刚体运动的加速度、角速度和姿态等都依赖于惯性设备输出,因此提高惯性设备的输出精度具有明确的实际意义。飞行器、鱼雷、航天器等空间运动在大多数情况下都采用刚体运动微分方程;而刻画刚体姿态的微分方程又是其中的核心,通常以三个欧拉角即俯仰、滚转和偏航角来描述,通常都由机载惯性设备中俯仰、滚转和偏航角速度解算后输出。当刚体当俯仰角为±90°时,滚转角和偏航角无法定值,同时临近该奇点的区域求解误差过大,导致工程上不可容忍的误差而不能使用;为了避免这一问题,人们采用限制俯仰角取值范围的方法,这使得方程式退化,不能全姿态工作,因而难以广泛用于工程实践。为此,人们基于机载惯性设备中的俯仰、滚转和偏航角速度直接测量值,并采用了方向余弦法、等效转动矢量法、四元数法等输出飞行姿态。
方向余弦法避免了欧拉法的“奇异”现象,用方向余弦法计算姿态矩阵没有方程退化问题,可以全姿态工作,但需要求解九个微分方程,计算量较大,实时性较差,无法满足工程实践要求。等效转动矢量法如单子样递推、双子样转动矢量、三子样转动矢量和四子样旋转矢量法以及在此基础上的各种修正算法和递推算法等。文献中研究旋转矢量时,都是基于速率陀螺输出为角增量的算法。然而在实际工程中,一些陀螺的输出是角速率信号,如光纤陀螺、动力调谐陀螺等。当速率陀螺输出为角速率信号时,旋转矢量法的算法误差明显增大。四元数方法是最为广泛使用的方法,该方法是定义四个欧拉角的函数来计算航姿,能够有效弥补欧拉法的奇异性,只要解四个一阶微分方程式组即可,比方向余弦姿态矩阵微分方程式计算量有明显的减少,能满足工程实践中对实时性的要求。其常用的计算方法有毕卡逼近法、二阶、四阶龙格-库塔法和三阶泰勒展开法等(Paul G.Savage.A Unified MathematicalFramework for Strapdown Algorithm Design[J].Journal of guidance,control,anddynamics,2006,29(2):237-248)。毕卡逼近法实质是单子样算法,对有限转动引起的不可交换误差没有补偿,在高动态情况下姿态解算中的算法漂移会十分严重。采用四阶龙格-库塔法求解四元数微分方程时,随着积分误差的不断积累,会出现三角函数取值超出±1的现象,从而导致计算发散。泰勒展开法也因计算精度的不足而受到制约,特别是对于飞行器机动飞行,姿态方位角速率通常都较大,而且对姿态的估计精度提出了更高要求,而四元数等参数确定带来的误差使得上述方法大多数情况下不能满足工程精度。
发明内容
为了克服现有四元数输出误差大的问题,本发明提供一种基于角速度的飞行器极限飞行时四元数傅里埃近似输出方法,该方法采用傅里埃级数的多项式对滚转、俯仰、偏航角速度p,q,r进行近似逼近描述,直接得到四元数状态转移矩阵,保证了确定四元数的迭代计算精度,从而提高飞行器极限飞行时惯性设备输出四元数精度。
本发明解决其技术问题采用的技术方案是,一种基于角速度的飞行器极限飞行时四元数傅里埃近似输出方法,其特点是包括以下步骤:
根据四元数连续状态方程
和离散状态方程
e(k+1)=Φe[(k+1)T,kT]e(k)
其中e=[e1,e2,e3,e4]T
Φe[(k+1)T,kT]为Ae的状态转移矩阵,T为采样周期,
p,q,r分别为滚转、俯仰、偏航角速度;欧拉角θ,ψ分别指滚转、俯仰、偏航角;
状态转移矩阵按照逼近式
及e(k+1)=Φe[(k+1)T,kT]e(k)得到四元数的时间更新值;
其中,ω为角频率,
ξAI(t)=[t sin(ωt)…sin[(n-1)ωt]sin(nωt)]T
ξBI(t)=[cos(ωt)cos(2ωt)…cos[(n-1)ωt]cos(nωt)]T
滚转、俯仰、偏航角速度p,q,r的n阶展开式分别为
p(t)=[pa0 pa1 … pa(n-1) pan][1cos(ωt)…cos[(n-1)ωt]cos(nωt)]T+[pb1 pb2 … pb(n-1) pbn][sin(ωt)sin(2ωt)…sin[(n-1)ωt]sin(nωt)]T
q(t)=[qa0 qa1 … qa(n-1) qan][1cos(ωt)…cos[(n-1)ωt]cos(nωt)]T+[qb1 qb2 … qb(n-1) qbn][sin(ωt)sin(2ωt)…sin[(n-1)ωt]sin(nωt)]T
r(t)=[ra0 ra1 … ra(n-1) ran][cos(ωt)cos(2ωt)…cos[(n-1)ωt]cos(nωt)]T+[rb1 rb2 … rb(n-1) rbn][sin(ωt)sin(2ωt)…sin[(n-1)ωt]sin(nωt)]T
本发明的有益效果是:由于傅里埃级数的多项式对滚转、俯仰、偏航角速度p,q,r进行近似逼近描述,直接得到了四元数状态转移矩阵,保证了确定四元数的迭代计算精度,从而提高了飞行器极限飞行时惯性设备输出四元数精度。
下面结合实施例对本发明作详细说明。
具体实施方式
根据四元数连续状态方程
和离散状态方程
e(k+1)=Φe[(k+1)T,kT]e(k)
其中e=[e1,e2,e3,e4]T
Φe[(k+1)T,kT]为Ae的状态转移矩阵,T为采样周期,
状态转移矩阵按照逼近式
及e(k+1)=Φe[(k+1)T,kT]e(k)得到四元数的时间更新值;
其中
ξAI(t)=[t sin(ωt)…sin[(n-1)ωt]sin(nωt)]T
ξBI(t)=[cos(ωt)cos(2ωt)…cos[(n-1)ωt]cos(nωt)]T
滚转、俯仰、偏航角速度p,q,r的展开式分别为
p(t)=[pa0 pa1 … pa(n-1) pan][1cos(ωt)…cos[(n-1)ωt]cos(nωt)]T+[pb1 pb2…pb(n-1)pbn][sin(ωt)sin(2ωt)…sin[(n-1)ωt]sin(nωt)]T
q(t)=[qa9 qa1…qa(n-1)qan][1cos(ωt)…cos[(n-1)ωt]cos(nωt)]T+[qb1 qb2…qb(n-1)qbn][sin(ωt)sin(2ωt)…sin[(n-1)ωt]sin(nωt)]T
r(t)=[ra0 ra1…ra(n-1)ran][cos(ωt)cos(2ωt)…cos[(n-1)ωt]cos(nωt)]T+[rb1 rb2…rb(n-1)rbn][sin(ωt)sin(2ωt)…sin[(n-1)ωt]sin(nωt)]T
当对惯性设备直接输出滚转、俯仰、偏航角速度p,q,r采用三阶逼近描述时,所得结果也接近O(T3),相比毕卡逼近等方法的O(T2)精度要高。
Claims (1)
1.一种基于角速度的飞行器极限飞行时四元数傅里埃近似输出方法,其特征在于包括以下步骤:
根据四元数连续状态方程
和离散状态方程
e(k+1)=Φe[(k+1)T,kT]e(k)
其中e=[e1,e2,e3,e4]T
Φe[(k+1)T,kT]为Ae的状态转移矩阵,T为采样周期,
状态转移矩阵按照逼近式
及e(k+1)=Φe[(k+1)T,kT]e(k)得到四元数的时间更新值;
其中,ω为角频率,
ξAI(t)=[t sin(ωt)…sin[(n-1)ωt]sin(nωt)]T
ξBI(t)=[cos(ωt)cos(2ωt)…cos[(n-1)ωt]cos(nωt)]T
滚转、俯仰、偏航角速度p,q,r的n阶展开式分别为
p(t)=[pa0 pa1…pa(n-1)pan][1cos(ωt)…cos[(n-1)ωt]cos(nωt)]T+[pb1 pb2…pb(n-1)pbn][sin(ωt)sin(2ωt)…sin[(n-1)ωt]sin(nωt)]T
q(t)=[qa0 qa1…qa(n-1)qan][1cos(ωt)…cos[(n-1)ωt]cos(nωt)]T+[qb1 qb2…qb(n-1)qbn][sin(ωt)sin(2ωt)…sin[(n-1)ωt]sin(nωt)]T
r(t)=[ra0 ra1…ra(n-1)ran][cos(ωt)cos(2ωt)…cos[(n-1)ωt]cos(nωt)]T+[rb1 rb2…rb(n-1)rbn][sin(ωt)sin(2ωt)…sin[(n-1)ωt]sin(nωt)]T
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110366737.1A CN102436437B (zh) | 2011-11-17 | 2011-11-17 | 基于角速度的飞行器极限飞行时四元数傅里埃近似输出方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110366737.1A CN102436437B (zh) | 2011-11-17 | 2011-11-17 | 基于角速度的飞行器极限飞行时四元数傅里埃近似输出方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102436437A true CN102436437A (zh) | 2012-05-02 |
CN102436437B CN102436437B (zh) | 2014-07-09 |
Family
ID=45984506
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201110366737.1A Expired - Fee Related CN102436437B (zh) | 2011-11-17 | 2011-11-17 | 基于角速度的飞行器极限飞行时四元数傅里埃近似输出方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102436437B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102679976A (zh) * | 2012-05-20 | 2012-09-19 | 西安费斯达自动化工程有限公司 | 基于加速度的飞行器四元数修正模型 |
CN102929138A (zh) * | 2012-10-10 | 2013-02-13 | 西北工业大学 | 含有非线性的飞行器控制器设计方法 |
CN102929143A (zh) * | 2012-10-10 | 2013-02-13 | 西北工业大学 | 飞行器时间滞后模型的控制器设计方法 |
CN102929135A (zh) * | 2012-10-10 | 2013-02-13 | 西北工业大学 | 飞行器时间滞后时变模型的控制器设计方法 |
CN104850127A (zh) * | 2015-03-13 | 2015-08-19 | 哈尔滨工程大学 | 一种可动感操控四旋翼飞行器的方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6061611A (en) * | 1998-01-06 | 2000-05-09 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | Closed-form integrator for the quaternion (euler angle) kinematics equations |
CN1876501A (zh) * | 2006-05-31 | 2006-12-13 | 哈尔滨工业大学 | 基于行为模式的深空三轴稳定姿态定向控制方法 |
CN101846510A (zh) * | 2010-05-28 | 2010-09-29 | 北京航空航天大学 | 一种基于星敏感器和陀螺的高精度卫星姿态确定方法 |
-
2011
- 2011-11-17 CN CN201110366737.1A patent/CN102436437B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6061611A (en) * | 1998-01-06 | 2000-05-09 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | Closed-form integrator for the quaternion (euler angle) kinematics equations |
CN1876501A (zh) * | 2006-05-31 | 2006-12-13 | 哈尔滨工业大学 | 基于行为模式的深空三轴稳定姿态定向控制方法 |
CN101846510A (zh) * | 2010-05-28 | 2010-09-29 | 北京航空航天大学 | 一种基于星敏感器和陀螺的高精度卫星姿态确定方法 |
Non-Patent Citations (1)
Title |
---|
周宗锡: "基于四元数的刚体姿态调节问题", 《西安交通大学学报》 * |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102679976A (zh) * | 2012-05-20 | 2012-09-19 | 西安费斯达自动化工程有限公司 | 基于加速度的飞行器四元数修正模型 |
CN102679976B (zh) * | 2012-05-20 | 2014-07-09 | 西安费斯达自动化工程有限公司 | 基于加速度计的飞行器四元数修正模型 |
CN102929138A (zh) * | 2012-10-10 | 2013-02-13 | 西北工业大学 | 含有非线性的飞行器控制器设计方法 |
CN102929143A (zh) * | 2012-10-10 | 2013-02-13 | 西北工业大学 | 飞行器时间滞后模型的控制器设计方法 |
CN102929135A (zh) * | 2012-10-10 | 2013-02-13 | 西北工业大学 | 飞行器时间滞后时变模型的控制器设计方法 |
CN102929143B (zh) * | 2012-10-10 | 2015-05-06 | 西北工业大学 | 飞行器时间滞后模型的控制器设计方法 |
CN102929138B (zh) * | 2012-10-10 | 2015-05-13 | 西北工业大学 | 含有非线性的飞行器控制器设计方法 |
CN102929135B (zh) * | 2012-10-10 | 2015-05-27 | 西北工业大学 | 飞行器时间滞后时变模型的控制器设计方法 |
CN104850127A (zh) * | 2015-03-13 | 2015-08-19 | 哈尔滨工程大学 | 一种可动感操控四旋翼飞行器的方法 |
CN104850127B (zh) * | 2015-03-13 | 2017-11-21 | 哈尔滨工程大学 | 一种可动感操控四旋翼飞行器的方法 |
Also Published As
Publication number | Publication date |
---|---|
CN102436437B (zh) | 2014-07-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103256928A (zh) | 一种分布式惯性导航系统及其姿态传递对准方法 | |
CN102436437B (zh) | 基于角速度的飞行器极限飞行时四元数傅里埃近似输出方法 | |
CN102589553A (zh) | 建立飞行器运动模型的切换方法 | |
CN102495831B (zh) | 基于角速度的飞行器极限飞行时四元数埃米特近似输出方法 | |
CN102495830B (zh) | 基于角速度的飞行器极限飞行时四元数Hartley近似输出方法 | |
CN102495829B (zh) | 基于角速度的飞行器极限飞行时四元数沃尔什近似输出方法 | |
CN102508819B (zh) | 基于角速度的飞行器极限飞行时四元数勒让德近似输出方法 | |
CN102506864B (zh) | 飞行器极限飞行时四元数任意步长正交级数近似输出方法 | |
CN102506866B (zh) | 基于角速度的飞行器极限飞行时四元数切比雪夫近似输出方法 | |
CN102506865B (zh) | 基于角速度的飞行器极限飞行时四元数多项式类近似输出方法 | |
CN102445202B (zh) | 一种刚体空间运动状态的拉盖尔输出方法 | |
CN102495825B (zh) | 基于角速度的飞行器极限飞行时四元数超线性输出方法 | |
CN102323990B (zh) | 一种刚体空间运动气动模型的建模方法 | |
CN102494688B (zh) | 基于角速度的飞行器极限飞行时四元数拉盖尔近似输出方法 | |
CN102384747A (zh) | 一种刚体空间运动状态的Hartley输出方法 | |
CN102508818B (zh) | 一种刚体空间运动状态的任意步长正交级数输出模型建模方法 | |
CN102359790B (zh) | 一种刚体空间运动状态的傅里埃输出方法 | |
CN102359789B (zh) | 一种刚体空间运动状态的任意阶输出方法 | |
CN102323992B (zh) | 一种刚体空间运动状态多项式类输出模型的建模方法 | |
CN102346729B (zh) | 一种刚体空间运动状态的勒让德输出方法 | |
CN102445203B (zh) | 一种刚体空间运动状态的埃米特输出方法 | |
CN102375803B (zh) | 一种刚体空间运动的气流轴系模型的建立方法 | |
CN116447930A (zh) | 一种机载武器传递对准方法 | |
CN102384746A (zh) | 一种刚体空间运动状态的切比雪夫输出方法 | |
CN102323991B (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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20140709 Termination date: 20191117 |