捷联惯导系统航姿算法的比较及仿真分析
合集下载
相关主题
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
收稿 日期:2016.01.05。王小峰 (1983一 ):陕西人,工程 师 ,工 学硕 士,研究方向:惯性及卫星导航 。
矢 量 三子样 法 进行 仿真 分析 比较 ,在典 型 圆锥运 动
下 ,四元 数 算法利 用 四阶 龙格 一库 塔法 对 四元数 微
分 方程 进 行姿 态求 解 ,而 旋转 矢量 三子 样算 法主 要
Q(t+ )=Q(f)+( +k2+k3十 )/6 kl=0.5h[co(t)]Q(t、 k2=0.5h[a ̄(t+h/2)][Q(f)+ki/2] (4) k3=0.5h[co(t+h/2)][Q(f)+k2/2] k4=0.5h[co(t+ )儿Q( )+k3]
仿真 了上述算法。仿真结果表明,四元数算法在精度上不如旋转矢量三予样 法,但在 陀螺角速率
输入模 式下比三子样法 占有优势且计算量小,旋转矢量三子样法可以抑制不可 交换误差,适于高
机动 高精度的导航要求,但也存在计算量大以及在 陀螺角速率输入模 式下存在明显的噪声放大效
应 。
关键词 :航姿 算法;旋转矢量;四元数;圆锥运动;仿真
l g02+q 一q;一q; 2(q1g2一gog3) 2(gIq2+qoq3)I c =I 2(g。q2+qoq3) g 一q +g;一g; 2(g1q2一qoq3)l
l 2(glg3一gog2) 2(g2g3+g0g1) g —g 一g;+g I
(2)
利 用式 (2)便 可 以从 由载 体 坐标 系 转 移 至导 航 地 理 坐 标 系 的姿 态 转 移 矩 阵 中提 取 实 时姿 态 角 供导 航 系统使 用 。 1.2 四阶龙 格一 库塔 法 求解 四 元数微 分 方程
是 通 过 对 有 限制 转 动 的 不 可 交 换 性 误 差 进 行 补 偿
来 进行 姿态 更 新和解 算 。
’
1四元数 算法
四元数 是是 由四个元 素 构成 的数 : Q(q0,q1,q2,q3)=q0+qli+g2j+q3k (1)
其中,qo,q。,q:,q,是实数,i,j,k是互相正交的单位 向量 ,用 来表 示 四元 数 的乘法 运 算关 系 。
中图分类号 :V249
文献标识码 :A
文章编号 :1674.7976.(2016)04—103—04
Com parison and Simulation Analysis for Attitude A lgorithm s of SIN S
Abstract: Combining with engineering application,the quaternion and rotation vector attitude algorithms which are m ainstream algorithms are introduced,an d a new method of fi ndi ng a solution to quatem ion and three subsample rotation vector in typical coning m ovement is proposed an d an alyzed through t he simulation.The results show that quaternion has smaller a m ount of compumtions in the mode of gyro velocity input,but its precision is not beter t ha n rotation vector atit u de algorithms.M ea n while, rotation vector atitude algorithms m eet requirements of high-dynamic and high-precision,but its noise amplif ication is more obvious.
周 期一 般 都很短 , 很 小 , 的高 次项可 略 去不计 , 得 工程 上 常用 的近 似方 程 :
=∞+二2 ×∞+ ×( ×∞) (6)
四元数 微分 方程 为 :
1
.
a=去Q
(3)
其 中, 表示 由机体 坐 标 系到 导 航坐 标 系 在机 体 坐 标 系 中 的投 影 。式 (3) 的求 解 可 以通 过 用 四阶 龙 格一 库塔 法来 求 取如 下 的 四元 数 递推 公式 :
2016年 4月第 2期
现 代 导 航
捷联惯导系统航姿算 法的比较及仿真分析
王小峰源自文库,董正芳
(中国 电子 科技集团公司第二十研究所 ,西安 710068)
摘 要 :结合 工程 实际应用,介绍了当前主流航姿算法中的四元数法和旋转 矢量三子样 算法,
提 出了一种在典型圆锥运动下求解四元数和旋转矢量三子样 的新方法,并且详 细地分析 、比较和
·104·
现 代 导 航
2016年
1.1 四元数 与姿 态矩 阵 间的 关系
四元数 Q=c。s +usin旦描 述 了刚 体 绕 固 定 2
点 的转动 形态 ,可看成 刚 体绕 瞬轴 U (单 位 向量 ) 转过 角一 次 完成 的旋 转 。四元 数与 姿态 矩 阵的关 系可 以表 示 如下 :
Key words: Atitude Algorithms;Rotation Vector;Quatemion;Coning Movement;Simulation
0 引言
在 常 规 的捷联 惯 性导航 系 统 中 ,陀螺 仪和 加速 度 计 是 固定连 接在 运 动载体 上 的 ,用 于直 接感 知测 量 运 动载体 的角运 动和 线运 动 。通 过姿 态 转移 矩 阵 把 惯 性 元件 加 速 度 计 输 出 的 比力 信 息 转 换 到 导 航 地 理坐 标系 中,对 其进 行 两次 积分 运算 便 可得 到地 理 坐 标 系 下 的位 置 速度 等 导 航 信 息 ,实 现 实 时 导 航 。因此 姿 态转 移矩 阵 的计算 就 显得 尤为 重要 。本 文 主 要 对 目前 常 用 航 姿 算法 中 的 四元 数 法 和 旋 转
矢 量 三子样 法 进行 仿真 分析 比较 ,在典 型 圆锥运 动
下 ,四元 数 算法利 用 四阶 龙格 一库 塔法 对 四元数 微
分 方程 进 行姿 态求 解 ,而 旋转 矢量 三子 样算 法主 要
Q(t+ )=Q(f)+( +k2+k3十 )/6 kl=0.5h[co(t)]Q(t、 k2=0.5h[a ̄(t+h/2)][Q(f)+ki/2] (4) k3=0.5h[co(t+h/2)][Q(f)+k2/2] k4=0.5h[co(t+ )儿Q( )+k3]
仿真 了上述算法。仿真结果表明,四元数算法在精度上不如旋转矢量三予样 法,但在 陀螺角速率
输入模 式下比三子样法 占有优势且计算量小,旋转矢量三子样法可以抑制不可 交换误差,适于高
机动 高精度的导航要求,但也存在计算量大以及在 陀螺角速率输入模 式下存在明显的噪声放大效
应 。
关键词 :航姿 算法;旋转矢量;四元数;圆锥运动;仿真
l g02+q 一q;一q; 2(q1g2一gog3) 2(gIq2+qoq3)I c =I 2(g。q2+qoq3) g 一q +g;一g; 2(g1q2一qoq3)l
l 2(glg3一gog2) 2(g2g3+g0g1) g —g 一g;+g I
(2)
利 用式 (2)便 可 以从 由载 体 坐标 系 转 移 至导 航 地 理 坐 标 系 的姿 态 转 移 矩 阵 中提 取 实 时姿 态 角 供导 航 系统使 用 。 1.2 四阶龙 格一 库塔 法 求解 四 元数微 分 方程
是 通 过 对 有 限制 转 动 的 不 可 交 换 性 误 差 进 行 补 偿
来 进行 姿态 更 新和解 算 。
’
1四元数 算法
四元数 是是 由四个元 素 构成 的数 : Q(q0,q1,q2,q3)=q0+qli+g2j+q3k (1)
其中,qo,q。,q:,q,是实数,i,j,k是互相正交的单位 向量 ,用 来表 示 四元 数 的乘法 运 算关 系 。
中图分类号 :V249
文献标识码 :A
文章编号 :1674.7976.(2016)04—103—04
Com parison and Simulation Analysis for Attitude A lgorithm s of SIN S
Abstract: Combining with engineering application,the quaternion and rotation vector attitude algorithms which are m ainstream algorithms are introduced,an d a new method of fi ndi ng a solution to quatem ion and three subsample rotation vector in typical coning m ovement is proposed an d an alyzed through t he simulation.The results show that quaternion has smaller a m ount of compumtions in the mode of gyro velocity input,but its precision is not beter t ha n rotation vector atit u de algorithms.M ea n while, rotation vector atitude algorithms m eet requirements of high-dynamic and high-precision,but its noise amplif ication is more obvious.
周 期一 般 都很短 , 很 小 , 的高 次项可 略 去不计 , 得 工程 上 常用 的近 似方 程 :
=∞+二2 ×∞+ ×( ×∞) (6)
四元数 微分 方程 为 :
1
.
a=去Q
(3)
其 中, 表示 由机体 坐 标 系到 导 航坐 标 系 在机 体 坐 标 系 中 的投 影 。式 (3) 的求 解 可 以通 过 用 四阶 龙 格一 库塔 法来 求 取如 下 的 四元 数 递推 公式 :
2016年 4月第 2期
现 代 导 航
捷联惯导系统航姿算 法的比较及仿真分析
王小峰源自文库,董正芳
(中国 电子 科技集团公司第二十研究所 ,西安 710068)
摘 要 :结合 工程 实际应用,介绍了当前主流航姿算法中的四元数法和旋转 矢量三子样 算法,
提 出了一种在典型圆锥运动下求解四元数和旋转矢量三子样 的新方法,并且详 细地分析 、比较和
·104·
现 代 导 航
2016年
1.1 四元数 与姿 态矩 阵 间的 关系
四元数 Q=c。s +usin旦描 述 了刚 体 绕 固 定 2
点 的转动 形态 ,可看成 刚 体绕 瞬轴 U (单 位 向量 ) 转过 角一 次 完成 的旋 转 。四元 数与 姿态 矩 阵的关 系可 以表 示 如下 :
Key words: Atitude Algorithms;Rotation Vector;Quatemion;Coning Movement;Simulation
0 引言
在 常 规 的捷联 惯 性导航 系 统 中 ,陀螺 仪和 加速 度 计 是 固定连 接在 运 动载体 上 的 ,用 于直 接感 知测 量 运 动载体 的角运 动和 线运 动 。通 过姿 态 转移 矩 阵 把 惯 性 元件 加 速 度 计 输 出 的 比力 信 息 转 换 到 导 航 地 理坐 标系 中,对 其进 行 两次 积分 运算 便 可得 到地 理 坐 标 系 下 的位 置 速度 等 导 航 信 息 ,实 现 实 时 导 航 。因此 姿 态转 移矩 阵 的计算 就 显得 尤为 重要 。本 文 主 要 对 目前 常 用 航 姿 算法 中 的 四元 数 法 和 旋 转