惯性导航期末复习:方向余弦阵、四元数与舒勒回路高频考点

简介:面向东南大学惯性导航课程期末复习整理的问答型笔记,适合正在备考的本科生对照课堂重点梳理知识框架。内容围绕坐标变换矩阵求取、地球模型与垂线纬度定义、惯性器件(陀螺仪与加速度计)性能要求展开,并延伸到惯导平台工作状态与基本回路、舒勒摆与舒勒回路、哥氏定理、比力方程与惯导基本方程的推导思路,以及方向余弦阵微分方程、指北与游移方位惯导系统、四元数姿态描述、捷联惯导初始对准等常考题目。压缩包仅含1个docx文档,约18.25MB,以题目清单加要点解答的形式组织,便于按题号逐条背诵与查漏补缺。已有955人学习,适合考前快速过一遍概念与证明脉络。

1. 惯性导航期末卷的分数结构:推导占一半,物理含义决定另一半

某高校惯性导航的期末复习资料里,二十五道题几乎把整本书串了一遍,但真正决定及格线的并不是题量。翻开卷子你会发现,坐标变换矩阵、比力方程、惯导基本方程这类推导题分值最重,而每道推导后面几乎都跟着一句“说明各项物理含义”或“说明证明思路”。很多人把公式推完就停笔,结果步骤分拿了一半,解释分全丢。这门课考的是“能不能把式子讲成人话”:先把几何关系说清,再把每一项对应到哪个物理量,最后补一句工程上为什么这么处理。适合已经把课本翻过一遍、但一合上书就说不清所以然的人,按考点模块过一遍,比从头再读一遍教材有效得多。

2. 坐标变换与地球模型:方向余弦阵、四元数、垂线纬度的必考问法

这一块对应资料里的第1、3、14、15、21题,横跨简答、计算和推导三种题型,分值加起来通常超过二十分。共同点是都要求先把坐标系定义讲清,再动笔算。坐标变换矩阵的求取方法,资料里提到矩阵乘法和向量点乘,那只是工具,卷面真正要你回答的是“用哪条路径求、为什么选这条”。地球模型、垂线、纬度这三组概念则几乎年年出选择题或填空,错一个词就整题没分,得先把定义和惯导实际选用的模型分开记。

2.1 方向余弦阵的三条求取路径与微分方程推导

求方向余弦阵,考场上能走的路就三条。第一条是按基向量投影直接写:把b系三个单位矢量在n系中的投影排成列,得到的3×3矩阵就是C_b^n,适合题目已经给出几何夹角的情况。第二条是欧拉角连乘:按z-y-x或z-x-y的顺序三次旋转,每次写一个初等旋转阵再相乘,优点是物理意义清楚,缺点是存在奇异点,俯仰角接近±90°时方程退化。第三条是四元数构造,先更新四元数再转成矩阵,计算量大但无奇异,捷联系统实际用的就是这条。

卷面第14题“试推导方向余弦阵的微分方程”,标准骨架分三步。第一步定义符号:设C_b^n为b系到n系的方向余弦阵,b系相对n系的转动角速度为ω_nb^b,注意上标必须是b系投影,这是最容易写错的地方。第二步对基向量求导:b系第i个基向量在n系中的变化率等于角速度矢量叉乘该基向量,写成矩阵就是每个基向量导数为-[ω_nb^b×]乘对应的列。第三步把所有列合起来,得到

Ċ_b^n = C_b^n · [ω_nb^b×]

其中[ω×]是反对称矩阵,形式为三行三列,主对角线全零,非对角线元素由角速度分量正负交替组成。答题时把反对称矩阵展开写出来,再补一句“该式说明方向余弦阵的变化率由相对角速度唯一确定”,这一步就是解释分。

容易翻车的是角速度下标。有人写成ω_ib^b,意思变成b系相对惯性系,物理上不对;也有人把上标写成n,矩阵维度立刻对不上。判断方法很简单:C_b^n右边乘的必须是b系投影的量,上标必须是b。这个检查习惯能救回不少步骤分。

2.2 小角度近似与四元数:计算题和简答题的分界

卷面第15题给的是小角度转动:a系到b系转角为小角度,求变换阵及其导数。这类题只考一个近似:当转角 θ 很小时,cosθ≈1、sinθ≈1不成立,正确写法是cosθ≈1、sinθ≈θ,于是方向余弦阵近似为C ≈ I - [θ×],符号取决于旋转方向的定义,答题时先声明“按右手定则、b系相对a系转动”再写符号,避免和标准答案差一个负号。导数则为Ċ ≈ -[θ̇×],再说明小角度下两个变换阵相乘可交换,因为二阶小量可以忽略。

四元数那道简答题(第21题)分值不高但丢分集中。定义要写全:q = q0 + q1i + q2j + q3k,满足q0²+q1²+q2²+q3²=1,其中q0是标量部分,q1到q3是矢量部分。描述形式至少写两种:矢量形式q=[q0, qv],三角形式q=[cos(θ/2), sin(θ/2)·u],u为单位转轴。与姿态阵的关系必须给出矩阵,不能只写“四元数可以表示姿态”就收笔,那句话没有分。

import numpy as np def quat_to_dcm(q): # q = [q0, q1, q2, q3],q0 为标量部分,q1~q3 为矢量部分 q0, q1, q2, q3 = q / np.linalg.norm(q) # 先归一化,否则数值漂移会直接毁掉姿态阵 C = np.array([ [1 - 2*(q2**2 + q3**2), 2*(q1*q2 - q0*q3), 2*(q1*q3 + q0*q2)], [2*(q1*q2 + q0*q3), 1 - 2*(q1**2 + q3**2), 2*(q2*q3 - q0*q1)], [2*(q1*q3 - q0*q2), 2*(q2*q3 + q0*q1), 1 - 2*(q1**2 + q2**2)] ]) return C

这段代码不是让你在卷子上写程序,而是帮你记矩阵元素的排列顺序:对角线是“1减另外两个平方的两倍”,非对角线是“两两乘积加减q0乘第三分量”,正负号成对出现。参数上,q的输入顺序必须是标量在前、矢量在后,很多教材写成矢量在前,考试如果题目给了顺序就按题目来,没给就在答案里注明自己的约定。归一化那一步对应考试里的“单位四元数”条件,少了它矩阵不再是正交阵,这一条常被当作隐含条件扣分。

2.3 地球模型、垂线与纬度:三个概念一张表

第3题一口气问了地球描述模型、垂线定义、纬度定义、惯导选用哪种模型、重力与引力的关系,是典型的“概念打包题”。地球模型常见三类:圆球模型、旋转椭球模型、参考椭球模型,有的教材还会提大地水准面。圆球模型把地球当成半径固定的球,惯导的舒勒调谐就是按圆球推出来的,误差在大多数应用里可以接受;椭球模型更接近真实形状,用于高精度导航和测绘;参考椭球是人为规定的、与局部大地水准面最佳拟合的椭球,解决的是坐标基准问题。

垂线有两种:几何垂线是椭球面的法线,纯几何概念;物理垂线是重力方向,也叫大地垂线,受地球质量分布影响,两者之间的夹角叫垂线偏差。纬度同样有三种:地理纬度是法线与赤道面的夹角,地心纬度是地心连线与赤道面的夹角,天文纬度是物理垂线与赤道面的夹角。地理纬度和地心纬度最大差约11.5角分,这个数字常出现在选择题里。

概念定义依据惯导是否采用常见考法
圆球模型半径固定的球采用,用于舒勒调谐推导问“为什么用圆球”
旋转椭球模型子午椭圆绕短轴旋转高精度场景参考与圆球模型对比
参考椭球与局部水准面拟合坐标基准用问拟合对象
几何垂线椭球法线不直接用与物理垂线区分
物理垂线重力方向采用问垂线偏差来源
地理纬度法线与赤道面夹角采用与地心纬度换算

重力加速度与引力加速度的关系要写成一句话再加一个式子:重力是引力与地球自转离心惯性力的合力,g = G - ω_ie × (ω_ie × r),其中G为引力加速度,第二项为离心加速度,方向垂直自转轴向外。答题时补一句“惯导解算中把重力视为已知量,用重力模型计算,不靠加速度计直接测”,这句话能说明你懂工程处理,而不是只背了公式。

3. 惯性器件与平台:惯性级指标、四种工作状态、三条基本回路

第2、4、6、8、9、22题集中在这一块,题型以简答为主,特点是“问得直、答得散”。惯性级陀螺和加速度计的要求,很多资料只写“精度高、稳定性好”,这种答案在卷面上拿不到分,必须落到具体指标名称和量级。平台工作状态和基本回路则是典型的“分类题”,答错分类等于整题作废,先把分类标准记住,再往里填特征。

3.1 惯性级陀螺与加速度计的硬指标:六条要求怎么背

惯性级加速度计的要求可以归成六条。第一是分辨率高,要能敏感10⁻⁵g量级的加速度变化,因为惯导在匀速飞行时测的就是这点小量。第二是零偏小且稳定,零偏决定长时间导航的位置漂移,稳定性比绝对值更重要,标定可以扣掉常值,扣不掉的是随机漂移。第三是标度因数线性度好,输入输出关系偏离直线的程度要小,否则大加速度段误差无法补偿。第四是量程够用,一般要覆盖正负几个g到十几个g,取决于载体机动能力。第五是动态范围大,小信号能测、大信号不饱和,这两件事同时做到才有意义。第六是环境适应性,温度、振动、冲击下参数不能漂。

惯性级陀螺的要求与之对应,但指标名称不同:零漂要小,惯性级通常在0.01°/h量级甚至更低;标度因数要稳定,长期重复性要好;随机游走要小,它决定姿态误差随时间的发散速度;动态范围要大,既要测地球自转15°/h这样的微弱输入,也要承受载体机动带来的大角速度;抗振动冲击能力要强,陀螺对线振动引起的整流误差很敏感;启动时间要短,这对快速反应场景是硬约束。

卷面第4题和第6题经常被合并成一道“试述惯性级惯性器件的要求”,答题时按“分辨率、零偏/零漂、标度因数、量程与动态范围、环境适应性、启动特性”六条排列,每条后面加半句“因为……”,比如“零偏稳定性要求高,因为惯导误差随时间积累,常值零偏可以标定,随机漂移只能靠器件本身”。这半句就是区分背题和理解的标志。

3.2 平台工作状态:指北、游移、自由、空间稳定怎么区分

第8题问惯导平台有几种工作状态。主流教材的分法是指北方位、游移方位、空间稳定三类,有的版本把自由方位单列,考试时先写“常见分为三类”,再补一句“也有教材将自由方位单独列出”,既稳妥又不显得含糊。

指北方位状态:平台始终跟踪当地地理坐标系,一个轴指东、一个轴指北、一个轴指天。优点是平台系就是地理系,姿态角、航向角可以直接读出,导航参数计算简单,不需要额外的坐标变换;缺点是方位轴要跟随地球自转和载体运动连续转动,纬度越高方位角变化率越大,到了极点附近方位失去定义,所以不能全球导航。

游移方位状态:平台方位轴不锁定地理北,而是相对惯性空间保持稳定,方位角随载体运动自然游移。这样做的直接好处是避开极区方位角变化率发散的问题,实现全球导航;代价是平台系与地理系之间多了一个游移方位角,导航解算要多算一个角,姿态输出也要做转换。卷面第17题“游移方位系统如何实现全球导航”,答案就落在这句“方位不锁定、避免极区奇异、用游移角补偿”上。

空间稳定状态:平台相对惯性空间稳定,不跟踪地球。这种状态多用于短时间、高精度的场景,比如发射载体上的惯导,因为不需要连续修正,避免了修正回路引入的误差;缺点是导航系与平台系之间的变换关系随时间变化,解算复杂。

三种状态的区别可以压成一句口诀:指北跟地理、游移跟惯性、空间稳定完全不跟。答题时把这句放在开头,再展开各自优缺点,阅卷时一眼就能看到分类正确。

3.3 平台基本回路:稳定、修正、锁定各管什么

第9题问平台有哪些基本回路,标准答案三条:稳定回路、修正回路、锁定回路。

稳定回路的作用是让平台相对惯性空间保持稳定,隔离载体的角运动。它由陀螺、放大器、力矩器和平台台体构成闭环,陀螺敏感平台相对惯性空间的偏转,输出信号经放大加到力矩器,产生反力矩把平台拉回原位。这条回路的带宽要求高,因为载体角运动频率可能很高,回路跟不上平台就会晃动。

修正回路的作用是让平台跟踪导航坐标系。指北系统中,它把重力加速度和地球自转角速度的信息引入,使平台始终保持水平并指北;具体做法是用加速度计测出平台相对水平面的倾角,转换成修正角速度加到陀螺力矩器上。修正回路的增益不是随便取的,要满足舒勒调谐条件,这一点和第10题直接挂钩。

锁定回路的作用是在初始对准或特殊工作状态下把平台锁定在某个固定位置,防止它自由漂移。对准结束后锁定回路要按程序退出,让修正回路接管,这个切换顺序写错也是常见失分点。

三条回路的关系可以说成:稳定回路保命,修正回路保精度,锁定回路保流程。答题时先列三条,再各用两三句说清输入、输出和作用对象,比只写名称要稳得多。

4. 舒勒回路与动力学方程:舒勒调谐、哥氏定理、比力方程的证明骨架

第10到13题加上第5、7题,是整份资料里推导密度最高的一段。舒勒摆和舒勒回路的异同是简答,哥氏定理、比力方程、惯导基本方程是证明,摆组件和挠性陀螺的拉普拉斯变换是计算。这几道题的共同套路是:先写矢量关系,再用定理替换导数,最后整理成标准形式并逐项解释。套路固定,练的是每一步不跳步。

4.1 舒勒摆与舒勒回路:相同点、不同点、工程上怎么实现

舒勒摆是一个无阻尼物理摆,摆长等于地球半径,固有频率为ω_s = √(g/R),振荡周期T = 2π√(R/g),算出来约84.4分钟。这个摆的特殊之处在于:当它的支点跟着载体加速运动时,摆的指示不产生误差,因为惯性力和重力对摆的作用刚好抵消。舒勒把这个性质搬进惯导,就有了舒勒回路。

相同点有三条:振荡周期相同,都是84.4分钟;都是无阻尼等幅振荡,误差不发散也不衰减;都对载体的线加速度不敏感,载体加速时系统不产生额外的姿态误差。不同点也有三条:舒勒摆是物理实体,靠摆长和重力场参数自然满足调谐;舒勒回路是控制回路,靠修正回路增益人为凑出g/R这个系数;舒勒摆的振荡是机械运动,舒勒回路的振荡是平台误差角的数学振荡,没有实物在摆。

第10题后半问“惯性导航中如何实现舒勒振荡”,答案落在修正回路的设计上:把加速度计输出的比力积分成速度,再乘以g/R反馈到水平修正通道,使平台误差角方程变成θ̈ + (g/R)θ = 0的形式,特征方程无阻尼、自然频率等于舒勒频率。工程上还会加阻尼网络改善对准阶段的动态特性,但进入导航状态后必须把阻尼去掉,否则会破坏等幅振荡条件,引入新的误差。这句话很多答案里没有,写上就是加分点。

4.2 哥氏定理到比力方程:证明题的通用四步

哥氏定理(也叫哥里奥里定理)描述的是同一个矢量在两个相对转动坐标系中变化率的关系:dA/dt|i = dA/dt|e + ω_ie × A。三项分别是绝对变化率、相对变化率、牵连变化率,最后一项就是哥氏项。答题时不要只写公式,要把三项的物理含义各用一句话说清,比如“绝对变化率是在惯性系观察到的变化,相对变化率是在地球系观察到的变化,哥氏项是因为坐标系转动带来的附加变化”。

比力方程的证明走四步。第一步,写出载体位置矢量在惯性系中的表达式,对时间求一次导得到绝对速度。第二步,用哥氏定理把绝对速度换成地球系速度加牵连速度,得到v_i = v_e + ω_ie × r。第三步,再对时间求一次导,第二次用哥氏定理,把惯性系加速度换成地球系加速度,展开后会出现2ω_ie × v_e这一项,就是哥氏加速度。第四步,把重力项移到等式一边,整理得到

f = v̇_e + (2ω_ie + ω_en) × v_e - g

其中f是加速度计测到的比力,v̇_e是载体相对地球的加速度,2ω_ie × v_e是哥氏加速度,ω_en × v_e是载体在地球表面运动引起的向心加速度,g是重力加速度。惯导基本方程就是把上式移项写成v̇_e = f - (2ω_ie + ω_en) × v_e + g,第13题要的正是这个形式和各项含义。

证明题最忌讳只写结果不写过程。阅卷时按步给分,哥氏定理用两次、每次替换的对象写清楚,比最后结果写对更重要。另外注意ω_en的下标,它表示地球系相对导航系的角速度,有人写成ω_ie,物理含义完全变了,这一处错整道题的逻辑就断了。

4.3 拉普拉斯变换题:摆组件与挠性陀螺共用一套模板

第5题和第7题看起来是两道不同的题,一个是摆组件运动方程,一个是动力调谐式挠性陀螺的简化方程,但解法完全一样,都是二阶线性常系数微分方程求拉普拉斯变换。

以摆组件为例,引入再平衡力矩后的运动方程通常写成转动惯量乘角加速度、加阻尼乘角速度、加刚度乘角度等于力矩的形式,即Jθ̈ + Dθ̇ + Kθ = M(t)。两边取拉普拉斯变换,用微分性质:θ̈变成s²Θ(s) - sθ(0) - θ̇(0),θ̇变成sΘ(s) - θ(0)。考试默认零初始条件,初值项直接划掉,得到

(Js² + Ds + K)Θ(s) = M(s)

传递函数就是Θ(s)/M(s) = 1/(Js² + Ds + K)。答题时补三句:一是说明零初始条件的假设;二是把分母写成标准二阶形式,指出自然频率和阻尼比;三是说明极点位置决定系统的稳定性和响应快慢。挠性陀螺的方程形式相同,只是J、D、K的物理来源不同,分别对应转子惯量、挠性接头阻尼和挠性接头刚度,参数含义写对,步骤分就稳。

这类题最常见的错误是拉普拉斯变换时漏掉初值项又不说假设,或者把θ̈的变换写成s²Θ(s)却不解释。稳妥的写法是先写完整变换式,再补一句“本题研究稳态响应,取零初始条件”,既严谨又不啰嗦。

5. 失分点:五个一写就错的答题习惯

这一部分不是新知识点,是把前面几块里最容易翻车的地方单独拎出来。每一条都对应卷面上真实出现过的错误答案,错法有共性:不是不会,而是背串了、写急了、少写了一句。考前把这五条过一遍,比多做一套卷子划算。

5.1 垂线与纬度混着用

错在哪:第3题问惯导采用何种垂线和纬度,有人答“采用几何垂线和地心纬度”,把两个概念各错一半。为什么错:几何垂线是椭球法线,地心纬度是地心连线与赤道面的夹角,这两个都不反映重力方向,而惯导的水平基准靠的是重力,平台修正回路用的就是重力矢量。怎么答对:先记住“惯导测的是重力,所以用物理垂线”,再记“导航解算按圆球模型简化,纬度用地理纬度”,两句话连起来写,逻辑自洽。如果题目追问垂线偏差,补一句“物理垂线与几何垂线的夹角,高精度场合需要补偿”,这一分就拿到了。

5.2 舒勒回路答成“消除误差”

错在哪:第10题问舒勒回路的作用,常见答案是“消除惯导系统的误差”。为什么错:舒勒回路做的是把误差振荡调成等幅振荡,周期84.4分钟,误差不会无限发散,但也不会消失;说“消除”等于把无阻尼振荡说成了渐近稳定,物理图像完全反了。怎么答对:标准表述是“使系统误差按舒勒周期等幅振荡,从而对载体加速度不敏感”,再补一句“要真正减小误差,靠的是器件精度和初始对准精度”。这句话能把舒勒回路和误差抑制的关系讲清楚,而不是混为一谈。

5.3 内反馈回路对准结束后不断开

错在哪:第19题问初始对准为什么要引入内反馈回路、对准结束后怎么处理。很多人只答“引入内反馈是为了方位对准”,后半问空着,或者答“保留内反馈以维持对准效果”。为什么错:内反馈回路的作用是在对准阶段把水平失准角耦合到方位通道,加快罗经效应的收敛;但它的参数是按对准阶段的动态特性设计的,进入导航状态后继续保留会破坏舒勒调谐,引入额外的振荡和误差。怎么答对:先写“对准阶段引入内反馈,用于提取罗经项、加快方位误差收敛”,再写“对准结束后必须断开内反馈,恢复舒勒回路,否则破坏等幅振荡条件”。一进一出,两句话把前后逻辑补齐。

5.4 指北与游移方位的优缺点写反

错在哪:第16、17题连着考两种系统,有人把“能全球导航”安在指北系统头上,把“高纬度方位误差大”安在游移方位头上。为什么错:指北系统的平台方位轴要跟踪地理北,纬度越高方位角变化率越大,极区附近方位失去定义,所以它不能全球导航;游移方位恰恰是为了解决这个问题才让方位轴相对惯性空间稳定。怎么答对:记一个因果链——指北跟地理,所以极区失效;游移不跟地理,所以全球可用但要多算一个游移角。答题时先写“指北系统优点是导航参数直观、解算简单,缺点是不能全球导航”,再写“游移方位优点是全球可用、避开极区奇异,缺点是多一个游移角、姿态输出要转换”,两条对照着写,不容易串。

5.5 四元数只写定义不写姿态阵

错在哪:第21题问四元数有哪些描述形式、与姿态阵的关系,答案只写了定义和归一化条件,矩阵一个字没有。为什么错:这道题的分值分布是定义三分之一、描述形式三分之一、与姿态阵关系三分之一,最后一块是重头,空着直接丢分。怎么答对:定义写标量加矢量形式,描述形式写矢量形式和三角形式,关系部分把3×3矩阵完整写出来,再补一句“四元数更新后需归一化,否则矩阵不再正交”。如果时间紧,矩阵可以只写第一行加“其余两行按循环对称写出”,但必须让阅卷看到你知道元素怎么排。

6. 押题与答题模板:把二十五道题压成四段话

最后几天不建议再从头翻书,按题型把答案压成模板更有效。整份资料二十五个问题,归到底就四类:概念定义类、方程推导类、系统对比类、参数计算类。每一类都有固定的起手式和收尾句,练熟之后看到题就能往下写。

题型代表题号答题骨架收尾句
概念定义3、21、22定义→分类→惯导选用哪种→为什么工程上这样选是因为……
方程推导11、12、13、14定义符号→基向量或矢量求导→整理标准形式→逐项含义该式说明……由……唯一确定
系统对比16、17、18定义→优点两条→缺点两条→适用场景两者的根本区别在于……
参数计算5、7、15写方程→取变换或近似→整理结果→说明参数物理意义结果中……决定……

以第23题“梳理捷联惯导计算姿态角和平台方位角的思路”为例,模板直接套:先说捷联没有物理平台,姿态矩阵由陀螺输出更新四元数得到;再说更新用一阶或二阶龙格库塔积分,步长和角速度增量有关;然后从姿态阵提取欧拉角,注意俯仰角接近±90°时的奇异处理;最后说平台方位角不是物理量,而是姿态阵的一个元素组合,指北系统中它对应航向角,游移方位系统中要加上游移角。四段写完,逻辑链完整,比零散罗列公式稳。

第24、25题考捷联初始对准,押题方向很明确:粗对准用重力矢量和地球自转角速度矢量做双矢量定姿,精对准用卡尔曼滤波或罗经法处理器件输出,校正失准角。答题时把“粗对准解析求矩阵、精对准滤波估失准角”这组对比写出来,再补一句“平台式有实际对准回路,捷联式只有对准程序,本质都是把舒勒等幅振荡改成提高频率的减幅振荡”,这句话是资料里现成的,写上就是标准答案的味道。

我自己吃过一次亏:推导题写完公式就交卷,觉得过程都在,结果分数出来比估的低一截。后来把每道推导后面强制加一句“式中各项含义为……”,才发现那句话才是阅卷人找的东西。从那以后我每次答推导题都强制走一遍“符号定义—矢量求导—标准形式—物理含义”四步,一步不落。希望帮到你。

本文还有配套的精品资源,点击获取