P捷联惯导系统姿态算法矩阵.pptx

Lecture 10-Algorithms for SINS1Outlineq 捷联惯导系统概述捷联惯导系统概述q 姿态矩阵（姿态矩阵（DCM）微分方程的推导）微分方程的推导q 方向余弦矩阵的求解方向余弦矩阵的求解:角增量算法角增量算法Lecture 10-Algorithms for SINS21.1*捷联惯导系统捷联惯导系统:特点特点方位轴方位轴滚动轴滚动轴俯仰轴俯仰轴q 陀螺和加速度计被直接陀螺和加速度计被直接“捆绑捆绑(strapped)”到载体上到载体上q 没有物理的平台没有物理的平台q 对陀螺仪的角速度输出进行对陀螺仪的角速度输出进行积分，获取载体的姿态信息积分，获取载体的姿态信息.q 加速度计的输出需要变换到导航坐标系中加速度计的输出需要变换到导航坐标系中.对导航坐标系中的加速度分量进行补偿并积分，获取载体的速对导航坐标系中的加速度分量进行补偿并积分，获取载体的速度和位置信息度和位置信息.Lecture 10-Algorithms for SINS3z,方位轴方位轴x,滚动轴滚动轴y,俯仰轴俯仰轴1.2 姿态变换姿态变换加速度需要变换加速度需要变换:q C 包含姿态信息包含姿态信息.q 也可用欧拉角、四元数等表示姿态也可用欧拉角、四元数等表示姿态Lecture 10-Algorithms for SINS41.3 SINS的示意框图的示意框图计算载体的计算载体的姿态信息姿态信息 姿态信息姿态信息计算机计算机沿载体轴的沿载体轴的 加速度输出加速度输出沿载体轴的沿载体轴的 角速率输出角速率输出惯性元件惯性元件对加速度分量对加速度分量进行坐标变换进行坐标变换沿地理坐标沿地理坐标 系各轴的加系各轴的加速度速度导导航航计计算算显显示示姿态姿态 位置位置速度速度对地理坐对地理坐标系进行标系进行 修正修正数学平台数学平台Lecture 10-Algorithms for SINS5Outlineq 捷联惯导系统概述捷联惯导系统概述q 姿态矩阵（姿态矩阵（DCM）微分方程的推导）微分方程的推导q 方向余弦矩阵的求解方向余弦矩阵的求解:角增量算法角增量算法Lecture 10-Algorithms for SINS6z,方位方位x,滚动滚动y,俯仰俯仰2.1 方向余弦矩阵方向余弦矩阵咋来的？咋来的？S1设设 S1 为导航坐标系，其单为导航坐标系，其单位坐标矢量为位坐标矢量为 i,j 和和 kS2S2 为载体坐标系为载体坐标系,其单位坐标矢量其单位坐标矢量为为 i,j 和和 k Lecture 10-Algorithms for SINS72.1 方向余弦矩阵方向余弦矩阵C 为从为从 S2 到到 S1 的方向余弦的方向余弦矩阵，即矩阵，即:S2S1其中其中 载体的旋转导致载体的旋转导致 C 发生变化发生变化Lecture 10-Algorithms for SINS82.2 方向余弦矩阵的导数方向余弦矩阵的导数so设载体坐标系相对于导航坐标系的角速度为设载体坐标系相对于导航坐标系的角速度为表示在载体坐标系中表示在载体坐标系中则则类似的类似的Lecture 10-Algorithms for SINS9则则2.3 方向余弦矩阵微分方程方向余弦矩阵微分方程-斜斜对称矩阵对称矩阵-其解取决于其解取决于 C(0)和载体的转动角速度的变化规律和载体的转动角速度的变化规律Lecture 10-Algorithms for SINS10Outlineq 捷联惯导系统概述捷联惯导系统概述q 姿态矩阵（姿态矩阵（DCM）微分方程的推导）微分方程的推导q 方向余弦矩阵的求解方向余弦矩阵的求解:角增量算法角增量算法Lecture 10-Algorithms for SINS113.1 方向余弦矩阵微分方程方向余弦矩阵微分方程记初始时刻的地理坐标系为记初始时刻的地理坐标系为 G0,则有则有其中其中则则记记where(角增量角增量)and denote(向量的模向量的模)Lecture 10-Algorithms for SINS123.2*毕毕-卡解卡解-毕毕-卡形式的解卡形式的解可记为可记为:近似计算近似计算:Lecture 10-Algorithms for SINS133.3*角增量算法角增量算法方程的解方程的解各阶近似各阶近似:1st:2nd:.许多类型的陀螺仪可用内部许多类型的陀螺仪可用内部硬件完成对角速率的积分，硬件完成对角速率的积分，从而直接输出角增量从而直接输出角增量.Lecture 10-Algorithms for SINS143.6 地理坐标系的修正地理坐标系的修正EN0TENLecture 10-Algorithms for SINS153.7 算例算例某捷联惯导系统在某捷联惯导系统在 n 时刻时刻,其载体坐标系和惯性坐标系重合其载体坐标系和惯性坐标系重合.然然后从时刻后从时刻 n 到时刻到时刻 n+1,沿着载体三个轴的三个陀螺仪沿着载体三个轴的三个陀螺仪 X,Y,Z 的角增量输出分别为的角增量输出分别为 0.002,0.004 和和 0.006(rad);请利用基于请利用基于Peano-Paker 解的一阶角增量算法计算时刻解的一阶角增量算法计算时刻 n+1 载体和惯性坐载体和惯性坐标系之间的方向余弦矩阵标系之间的方向余弦矩阵.Lecture 10-Algorithms for SINS163.7 算例算例Lecture 10-Algorithms for SINS17Summary捷联惯导系统概述捷联惯导系统概述方向余弦矩阵微分方程的推导方向余弦矩阵微分方程的推导方向余弦矩阵的求解方向余弦矩阵的求解:角增量算法角增量算法Lecture 10-Algorithms for SINS18End