从陀螺仪到舒勒回路：惯性导航核心考点梳理

简介：面向东南大学惯性导航课程期末复习的问答型资料包，适合考前梳理概念、核对公式推导与查漏补缺。包内仅含1个docx文档，压缩包约18.25MB，以25个复习问题串联坐标变换矩阵求取、惯性器件功用、地球模型与垂线纬度定义、惯性级陀螺和加速度计要求、拉普拉斯变换推导、惯导平台工作状态与基本回路、舒勒摆与舒勒回路、哥氏定理、比力方程、惯导基本方程、方向余弦阵微分方程、指北与游移方位系统、误差传播、初始对准、四元数及捷联系统对准等考点。文档按题号组织，便于对照课堂重点逐条复盘，也能帮助理解概念之间的区别与联系。已有955人学习，适合需要系统过一遍知识点、补充推导思路和检查复习盲区的学习者。

1. 一句话说清惯性导航：蒙上眼睛，它凭什么知道你在哪

惯性导航，说白了就是一套“不看路也能算路”的本事：不依赖卫星信号，也不靠地面基站，只靠自己身上那几只传感器，把每一次转弯、每一脚加速都记下来，然后一路累加，推算出此刻的位置和姿态。听起来有点玄学，其实逻辑很朴素——知道出发点，记住每个瞬间的加速度和转动，再积分两次，路就“算”出来了。它值得搞懂，是因为很多场合卫星信号根本靠不住：水下、隧道、强电磁干扰环境，这时候惯导就是那只唯一的黑匣子。这份复习资料把这条线索拆成二十多个考点，从坐标变换一路讲到初始对准，期末复习时正好拿来串成一条线。

2. 惯导的两块心脏：陀螺仪和加速度计到底在测什么

一套惯导系统里，真正跟物理世界打交道的只有两类器件：陀螺仪和加速度计。剩下的事情，全是计算机在做算术。很多人第一次接触会觉得奇怪——既然要测位置和姿态，为什么不直接装个“位置传感器”？答案很现实：宇宙里没有一把刻好刻度的尺子，能测的只有“变化率”。位置是速度的积分，速度是加速度的积分，姿态是角速度的积分，所以惯导从设计之初就注定是一个“积分机器”。理解这一点，后面所有的误差为什么会随时间发散，就都好解释了。

2.1 陀螺仪：它测的是转动快慢，不是角度

把陀螺仪想成汽车上的车速表，而不是里程表。车速表给你的是“此刻跑多快”，想知道跑了多远，得自己按时间累加。陀螺仪输出的就是角速度，单位一般是度每小时或者弧度每秒，想要姿态角，必须做一次积分。这也解释了为什么陀螺的误差特别要命：角速度上一点点偏差，积分几分钟也许看不出来，积分一小时就变成了实打实的角度漂移，而且这个漂移还会继续被后面的计算放大。

那为什么不直接测角度？因为角度必须有参照物。你说“我现在转了30度”，总得先说清是相对哪个基准转的。惯性空间倒是提供了一个天然基准，可它没有刻度。陀螺仪能感知的是“相对惯性空间的转动速率”，这已经是物理上能给到的最接近绝对参考的量了。所以惯导里所有的姿态解算，本质都是在跟这个积分过程打交道。

工程上常见的陀螺有几大类：靠高速转子撑着的机电陀螺、靠挠性接头和平衡环调谐的动力调谐式挠性陀螺、靠光程差感知旋转的激光和光纤陀螺，以及尺寸很小的MEMS陀螺。资料里专门提到的动力调谐式挠性陀螺，考点落在“对运动简化方程做拉普拉斯变换”上。这类题看着吓人，思路其实固定：先把挠性接头和平衡环的力矩平衡写成微分方程，两边取拉氏变换、初始条件置零，微分方程就变成了代数方程，整理一下就能得到传递函数，从传递函数的分母就能看出系统的固有频率和阻尼特性。

惯性级陀螺必须满足哪些要求，是这份资料里一道标准问答。核心无非几条：零偏要小且稳定，因为零偏直接变成姿态漂移；标度因数要准且线性，否则大角速度下读数会系统性偏大偏小；随机噪声要低，噪声积分之后就是随机游走；动态范围要够宽，既得测得出慢速漂移，也得扛得住快速机动；还要能适应温度、振动、冲击这些环境条件。所谓“惯性级”，说的就是这类指标整体上了一个台阶、能独立支撑导航解算的器件等级。

2.2 加速度计：测的是比力，不是加速度

加速度计更容易被误解。很多人以为它测的是“加速度”，其实它测的是比力——通俗地说，是“支撑力除以质量”。想象手里托着一个弹簧秤，秤上挂个砝码：静止时读数等于重量；把整套装置自由落体放下去，读数会变成零。可自由落体明明是加速运动，读数却是零，说明它测的从来不是加速度本身，而是除了引力之外、作用在物体上的那部分力。

惯导里把这个量叫作比力，用 f 表示。它和加速度、引力加速度之间的关系，就是比力方程要处理的事情。加速度计测到的是比力，导航计算机要做的，是把引力项和哥氏项扣掉，才能得到载体相对地球的真实加速度。这个“扣”的过程，正是惯导基本方程存在的意义。搞不清比力和加速度的区别，后面的方程推导基本就只能靠背了。

摆式加速度计是最经典的一种实现：一个可以绕轴转动的摆组件，载体加速时摆会因为惯性相对壳体偏转，传感器测出这个偏转角，再通过力矩器施加再平衡力矩把它拉回零位，施加的力矩大小就正比于比力。资料里那道“对引入再平衡力矩的摆组件运动方程做拉普拉斯变换”的题，考的就是这个闭环。写出摆的转动惯量、阻尼、弹簧刚度、再平衡力矩之间的力矩平衡方程，取拉氏变换，整理成输入力矩到输出角度的传递函数，就能看出这是一个典型的二阶系统，阻尼比和自然频率决定了它的动态响应。

惯性级加速度计的要求和陀螺类似：分辨率要高，因为要测的是很小的加速度变化；零偏要小且稳定；标度因数要准；线性度要好；带宽要覆盖载体的机动频率；同样要能扛环境。这里有个容易踩坑的点：加速度计的零偏和陀螺的零偏，在误差传播里的角色完全不同——陀螺零偏造成的是姿态误差随时间增长，加速度计零偏造成的是速度误差随时间线性增长、位置误差随时间平方增长，后者发散得更快。

2.3 精度要求有多苛刻：算一笔账

“惯性级”这三个字到底意味着什么，算一笔账最直观。假设平台已经对准好、处于水平状态，陀螺存在一个恒定的等效漂移，平台就会慢慢倾斜；平台一倾斜，重力在水平方向就有了分量，加速度计会把这个分量误当成载体的加速度，两次积分之后就是位置误差。

import math R = 6371000.0 # 地球平均半径，单位 m eps_deg_h = 0.01 # 陀螺等效漂移，单位 度/小时 eps_rad_h = math.radians(eps_deg_h) # 换算成 弧度/小时 drift_m_h = R * eps_rad_h # 每小时产生的位置误差，单位 m drift_nm_h = drift_m_h / 1852.0 # 换算成 海里/小时 print(f"漂移 {eps_deg_h} 度/小时，约合 {drift_m_h:.1f} 米/小时") print(f"也就是大约 {drift_nm_h:.2f} 海里/小时")

这段代码做的是一个量级估算，不是严格推导：把陀螺漂移直接当成平台倾角的变化率，再乘上地球半径换算成地面上的距离。参数只有两个，一个是地球半径，一个是陀螺漂移；改掉eps_deg_h就能看不同器件等级对应的差距。跑出来的结果是，0.01度每小时的漂移大约对应每小时一千多米、也就是零点几海里的位置发散。工程上常说的“0.01度每小时量级对应一海里每小时量级”，就是这么来的。

反过来说，如果要求导航一小时的位置误差控制在几百米以内，陀螺的等效漂移就得压到0.001度每小时这个量级。这就是为什么惯性级器件贵得离谱——它不是靠堆料堆出来的，是靠材料、工艺、温控、标定一整套东西把误差一点点抠下去的。理解了这个数量级关系，再看资料里那些“惯性级陀螺必须满足哪些要求”的问答题，就不再是干巴巴的条目，而是一串被精度指标倒逼出来的硬约束。

3. 地球模型与姿态表示：惯导为什么非得“挑一个地球”

惯导算的是相对地球的位置，可地球本身既不是标准球，也不是静止的。它的形状要用模型近似，它的自转要在方程里体现，它的重力方向还决定了“水平面”到底朝哪。所以惯导从第一步起就必须回答一个问题：我用哪个地球？这个选择不是学术洁癖，它直接决定了方程长什么样、误差怎么传播、在高纬度还能不能正常工作。

3.1 球形、椭球，还有好几种“垂线”和“纬度”

最粗糙的模型是把地球当成一个圆球，半径取平均值。这个模型在短时间、低精度场合够用，方程也简单，但它的重力方向处处指向球心，跟真实情况差得比较远。再精细一点是旋转椭球：赤道半径大、极轴半径小，用一个扁率描述这种差异。再往上还有大地水准面和重力场模型，那是测绘和地球物理层面的事情了。

跟模型绑在一起的是“垂线”和“纬度”这两个词。地心垂线是从地心指向地面点的方向，简单但不符合物理；大地垂线是椭球面在该点的法线方向；而真实的重力方向（铅垂线）又和法线有一个很小的夹角，这个夹角叫垂线偏差。纬度也相应地有好几种：地心纬度是地心矢量和赤道面的夹角，大地纬度是椭球法线和赤道面的夹角，天文纬度则由重力方向定义。三个纬度彼此都不完全相等。

惯导用的是哪一套？通常是参考椭球加大地纬度，配合椭球法线方向定义当地水平面，重力则用正常重力公式计算。原因很实在：惯导平台要对准“当地水平”，而水平的物理定义就是重力方向的垂直面；同时导航解算要在全球范围内保持一致性，就得用一个公认的、可计算的椭球模型。重力加速度和引力加速度的关系也要说清楚：引力是地球质量产生的，重力是引力加上地球自转带来的离心惯性力之后的合力，两者方向都不一样，差值就是那个著名的“重力偏离子午面”现象。

3.2 坐标变换矩阵：一次转弯就是一次乘法

惯导里所有的姿态信息，最终都要落到坐标变换矩阵上。它的定义很朴素：两个坐标系各坐标轴之间夹角的余弦，排成三行三列，就是一个方向余弦阵。物理含义是“把一个坐标系里的矢量，换算到另一个坐标系里”。载体转了个弯，本质上就是载体坐标系相对导航坐标系多转了一下，用矩阵乘一下就能表达。

求取方法有好几条路。第一条是按欧拉角拆成三次基本旋转，每次旋转对应一个初等矩阵，三个乘起来就是总变换阵。第二条是用四元数递推，避免三角函数运算。第三条是直接构造，比如已知两个不共线的参考矢量在两个坐标系下的表示，就能反解出变换阵，初始对准里的解析粗对准走的就是这条路。

import numpy as np def dcm_from_euler(yaw, pitch, roll): """按 Z-Y-X 顺序生成方向余弦阵，角度单位均为弧度。 yaw 绕 Z 轴，pitch 绕 Y 轴，roll 绕 X 轴。""" cy, sy = np.cos(yaw), np.sin(yaw) cp, sp = np.cos(pitch), np.sin(pitch) cr, sr = np.cos(roll), np.sin(roll) Rz = np.array([[cy, -sy, 0.0], [sy, cy, 0.0], [0.0, 0.0, 1.0]]) Ry = np.array([[cp, 0.0, sp], [0.0, 1.0, 0.0], [-sp, 0.0, cp]]) Rx = np.array([[1.0, 0.0, 0.0], [0.0, cr, -sr], [0.0, sr, cr]]) return Rz @ Ry @ Rx # 顺序一换，结果就完全不同 print(np.round(dcm_from_euler(0.10, 0.05, -0.02), 4))

这段代码演示的是最常用的三次旋转连乘。参数含义很直白：三个欧拉角，分别对应偏航、俯仰、横滚；@是矩阵乘法。需要特别注意的是旋转顺序，Z-Y-X 和 X-Y-Z 得到的结果完全不一样，这是初学者最容易翻车的地方，做题时一定要先看清题目约定的顺序。另外，小角度情况下这个矩阵可以近似成“单位阵加上一个反对称阵”，也就是 C ≈ I + [φ×]，这个近似是后面误差方程和卡尔曼滤波建模的起点，资料里“小角度转角求 C”那道题考的就是它。

方向余弦阵的微分方程也是必考项。思路是：载体在转，变换阵也在变，变换阵的变化率等于变换阵本身乘上一个由角速度构成的反对称矩阵。写成 Ċ = C·[ω×]，其中 [ω×] 是角速度矢量的反对称形式。这个方程把“几何姿态”和“角速度测量”连了起来，是姿态解算的核心式子。

3.3 四元数：四个数管住三个角

方向余弦阵有九个元素，实际上只有三个自由度，九个元素之间还带着六个约束，算起来冗余、递推久了还会失去正交性。四元数就是为解决这个问题出现的：用四个数描述姿态，一个实部、三个虚部，满足单位化约束，正好对应三个自由度。

它的几何意义也不难懂：绕某个单位轴 n 转一个角度 θ，对应四元数 q = cos(θ/2) + sin(θ/2)·n。注意那个二分之一，这是四元数最反直觉的地方——转180度对应的是实部为零，转360度对应的是实部为负一，得转720度才回到原点。描述形式上，四元数可以写成矢量式、三角式、复数式或者矩阵式，考试里经常要求在不同形式之间转换。

四元数和姿态阵的关系是重点：给定单位四元数，可以直接写出对应的方向余弦阵，形式是 C = (q0² - |q|²)I + 2qqᵀ + 2q0[q×]。这个式子在资料里出现频率很高，因为它把“四个数的递推”和“九宫格的矩阵”接上了。实际解算时，用四元数做递推更新，需要输出姿态阵时再转一次，既避免了三角函数，也不会丢正交性，代价是每步都要重新归一化，否则数值误差会让它慢慢跑偏。

四元数的微分方程同样简洁：q̇ = 0.5·q⊗ω，⊗ 表示四元数乘法。把它和方向余弦阵的微分方程放在一起看，会发现两者描述的是同一件事，只是一个用矩阵语言、一个用四元数语言。

4. 舒勒摆与舒勒回路：惯导的“不倒翁”为什么能稳

惯导有个天然矛盾：它靠加速度计测加速度，可加速度计分不清“载体在加速”和“平台歪了一点导致重力漏进来”。平台只要有一丝倾斜，重力就会在水平方向投下一个分量，这个分量被当成加速度积分两次，位置就飘了。舒勒摆和舒勒回路就是解决这个矛盾的钥匙，也是这门课里最容易被问“相同点和不同点”的地方。

4.1 舒勒摆：一个摆长等于地球半径的摆

先看一个纯力学现象。普通单摆的周期由摆长和重力决定，摆长越长周期越大。如果把摆长取成地球半径，算出来的周期大约是84.4分钟。这个特殊周期的摆有个奇妙性质：当它的悬挂点沿着地球表面平移时，摆锤不会因为平移而产生附加摆动，它会始终指向地心方向。物理直觉是，摆锤的自由下落轨迹刚好和地球表面的弯曲程度匹配上了，所以基座怎么平移，摆都“感觉不到”。

这个性质正是惯导梦寐以求的：载体在水平方向加速、减速、转弯，平台都不应该被带偏。于是有了舒勒回路——在惯导的水平修正回路里，把回路的振荡频率调到跟舒勒摆一样，也就是让平台的自然振荡周期等于84.4分钟。这样一来，载体的水平加速度对平台姿态的干扰就被“调谐”掉了，平台始终跟踪当地水平面。

两者的相同点很清楚：振荡周期一样，都是84.4分钟；目的也一样，都是让系统对水平加速度不敏感，保持对当地水平面的跟踪。不同点更值得说：舒勒摆是一个真实的物理摆，有摆锤、有悬点、有实际长度；舒勒回路是控制系统里的一种设计，惯导里根本没有那个摆，它是靠加速度计、陀螺和反馈回路“造”出来的等效特性。舒勒摆只有一根摆轴，只能管一个方向的水平；舒勒回路则在惯导的两个水平轴上同时实现。还有一点，舒勒摆是被动器件，特性由物理尺寸决定；舒勒回路是主动回路，增益可以调、可以切，这也埋下了后面“对准时为什么要改回路”的伏笔。

4.2 惯导里怎么“造”出舒勒振荡

实现方式是一套负反馈。假设平台因为某种原因出现了微小的水平失准角，加速度计就会测到重力在这个方向上的投影分量；把这个分量放大后送进陀螺的力矩器，让陀螺进动，平台跟着往回转，失准角就被拉回来了。整个回路的运动方程可以写成 δθ̈ + (g/R)·δθ = 干扰项 的形式，特征频率是 ω = √(g/R)，对应的周期就是那个84.4分钟。

import math R = 6371000.0 # 地球平均半径，m g = 9.80665 # 重力加速度，m/s^2 omega_s = math.sqrt(g / R) # 舒勒角频率，rad/s T_s = 2 * math.pi / omega_s # 舒勒周期，s print(f"舒勒角频率 {omega_s:.6f} rad/s") print(f"舒勒周期 {T_s:.1f} 秒，约 {T_s/60:.1f} 分钟")

代码里的两个参数分别取地球半径和标准重力，算出来的周期在五千秒出头，折合八十多分钟，跟理论值对得上。改动g或R会看到周期变化很小，说明这个周期对地理位置并不敏感，这也是它能作为通用设计依据的原因。需要说明的是，这是理想化模型，真实系统里还有阻尼、器件误差和各种交叉耦合项。

这里就必须接上初始对准里的“内反馈回路”了。舒勒回路的特点是无阻尼等幅振荡，一旦被激励起来，它能一直荡下去，收敛极慢。对准阶段等不起，所以要人为引入内反馈，把等幅振荡改成频率更高、衰减更快的减幅振荡，让失准角迅速收敛。对准结束之后，这些内反馈必须切断，原因很直接：内反馈破坏了舒勒条件，带着它进入导航状态，载体一加速平台就会被带偏，误差反而更大。这就是资料里“对准结束后应怎样处理这些内反馈回路、为什么”的标准答案思路。

罗经项则是方位对准的关键。平台存在方位失准角时，地球自转的北向分量会在东向产生一个等效的陀螺输入，这个输入通过水平回路耦合出东向的失准角变化，表现出来就像是罗盘在找北。利用这个效应，可以从水平失准角的变化里反推出方位误差，这就是罗经法对准。方位对准精度最终受限于等效东向陀螺漂移，而不是水平加速度计，这一点经常被混淆。

5. 常见误区：这几个概念最容易混

这门课的概念密度很高，很多名词长得像、听着像，实际是不同层次的东西。下面这几组是复习时翻车率最高的，搞清楚了，一大半选择题和简答题就不用死记。

5.1 平台式与捷联式：一个是实物，一个是算法

最容易混的是这两种系统。平台式惯导用机电控制的方法，真的搭出一个物理平台，让平台在空间里保持稳定，把导航坐标系“实体化”；捷联式惯导把陀螺和加速度计直接固连在载体上，跟着载体一起翻滚，所谓“数学平台”是算出来的，存在于计算机里。

为什么容易混？因为两者的功能描述几乎一模一样：都是给载体提供姿态和位置，都用陀螺和加速度计，方程也高度相似。区分的关键看“平台在哪”：能摸得着、会转动的实体台体，就是平台式；只有一组固连的传感器加一堆矩阵运算，就是捷联式。由此派生出的差别也很自然：平台式计算量小、对计算机要求低，但结构复杂、体积大、成本高；捷联式结构简单、可靠性高、成本低，但算法复杂，对器件动态范围和计算能力要求高得多。资料里那道“按平台实现方式分类并分别说明”的题，答的就是这一层。

5.2 哥氏定理、比力方程与惯导基本方程：三层不是三个

这三个经常被当成并列的三个知识点来背，其实是层层递进的关系。哥氏定理解决的是“在旋转坐标系里怎么求导”这个数学问题：一个矢量在惯性系里的变化率，等于它在旋转系里的变化率，加上旋转系自身转动带来的那部分。它是工具，不是物理结论。

比力方程是在哥氏定理基础上，把加速度计的测量值和载体的真实加速度联系起来：加速度计测到的比力，等于载体相对地球的加速度，加上哥氏项和向心项，再减掉重力。它回答的是“器件读数和运动之间什么关系”。

惯导基本方程则再往前一步，把比力方程整理成“速度的变化率等于什么”的形式，右端是比力、哥氏项、重力项的组合。它回答的是“给定器件输出，怎么算出速度”。所以证明思路也很固定：从惯性系下的牛顿第二定律出发，用哥氏定理把求导换到地球坐标系，再把比力和重力代进去，一步步整理。记住这个链条，比孤立地背三个公式可靠得多。

5.3 指北方位与游移方位：一个指北，一个放任

指北方位系统让平台始终跟踪地理坐标系，方位轴一直指向北。好处是姿态角直接可读、航向一目了然，导航计算也简单；坏处是在高纬度地区，经线迅速收敛，平台的方位角变化率会急剧增大，到了极点附近根本转不过来，所以它没法全球使用。

游移方位系统换了个思路：平台只跟踪当地水平面，方位方向不强行指北，让它自由“游移”，方位角改由计算机算出来。这样就不存在高纬度方位角变化率发散的问题，全球都能用，代价是多了一层方位角计算，而且航向不能直接从平台读出。为什么容易混？因为两者都叫“当地水平系统”，差别只在方位轴是不是被约束。区分口诀可以记成：指北系统是“平台指北、算法省事、极区犯难”，游移方位是“平台自由、算法补位、全球能跑”。

5.4 粗对准与精对准：一个是几何，一个是滤波

初始对准分两步，很多人以为只是精度不同。粗对准靠的是两个自然参考量——重力矢量和地球自转角速度矢量，用它们在不同坐标系下的观测值直接解算出一个粗略的姿态矩阵，本质是几何解析，速度快，精度有限。

精对准是在粗对准的基础上，处理惯性器件的输出信息，精确修正真实导航坐标系和计算导航坐标系之间的失准角，让它们趋于零，从而得到精确的捷联矩阵。它本质是一个估计问题，常用卡尔曼滤波或者罗经法慢慢收敛，耗时更长但精度高得多。

两者的本质其实是一样的：都是把舒勒等幅振荡回路改造成频率更高、衰减更快的减幅振荡，让误差快速收敛。区别在于实现形式：平台式惯导里有实际的对准回路，修正信息和其他误差项一起加到陀螺力矩器上，物理上把平台拧正；捷联式惯导里没有实际回路，只有对准计算程序，整个过程靠导航计算机算出来。这个“物理修正”和“数学修正”的对照，是简答题的加分点。

5.5 方向余弦阵与四元数：两套语言，一件事

最后一个常见混淆是把两者当成两种不同的姿态。其实它们描述的是同一个姿态，只是表示方式不同。方向余弦阵直观、便于坐标变换，但有九个元素、存在冗余，长时间递推容易失去正交性；四元数紧凑、无奇异、递推计算量小，但物理直观性差，而且必须定期归一化。

什么时候用哪个？需要做矢量变换、写误差方程、给外行看的时候，用方向余弦阵；需要高频递推、实时解算的时候，用四元数。很多实际系统是两个都用：内部用四元数递推，输出时转成矩阵。理解了这一层，就不会再纠结“到底该学哪个”这种问题。

6. 什么时候用、什么时候别用：从考卷走到工程边界

把概念搞懂之后，最值得问的一个问题是：这东西到底什么时候该用。惯性导航最大的优势是自主和隐蔽——它不向外辐射任何东西，也不依赖外部信号，水下、地下、强干扰环境里照样工作。它的劣势同样明显：误差随时间发散，精度再高的器件也扛不住长时间独立导航。所以工程上的判断标准从来不是“惯导好不好”，而是“这段时间里，我能不能接受这个误差量级”。

这张表想说明的是一件很朴素的事：惯导的价值不在于“单独能撑多久”，而在于“在多大时间窗内误差还可控”。时间窗的长短，由器件等级和导航时长共同决定。同样是惯导，器件差一个数量级，可用时间窗可能差出好几倍。

举个具体例子。某水下航行器要完成一段数小时的自主航行，中途不可能浮出水面校正。如果只用一套中等精度的惯导，位置误差会随着时间累积到无法接受，返航时可能连预定回收点都找不到。这时常见的做法是惯导加计程仪或者地形匹配做组合，用外部观测把惯导的发散“拉住”，惯导负责在两次观测之间提供高频、平滑的姿态和速度。这种组合里，惯导不是被替代，而是被约束——它的短期精度高、输出连续，正好补上外部观测稀疏的短板。

反过来，什么时候该果断放弃纯惯导方案？当任务时间远超器件精度支撑的时间窗，而且中途没有任何校正机会时，再高端的惯导也只是把发散推迟一点。这时候该考虑的是换方案，而不是加钱买更贵的器件。另一个要避开的坑是拿消费级器件去做导航级的事：MEMS陀螺在手机里做屏幕旋转检测没问题，但它的零偏稳定性距离导航级差了好几个数量级，硬上只会得到一个看起来很精致的错误答案。

做实操题的时候还有一个高频踩坑点：把舒勒回路的无阻尼特性当成优点一路用到底。它在导航阶段确实是优点，但在对准阶段就是灾难，收敛慢到让人怀疑人生。所以内反馈该加的时候加、该切的时候必须切，这个切换时机搞错，后面的误差分析全盘皆输。我第一次做这类题时就栽在这儿，把内反馈一直留着，算出来的稳态误差怎么都对不上，后来才发现是自己把“对准态”和“导航态”混成了一个状态。

从那以后，我每次碰这类题都会先在草稿纸上画一条时间轴：对准阶段用什么回路、导航阶段用什么回路、切换点在哪、切换后哪些量要重新初始化。这条轴画清楚，后面的方程才有地方落。希望帮到你。

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