- 1、本文档共13页,可阅读全部内容。
- 2、有哪些信誉好的足球投注网站(book118)网站文档一经付费(服务费),不意味着购买了该文档的版权,仅供个人/单位学习、研究之用,不得用于商业用途,未经授权,严禁复制、发行、汇编、翻译或者网络传播等,侵权必究。
- 3、本站所有内容均由合作方或网友上传,本站不对文档的完整性、权威性及其观点立场正确性做任何保证或承诺!文档内容仅供研究参考,付费前请自行鉴别。如您付费,意味着您自己接受本站规则且自行承担风险,本站不退款、不进行额外附加服务;查看《如何避免下载的几个坑》。如果您已付费下载过本站文档,您可以点击 这里二次下载。
- 4、如文档侵犯商业秘密、侵犯著作权、侵犯人身权等,请点击“版权申诉”(推荐),也可以打举报电话:400-050-0827(电话支持时间:9:00-18:30)。
高精度捷联式惯性导航系统算法研究
引言
随着计算机技术的发展,捷联式惯性导航系统(strapdownInertialNavigationSystem,SINS)的概念被提出,它取消了平台式惯性导航系统中复杂的机械平台装置,而将惯性传感器直接固联在载体上。SINS具有制造和维护成本低、体积小、重量轻以及可靠性高等优点,目前在高、中、低精度领域都得到了广泛使用。
捷联算法的基本框图如图1所示。
加速度计
加速度计
惯性传感器误差补偿
投影在平台坐标
系的比力矢量
地速与位置的
计算
位置角速度的
计算
显示器
陀螺仪
方向余弦矩阵
(数学平台)
姿态角计算
导航计算机
图1捷联算法的基本框图
在捷联惯性导航系统中,惯性传感器直接固联在载体上,因此对惯性传感器的性能提出了更高的要求。SINS中使用的陀螺所承受的动态范围较大,一般能够达到100/s,与此同时,SINS中的陀螺和加速度计与载体一起进行角运动和线运动,这增加了导航计算机输出数据的难度和复杂性。姿态实时计算是捷联惯导的关键技术,也是影响捷联惯导系统导航精度的重要因素。
载体的姿态和航向是载体坐标系和地理坐标系之间的方位关系,两坐标系之间的方位关系等效于力学中的刚体定点转动问题。在刚体定点转动理论中,描述动坐标系相对参考坐标系方位关系的方法有欧拉角法、四元数法、方向余弦法以及等效旋转矢量法。本报告对这四种姿态算法进行简单介绍,并结合研究对象对等效旋转矢量算法进行重点研究。针对角速率输入陀螺构成的捷联式惯性导航系统,本报告给出了一种改进的姿态算法,并在圆锥运动环境下对该算法进行数学仿真,验证了该方法的可能性。
姿态算法介绍
欧拉角法
一个动坐标系相对参考坐标系的方位可以完全由动坐标系依次绕三个不同轴转动
三个角度进行确定。把载体坐标系oxbybzb作为动坐标系,导航坐标系oxnyn
(即地理坐
zn
z
标系)作为参考坐标系,导航系依次转过航向角H、俯仰角P、横摇角R可得到载体坐标系,通过求解欧拉角微分方程得到三个欧拉角,从而进一步可以得到捷联姿态矩阵。欧拉角微分方程如下所示:
?P?
?cosPcosP
0 sinRcosP???b ?
? ? 1 ?
?? nbx?
?R??cosP?sinPsinR cosP ?cosPsinP???b ?
(1)
? ? ??nby?
??H?
?
?? ?sinR 0 cosR
???
bnbz
式(1)即为欧拉角微分方程,求解方程可以得到三个欧拉角,也就是航向角、俯仰角
以及横摇角,根据三个姿态角和姿态矩阵元素之间的关系即可以得到姿态矩阵Cn。
b
方向余弦法
常用方向余弦姿态矩阵微分方程的形式为
Cb??bkCb
(1)
n nb n
式中?bk为载体坐标系相对地理坐标系的转动角速度在载体坐标轴向的分量的反对称矩nb
阵形式,具体表达式如式(2)。
??? 0 ??b ?b ?
?
?
?bk
???b
nbz
?0
?
nby
?b
?
? (2)
?nb ?
?
nbz
nbx?
??b
nby
?b 0
nbx
用毕卡逼近法求解矩阵微分方程,其解为
? sin??
1?cos?? ?
Cb(t??t)?C(t)?I? 0??bk?
0(??bk)2? (3)
?n ?? nb
?
0
式中
??2
0
nb ?
???? 0 ???b ??b ?
?
?
?
??bk
??t
n?1?bkdt????b
nbz
0
nby
??? b ?
?
?nb t nb
?
n
? nbz
nbx?
??b2
??b2???b2???b2
nbx nby nbz
0
???b
nby
??b 0
nbx
四元数法
四元数微分方程的形式为
?bnb1Q(t)? Q(
?bnb
1
2
(4)
其中,Q(t)是姿态四元数,?b
nb
??? ?
?x y
?
??T,为b系相对n系的角速度。
?z
?
求解四元数微分方程一般用计算机实现,常用方法有毕卡逼近增量法和数值积分算法,本报告关于四元数求解姿态角算法采用的都是数值积分算法,因此此处仅对四元数四阶-龙格库塔算法进行简单介绍。
对四元数微分方程
1Q? Q??b (5)
1
2 nb
式中:?b
?0??bxi
?byj
?bzk
,为载体坐标系相对于导航坐标系的角速度矢量
nb
的四元数表达形式。
nbb
nbb
nb b
用四阶
您可能关注的文档
- 钢铁实习报告王英明.docx
- 钢铁是怎样炼成的赏析.docx
- 钢铁行业分析新.docx
- 钢铁行业烧结烟气脱硫技术.docx
- 钢网架结构安装之整体吊装法.docx
- 钢围堰施专项安全方案1.docx
- 钢屋架施工方案.docx
- 钢芯铝导线压模选用参数李春龙.docx
- 钢栈桥设计与检算书.docx
- 钢栈桥施工合同.docx
- 浙江省临海市白云高级中学2025届高三历史3月月考试题.doc
- 云南拾谷县第一中学2024_2025学年高二物理上学期10月月考试题.doc
- 2025版高考生物总复习第13讲基因的分离定律教案苏教版.doc
- 湖北省黄石实验高中2024_2025学年高一历史下学期期末考试模拟卷.doc
- 通史版2025版高考历史大一轮复习专题七近代化的曲折发展__中日甲午战争至五四运动前4第4讲从维新思想到新文化运动课后达标检测含解析新人教版.doc
- 2024年高考数学考试大纲解读专题04导数及其应用含解析文.doc
- 河南省许汝平九校联盟2024_2025学年高一语文上学期期末考试试题扫描版无答案.doc
- 江西省吉安市吉水县第二中学2024_2025学年高一历史上学期第二次月考试题.doc
- 北京市平谷区2025届高三政治一模考试试题含解析.doc
- 2025届中考物理第四讲物态变化专项复习测试无答案新人教版.docx
文档评论(0)