惯性导航原理.ppt
- 【下载声明】
1. 本站全部试题类文档,若标题没写含答案,则无答案;标题注明含答案的文档,主观题也可能无答案。请谨慎下单,一旦售出,不予退换。
2. 本站全部PPT文档均不含视频和音频,PPT中出现的音频或视频标识(或文字)仅表示流程,实际无音频或视频文件。请谨慎下单,一旦售出,不予退换。
3. 本页资料《惯性导航原理.ppt》由用户(晟晟文业)主动上传,其收益全归该用户。163文库仅提供信息存储空间,仅对该用户上传内容的表现方式做保护处理,对上传内容本身不做任何修改或编辑。 若此文所含内容侵犯了您的版权或隐私,请立即通知163文库(点击联系客服),我们立即给予删除!
4. 请根据预览情况,自愿下载本文。本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。
5. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007及以上版本和PDF阅读器,压缩文件请下载最新的WinRAR软件解压。
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 惯性 导航 原理
- 资源描述:
-
1、惯性导航原理*iiiizyOx*eeezyOxeweOziOzeeyOx*tttzyOx*nnnzyOxnztznxtxnyty *pppzyOx*bbbzyOx*3.2四元数理论*四元数:描述刚体角运动的数学工具四元数:描述刚体角运动的数学工具(quaternions)针对捷联惯导系统,可弥补欧拉参数在描述和解算方面的不足。针对捷联惯导系统,可弥补欧拉参数在描述和解算方面的不足。四元数的表示四元数的表示由一个实单位和三个虚数单位由一个实单位和三个虚数单位 i,j,k 组成的数组成的数 kPjPiPq3211或者省略或者省略 1,写成,写成kPjPiPq321i,j,k 服从如下运算公式:服从
2、如下运算公式:*i,j,k 服从如下运算公式服从如下运算公式 1kkjjiikijjiijkkjjkiikkPjPiPq321 称作标量部分,称作标量部分,kPjPiP321称作矢量部分称作矢量部分 四元数的另一种表示法四元数的另一种表示法 Pq,P 泛指矢量部分泛指矢量部分提示:四元数与刚体转动的关系提示:四元数与刚体转动的关系*kPjPiPq321kjivM3211四元数加减法四元数加减法 MqkPjPiPv)()()()(332211或简单表示为或简单表示为 PvMq,*2四元数乘法四元数乘法)(321321kjivkPjPiPMq)(332211PPPviPPvP)(233211jPP
3、vP)(311322kPPvP)(122133或简单表示为或简单表示为 PvPPvMq 关于相乘符号关于相乘符号 关于交换律和结合律关于交换律和结合律*3共轭四元数共轭四元数 仅向量部分符号相反的两个四元数仅向量部分符号相反的两个四元数),(Pq和和),(*Pq互为共轭互为共轭 可证明:可证明:*)*(qhqh4四元数的范数四元数的范数 q定义定义 2322212*PPPqqq1q则称为规范化四元数则称为规范化四元数*5逆四元数逆四元数 qq11qq*当当 1q时时*1qq6四元数的除法四元数的除法 若若 Mqh 则则 1 Mhq若若 Mhq 则则 Mhq1不能表示为不能表示为 hMq(含义不
4、确切含义不确切)*一个坐标系或矢量相对参考坐标系旋转,一个坐标系或矢量相对参考坐标系旋转,转角为转角为,转轴转轴 n n 与参考系各轴间的方向余弦值为与参考系各轴间的方向余弦值为cos、cos、cos。则表示该旋转的四元数可以写为则表示该旋转的四元数可以写为 nkjiq2sin2coscos2sincos2sincos2sin2cos为特征四元数为特征四元数(范数为范数为 1)四元数既表示了转轴方向,又表示了转角大小(转动四元数)四元数既表示了转轴方向,又表示了转角大小(转动四元数)*如果矢量如果矢量 R 相对固定坐标系旋转相对固定坐标系旋转,旋转四元数为,旋转四元数为 q,转动后,转动后的矢
5、量为的矢量为 R,则这种转动关系可通过四元数旋转运算来实现则这种转动关系可通过四元数旋转运算来实现1 qRqR含义:矢量含义:矢量 R 相对固定坐标系产生旋转,相对固定坐标系产生旋转,转角和转轴由转角和转轴由 q 决定决定*如果如果坐标系坐标系 OXYZ 发生发生 q 旋转,得到新坐标系旋转,得到新坐标系 OXYZ 一个相对原始坐标系一个相对原始坐标系 OXYZ 不发生旋转变换的矢量不发生旋转变换的矢量 V zkyjxiV矢量矢量 V 在新坐标系上在新坐标系上 OXYZ 的投影为的投影为 kzjyixV则不变矢量则不变矢量 V 在两个坐标系上的投影之间存在如下关系:在两个坐标系上的投影之间存在
6、如下关系:qVqVee1式中式中 zkyjxiVekzjyixVe分别称为矢量分别称为矢量 V 在坐标系在坐标系 OXYZ 和和 OXYZ 上的映像上的映像*zkyjxiV kzjyixVkzjyixVezkyjxiVe*qVqVee1将该投影变换式展开,也就是把将该投影变换式展开,也就是把kzjyixVezkyjxiVekPjPiPq321kPjPiPq3211代入上述投影变换式代入上述投影变换式kzjyix)(321kPjPiP)(zkyjxi)(321kPjPiP进行四元数乘法运算,整理运算结果可得进行四元数乘法运算,整理运算结果可得*zyxCzyx其中方向余弦矩阵其中方向余弦矩阵 C2
7、22123213223113223212223212313212322212)(2)(2)(2)(2)(2)(2PPPPPPPPPPPPPPPPPPPPPPPPPPP*多次旋转多次旋转的合成的合成对于一个坐标系经过多次旋转后,新坐标系和原始坐标系之间对于一个坐标系经过多次旋转后,新坐标系和原始坐标系之间的关系等效于一个一次转动的效果,的关系等效于一个一次转动的效果,相应地有合成转动四元数相应地有合成转动四元数 假定假定 q1、q2 分别是第一次转动、第二次转动的四元数分别是第一次转动、第二次转动的四元数 q 是合成转动的四元数,是合成转动的四元数,那么有如下关系成立:那么有如下关系成立:21q
8、qq上式中上式中 q1 和和 q2 的转轴方向必须以映象的形式给出。的转轴方向必须以映象的形式给出。如果如果 q1 和和 q2 的转轴方向都以原始坐标系的分量表示,则有的转轴方向都以原始坐标系的分量表示,则有 12qqq*用四元数旋转变换的方法求取两个坐标系之间的方向余弦表。用四元数旋转变换的方法求取两个坐标系之间的方向余弦表。坐标系坐标系 OXYZ 相对相对OXYZ 三次旋转,三次旋转,以欧拉角以欧拉角 、的形式给出。的形式给出。第一转,绕第一转,绕 Z 轴转轴转角,瞬时转轴角,瞬时转轴 n 和和 k 轴重合,则转动四元轴重合,则转动四元数为数为 kq2sin2cos1*第二转,绕第二转,绕
9、 OX1 轴转轴转角,角,瞬时转轴瞬时转轴 n 的方向表示式为的方向表示式为)sin(cosji其转动四元数为其转动四元数为 nq2sin2cos2)sin(cos2sin2cosji*由于由于 q1 和和 q2 的瞬时转轴的瞬时转轴都是以同一个坐标系的方向余弦来都是以同一个坐标系的方向余弦来表示,则合成转动四元数表示,则合成转动四元数 q 的计算采用:的计算采用:12qqqkji2sin2cos)sin(cos2sin2coskji2sin2cos2sin2sin2cos2sin2cos2cos*以瞬时转轴以瞬时转轴映象映象形式给出形式给出转动四元数的表达式并求转动四元数的表达式并求出合成转
10、动四元数出合成转动四元数 第一次转时,映象形式的第一次转时,映象形式的 q1 和非映象形式的和非映象形式的 q1 是是一致的:一致的:kq2sin2cos1*第二转绕第二转绕 OX1 轴转轴转 角角瞬时转轴瞬时转轴 n 是由是由 OX 经过经过第一转转换来的第一转转换来的OX 轴对应单位矢量轴对应单位矢量 i,所,所以定义以定义 n 的映象为的映象为 i则则 q2 的映象表示式为的映象表示式为 iq2sin2cos2*第三转,绕第三转,绕 OZ 轴转动轴转动 角角瞬时转轴瞬时转轴 n 是由是由 OZ 经过经过第一转和第二转转换来的第一转和第二转转换来的OZ 轴对应单位矢量轴对应单位矢量 k,所
11、以定义所以定义 n 的映象为的映象为 k则则 q3 的映象表示式为的映象表示式为kq2sin2cos3*由于由于 q1、q2 和和 q3 都是映象形式都是映象形式,所以三次转动的合成转动所以三次转动的合成转动四元数四元数 q 为为321qqqqkik2sin2cos2sin2cos2sin2cosji2sin2sin2cos2sin2cos2cosk2sin2cos据此可算出对应的方向余弦表据此可算出对应的方向余弦表*坐标系旋转时,不变矢量坐标系旋转时,不变矢量 V 在两个坐标系上的投影之间存在在两个坐标系上的投影之间存在如下关系:如下关系:qVqVee1在一些资料中,四元数的转动公式也经常写
12、成如下的形式在一些资料中,四元数的转动公式也经常写成如下的形式 1qqVVEE这个公式的意义是说,在一个超复数空间中,或者在一个固这个公式的意义是说,在一个超复数空间中,或者在一个固定坐标系中,矢量定坐标系中,矢量 VE 按着四元数按着四元数 q 所表示的方向和大小转所表示的方向和大小转动了一个角度,得到一个新的矢量动了一个角度,得到一个新的矢量 VE*四元数法能得到迅速发展,是由于飞行器控制与导航的发展,要四元数法能得到迅速发展,是由于飞行器控制与导航的发展,要求更合理地描述刚体空间运动,以及便于计算机的应用。求更合理地描述刚体空间运动,以及便于计算机的应用。采用方向余弦矩阵描述飞行器运动时
13、,要积分矩阵微分方程式:采用方向余弦矩阵描述飞行器运动时,要积分矩阵微分方程式:CC式中式中C为动坐标系转置到定坐标系的方向余弦矩阵,为动坐标系转置到定坐标系的方向余弦矩阵,为动坐为动坐标系相对定坐标系旋转角速度标系相对定坐标系旋转角速度的反对称矩阵:的反对称矩阵:000 xyxzyz包含包含 9 个一阶微个一阶微分方程式,计算分方程式,计算量比较大量比较大*如果采用四元数法,则是要求解四元数方程式如果采用四元数法,则是要求解四元数方程式 qq21q 为动坐标系的转动四元数,为动坐标系的转动四元数,为动坐标系相对定坐标系为动坐标系相对定坐标系的旋转角速度,也表示为四元数的旋转角速度,也表示为四
14、元数 kjizyx 0按四元数乘积展开按四元数乘积展开 xyzyzyyzxzyxPPPPPPPPPPPP2131323213212222只要解四个一阶微分只要解四个一阶微分方程式组方程式组即可即可*3.3视加速度和比力*RrMaMgMaRMgTMaMTRamaraRa 根据质心运动定理和相对运动学原理,根据质心运动定理和相对运动学原理,飞行体质心运动的微分方程(在惯性坐标系下)为:飞行体质心运动的微分方程(在惯性坐标系下)为:式中,式中,-飞行体的质量;飞行体的质量;-推力;推力;-空气阻力;空气阻力;-惯性空间飞行时,导弹质心加速度;惯性空间飞行时,导弹质心加速度;,-由推力产生的加速度;由
15、推力产生的加速度;-由阻力引起的阻力加速度。由阻力引起的阻力加速度。*RTagaa)(mamgmar)(gaarra)(RTraaa由上式可得出由上式可得出 飞行体质心运动的微分方程(在弹体坐标系下)为:飞行体质心运动的微分方程(在弹体坐标系下)为:或或 ,式中式中是动点的相对加速度,将(是动点的相对加速度,将(*)代入上式)代入上式 得得 *)(gaasTaRasaa)()(agmmamgf由上式可知,测得的由上式可知,测得的是推力加速度是推力加速度和阻力加速度和阻力加速度的矢量和,称为视加速度,在实际的测试中由加速度传感器得到的值是的矢量和,称为视加速度,在实际的测试中由加速度传感器得到的
16、值是在敏感轴上的分量,实际的惯性坐标系下的加速度在敏感轴上的分量,实际的惯性坐标系下的加速度可通过上式变换得到,在弹体坐标系上动点的力为可通过上式变换得到,在弹体坐标系上动点的力为称为比力,加速度计实际是通过比力来测量加速度的。称为比力,加速度计实际是通过比力来测量加速度的。*3.4捷联惯导系统的算法实现*捷联惯导系统算法概述捷联惯导系统算法概述算法:从惯性仪表输出到导航与控制信息算法:从惯性仪表输出到导航与控制信息捷联惯导算法的基本内容:捷联惯导算法的基本内容:一、系统初始化一、系统初始化(Initialization):1、给定飞行器初始位置、速度等、给定飞行器初始位置、速度等2、数学平台
17、的初始对准、数学平台的初始对准3、惯性仪表的校准、惯性仪表的校准二、惯性仪表误差补偿二、惯性仪表误差补偿(Compensation)三、姿态矩阵的计算三、姿态矩阵的计算四、导航计算四、导航计算五、导航控制信息的提取五、导航控制信息的提取*姿态矩阵的计算姿态矩阵的计算假设数学坐标系模拟地理坐标系假设数学坐标系模拟地理坐标系飞行器姿态的描述:飞行器姿态的描述:航向角航向角、俯仰角、俯仰角、滚动角、滚动角一、欧拉微分方程一、欧拉微分方程从地理坐标系到载体坐标系从地理坐标系到载体坐标系的旋转顺序:的旋转顺序:方向余弦矩阵:方向余弦矩阵:CCCCbE*coscossincoscossinsinsinsi
18、ncossincossincoscoscossinsinsincossinsinsincossincossincoscos飞行器相对地理坐标系的角速度:飞行器相对地理坐标系的角速度:TbEbzbEbybEbxbEb000000CCC*000000CCCcoscossin0cossincos0sin01求解欧拉角速率得求解欧拉角速率得bEbzbEbybEbx1coscossin0cossincos0sin01bEbzbEbybEbxcossin0cossincoscos0sincossinsincoscos1注意事项:当注意事项:当=90 度时,方程出现奇点度时,方程出现奇点*二、方向余弦矩阵微
19、分方程及其解二、方向余弦矩阵微分方程及其解 CCbEbEbEbCC其中其中000 xyxzyzbEb由于陀螺仪直接测得的是载体由于陀螺仪直接测得的是载体相对惯性空间的角速度,所以:相对惯性空间的角速度,所以:biEbibbEb导航计算可以得到导航计算可以得到EIE有有EbEiEbEbiECC 因此因此EbEiEbEbibbEbCC 得得EbEiEbibEbEbCCC*bEbEbEbCC的精确解(毕卡逼近):的精确解(毕卡逼近):)()(tCttCEbEb220000)(cos1sinbEbbEbI1nnttbEbbEbdt其中其中000bEbXbEbYbEbXbEbZbEbYbEbZbEb22
20、220)()()(bEbZbEbYbEbXbEb方向不变时的精确解方向不变时的精确解九个微分方程求解,计算量大九个微分方程求解,计算量大*三、四元数微分方程式及其解三、四元数微分方程式及其解由第一章,四元数微分方程式:由第一章,四元数微分方程式:qqb对对 的处理类似上一节的处理类似上一节b32132102/2/2/2/02/2/2/2/02/2/2/2/0PPPPPPxyzxzyyzxzyx精确解:精确解:)0(2sin2cos)(000qItq其中:其中:21ttbdt*)0(2sin2cos)(000qItq其中:其中:21ttbdt0000 xyzxzyyzxzyx22220ZYX*四
展开阅读全文