捷联惯导系统

文档格式：PPT| 30 页|大小 1.33MB|积分 15|2021-04-29 发布|文档ID：21332342

下载文档

下载文档到电脑，查找使用更方便还剩页未读，继续阅读>>

侵权申诉举报

1 / 30

此文档下载收益归作者所有下载文档

版权提示

文本预览

常见问题

捷联惯导系统原理框图捷联惯导系统捷联惯导系统姿态更新算法速度更新算法位置更新算法系统误差方程捷联惯导系统2. 姿态更新算法（核心）基本思想：刚体的定点转动2.1 欧拉角法（三参数法）一个动坐标系相对参考坐标系的方位，可以完全由动坐标系一次绕三个不同的轴的三个角度来确定把载坐标系作动坐标系，导航系为参考系则、和即为一组欧拉角当时，方程退化，故不能全姿态工作 bb bnb ib in （ - ） nbC 1sin cos cos 0sin 0 1cos cos sin 0 bnbxbnbybnbz 90 sin cos0cos coscos 0 sinsin tan 1 cos tan xyzbnbbnbbnb 捷联惯导系统2.2 方向余弦法（九参数法）矢量的方向余弦表示姿态矩阵的方法；可全姿态工作，但需要解含有九个未知量的线性方程组，计算量大，工程上不实用。

bknbnbnb CC 捷联惯导系统2.3 四元数法（四参数法）2.3.1 四元数基本概念四元数是由一个实数单位 1和一个虚数单位 i、 j、 k组成的含有四个元的数（超复数）四元数的大小范数四元数表达方式三角式基本运算 0 1 2 3 0 1 2 3, , ,q q q q q q q q Q i j k23222120 qqqq Q 2sin2cos uQ 捷联惯导系统动坐标系相对于参考坐标系的转动，等效于动坐标系绕某一个等效转轴转动一个角度（， u）四元数描述转动：四元数是刚体转动的一种描述形式结论：四元数可以描述刚体的定点转动， Q包含了等效旋转的全部信息；四元数与姿态矩阵的关系；描述刚体转动的四元数是规范化四元数；捷联惯导中的姿态更新实质上是如何计算四元数。

cos sin2 2 Q u2 2 2 20 1 2 3 1 2 0 3 1 3 0 22 2 2 21 2 0 3 0 1 2 3 2 3 0 12 2 2 21 3 0 2 2 3 0 1 0 1 2 32( ) 2( )2( ) 2( )2( ) 2( )Rb q q q q q q q q q q q qq q q q q q q q q q q qq q q q q q q q q q q q C 捷联惯导系统2.3.2 四元数微分方程毕卡求解法（角增量） 1）定时采样增量法：采样时间间隔相同； 2）定量采样增量法：角增量达到一固定值时才更新； 12n n bb b nbq q ( ) ( )( ) ( 1) ( 1) ( 1)n n m n b mb m n m b m b mq q q q 1( ) ( ) ( )2k kt t Q I Q 捷联惯导系统2.3.3 四元数初值的确定与归一化表征旋转的四元数应该是规范四元数；计算误差，失去规范性，需归一化处理； 1Q 23222120 qqqq qq ii 3322110 3322113 3322112 3322111 121 121 121 121 TTTq TTTq TTTq TTTq 122103 311302 233201444 TTqq TTqq TTqq )()()( )()()( )()()( 122103 311302 233201 TTsignqsignqsign TTsignqsignqsign TTsignqsignqsign 2 2cos sin cos( ) sin( ) cos sin2 2 2 2 2 2 Q u u u- 捷联惯导系统2.3.4 从姿态矩阵中提取姿态角 -90， 90 度 -180， 180 度 -180， 180 度或 0， 360 度真值表判断11 21 3112 22 3213 23 33nb T T TT T TT T T C 1 321 31331 1222sin ( )tan ( )tan ( )TTTTT 主主cos cos sin sin sin sin cos sin cos cos sin sincos sin sin cos sin cos cos sin sin cos cos sinsin cos sin cos cosnb C 捷联惯导系统2.4 等效旋转矢量法四元数法求解中用到了角速度矢量的积分。

当不是定轴转动时，即角速度矢量的方向在空间变化时，将使计算产生误差，称为转动不可交换性误差为了消除不可交换性误差，必须对角速度矢量积分修正，修正的方法是采用等效旋转矢量算法把角速度矢量积分等效为等效旋转矢量，利用等效旋转矢量的概念将四元数微分方程转化为等效旋转矢量微分方程 (即 Bortz方程 )：表征旋转的另一种形式： ( ) t t t tt tdt dt 1 1( ) ( ) ( ( )2 12b b bnb nb nbt t t u cos sin2 2 q 捷联惯导系统泰勒级数展开、曲线拟合的方法（几个采样角就为几子样算法）常数拟合：直线拟合：抛物线拟合：三次抛物线： ( )bnb kt ah0 ( )h ba 2)( kbnb t 1 2 1 22( ) 3h 2( ) 2 3bnb kt a b c 1 2 3 1 3 2 3 133 57( ) ( )80 80h 2 3( ) 2 3 4bnb kt a b c d 1 2 3 4 1 2 3 41 3 2 4 1 4 2 3736( ) ( )945334 526 654( )945 945 945h 捷联惯导系统四元数法与等效旋转矢量法的区别：原理相同：计算姿态四元数完成姿态更新；四元数算法等效旋转矢量的单子样算法；算法思路不同；等效旋转矢量法思路： nin bib( ) ( )( ) ( 1) ( 1) ( 1)n n m n b mb m n m b m b mq q q q 1 2 ( )h 1 2 1 22( ) 3h 捷联惯导系统2.4 几种姿态算法的比较欧拉角法：概念直观；只适应水平姿态角变化不大的情况，不能全姿态解算。

方向余弦法：可全姿态工作；但计算量大，不实用四元数法：算法简单，计算量小；存在不可交换误差，适应于低动态运载体（等效旋转矢量的单子样）等效旋转矢量法：可对不可交换性误差进行补偿，算法简单，适应于高动态环境捷联惯导系统2. 速度更新算法基础：比力方程数字递推形式：旋转效应： rotation 载体线运动在空间的旋转，角速度与线速度不共线；划桨效应： scull 绕一轴做线振动同时绕另一轴做同频角振动；（根本原因：更新周期内姿态角的变化引起）有害加速度： g/Coriolis 2n n b n n n nb ie en V C f V g 1 1 /1 1 /( )n n b nm m m sfm g cormn nm m m rotm sculm g corm V V C V VV C V V V VrotmVsculmV/ng cormV 捷联惯导系统2. 位置更新算法数字递推形式： ( ) ( ) ( 1)( 1)n l n l n le n l e C C C ( )( 1)( ) ( )n n n n n len l en n lF t V t dt F R Csin cos 0sin cos sin sin coscos cos cos sin sin ne L L LL L L C 33arcsin PL 3231Parctg P 主捷联惯导系统4. 捷联惯导系统误差方差捷联惯导系统误差源惯性仪表的安装误差和刻度因子误差陀螺漂移和加速度计零位初始条件误差计算误差 0 0 0 z yz xy xG GG G GG G 0 0 0 00 0 x y zKK K K b b 捷联惯导系统捷联惯导系统误差方程姿态误差方程： ( )n n n b nin in b G ibC K G EENN UNin U Ein U b b b n nnb ib n n inC C 捷联惯导系统捷联惯导系统误差方程速度误差方程：位置误差方程： ( ) (2 )(2 )n n n n b n n nb A ie enn n n nie enK A V f C f V V 2)( hR VhhR VL M NM N 2)( secsectansec hR LVhLLhRVLLhR V NEN EN E UVh MATLAB仿真 1、轨迹生成仿真 2、惯导器件输出信息的仿真 3、捷联惯导解算仿真 4、基本函数 MATLAB仿真1、轨迹生成仿真目的：航迹仿真的目的是生成惯性器件信息源（比力和角速度），并给出相应航迹点的航行参数（姿态、速度和位置） 1）航行轨迹微分方程姿态角微分方程： ( )t cos 0 sin cos( ) 0 1 sin ( )sin 0 cos cos bnbt t 2）生成惯性器件增量信息角增量通过控制姿态角速度和轨迹加速度，设置理想轨迹。

，则易知轨迹微分方程组是关于向量的一组微分方程，即，求解此微分方程组即可获得载体的轨迹，一般采用四阶龙格库塔解法求解 ( )b b n n b b n bib n in b nb n in nb C C C ( )tX MATLAB仿真( )t ( ) t ta MATLAB仿真2、惯导器件输出信息仿真 0 1b b r abr r ra ww 0 1b b r gbr r rg ww MATLAB仿真2、惯导器件输出信息仿真 0 1b b r abr r ra ww 0 1b b r gbr r rg ww MATLAB仿真3、捷联惯导解算仿真 ) ( , , )v att v pos （， MATLAB仿真4、仿真示例 0 2 4 6 8 10 12 14 16 18 x 104 -5 0 5 时间(秒) 俯仰角 (角分 ) 0 2 4 6 8 10 12 14 16 18 x 104 -5 0 5 时间(秒) 滚转角 (角分 ) 0 2 4 6 8 10 12 14 16 18 x 104 -10 0 10 时间(秒) 偏航角 (角分 ) MATLAB仿真4、仿真示例 0 2 4 6 8 10 12 14 16 18 x 104 -10 -5 0 5 10 时间(秒) 东向速度（米 /秒） 0 2 4 6 8 10 12 14 16 18 x 104 -10 -5 0 5 10 时间(秒) 北向速度（米 /秒） MATLAB仿真4、仿真示例 0 2 4 6 8 10 12 14 16 18 x 104 -10 0 10 20 时间(秒) 纬度（角分） 0 2 4 6 8 10 12 14 16 18 x 104 0 5 10 15 20 时间(秒) 经度（角分） MATLAB仿真4、仿真示例 MATLAB仿真4、仿真示例轨迹生成仿真静态仿真： 2种周期动态仿真：轨迹相似且发散严恭敏硕士论文、严恭敏仿真原程序MATLAB仿真。

点击阅读更多内容