方向余弦矩阵和姿态角提取算法(矩阵).pptx

Lecture10--AlgorithmsforSINS1Strap-downInertialNavigationSystem捷联惯导系统——介绍及算法（DCM）IntroductionandAlgorithms

OutlineLecture10--AlgorithmsforSINS201捷联惯导系统概述02姿态矩阵（DCM）微分方程的推导03方向余弦矩阵的求解:角增量算法

1.1*捷联惯导系统:特点Lecture10--AlgorithmsforSINS3方位轴滚动轴俯仰轴陀螺和加速度计被直接“捆绑(strapped)”到载体上没有物理的平台对陀螺仪的角速度输出进行积分，获取载体的姿态信息.加速度计的输出需要变换到导航坐标系中.对导航坐标系中的加速度分量进行补偿并积分，获取载体的速度和位置信息.

1.2姿态变换Lecture10--AlgorithmsforSINS4z,方位轴x,滚动轴y,俯仰轴加速度需要变换:C包含姿态信息.也可用欧拉角、四元数等表示姿态

1.3SINS的示意框图Lecture10--AlgorithmsforSINS5计算载体的姿态信息姿态信息计算机沿载体轴的加速度输出沿载体轴的角速率输出惯性元件对加速度分量进行坐标变换沿地理坐标系各轴的加速度导航计算显示姿态位置速度对地理坐标系进行修正数学平台

OutlineLecture10--AlgorithmsforSINS61捷联惯导系统概述2姿态矩阵（DCM）微分方程的推导3方向余弦矩阵的求解:角增量算法

2.1方向余弦矩阵Lecture10--AlgorithmsforSINS7z,方位x,滚动y,俯仰咋来的？S1设S1为导航坐标系，其单位坐标矢量为i,j和kS2S2为载体坐标系,其单位坐标矢量为i’,j’和k’

2.1方向余弦矩阵Lecture10--AlgorithmsforSINS8C为从S2到S1的方向余弦矩阵，即:S2S1其中载体的旋转导致C发生变化

2.2方向余弦矩阵的导数Lecture10--AlgorithmsforSINS9类似的设载体坐标系相对于导航坐标系的角速度为表示在载体坐标系中so则

2.3方向余弦矩阵微分方程Lecture10--AlgorithmsforSINS10则--斜对称矩阵---其解取决于C(0)和载体的转动角速度的变化规律

OutlineLecture10--AlgorithmsforSINS11捷联惯导系统概述01.姿态矩阵（DCM）微分方程的推导02.方向余弦矩阵的求解:角增量算法03.

3.1方向余弦矩阵微分方程Lecture10--AlgorithmsforSINS12记初始时刻的地理坐标系为G0,则有其中则记where(角增量)anddenote(向量的模)

3.2*毕-卡解Lecture10--AlgorithmsforSINS13------毕-卡形式的解可记为:近似计算:

3.3*角增量算法Lecture10--AlgorithmsforSINS14方程的解各阶近似:1st:2nd:………..许多类型的陀螺仪可用内部硬件完成对角速率的积分，从而直接输出角增量.

3.6地理坐标系的修正Lecture10--AlgorithmsforSINS15ENζ0TENζ

3.7算例Lecture10--AlgorithmsforSINS16某捷联惯导系统在n时刻,其载体坐标系和惯性坐标系重合.然后从时刻n到时刻n+1,沿着载体三个轴的三个陀螺仪X,Y,Z的角增量输出分别为0.002,0.004和0.006(rad);请利用基于Peano-Paker解的一阶角增量算法计算时刻n+1载体和惯性坐标系之间的方向余弦矩阵.

3.7算例Lecture10--AlgorithmsforSINS17

SummaryLecture10--AlgorithmsforSINS18捷联惯导系统概述01方向余弦矩阵微分方程的推导02方向余弦矩阵的求解:角增量算法03

Lecture10--AlgorithmsforSINS19End