第4章：传感器原理与应用
各位同学，今天我们来聊聊导弹制导系统的“眼睛”和“耳朵”——传感器。说实话，我入行那会儿，第一个让我头疼的就是传感器选型。你想想看，一枚导弹在天上飞，几倍音速，姿态稍微偏一度，落点可能就差出去几公里。传感器要是不可靠，后面算法再牛也白搭。
4.1 陀螺仪：角速度的测量艺术
陀螺仪这东西，说白了就是测“转得有多快”。我习惯把它分成三类：MEMS、激光和光纤。咱们一个一个说。
4.1.1 MEMS陀螺仪
MEMS陀螺仪，现在消费级产品里到处都是。它的原理是科里奥利效应——一个振动的质量块，当它旋转时会产生一个垂直于振动方向的力。测这个力的大小，就能算出角速度。
关键参数：
- 零偏稳定性：0.1°/s ~ 10°/s（消费级）
- 角度随机游走：0.1°/√h ~ 1°/√h
- 带宽：100Hz左右
我在项目中遇到过一个问题：MEMS陀螺仪对温度特别敏感。有一次做高低温测试，零度以下时零偏直接漂了5倍。嗯，这里要注意——MEMS陀螺仪必须做温度补偿，否则你飞控算出来的姿态角会越来越离谱。
避坑指南：我曾经在选型时只看数据手册的典型值，结果批量采购后发现一致性很差。后来我学乖了——一定要看最大值和最小值，尤其是零偏和噪声密度这两个参数。
4.1.2 激光陀螺仪
激光陀螺仪，这是高端货。原理是萨格纳克效应——两束激光在环形腔体内反向传播，当腔体旋转时，两束光的光程差会产生干涉条纹。数条纹就能算出角速度。
它的优点很明显：精度高、动态范围大、抗冲击。但缺点也突出：体积大、成本高、启动时间长。我记得有一次做地面测试，激光陀螺仪预热了整整20分钟才稳定下来。所以它一般用在战略导弹或大型飞行器上。
4.1.3 光纤陀螺仪
光纤陀螺仪，算是激光陀螺仪的“平民版”。原理一样是萨格纳克效应，但用光纤代替了环形腔体。光纤绕得越长，精度越高。
| 类型 | 精度等级 | 典型应用 | 成本 |
|---|---|---|---|
| MEMS | 低-中 | 战术导弹、无人机 | 低 |
| 光纤 | 中-高 | 中程导弹、舰船 | 中 |
| 激光 | 极高 | 战略导弹、航天器 | 极高 |
我个人建议：做项目时，先看精度需求。如果允许1°以内的姿态误差，MEMS就够了。如果要求0.1°以内，老老实实上光纤或激光。
4.2 加速度计：线加速度的测量
加速度计，测的是“直线加速有多快”。原理很简单——一个质量块挂在弹簧上，加速度会让质量块位移，测位移量就能算出加速度。
但实际应用中，有个坑：加速度计测的是“比力”，不是纯重力加速度。什么意思？就是它测的是物体受到的合力，包括重力。所以静止时它测的是1g，自由落体时测的是0g。这一点在姿态解算时特别重要。
注意：加速度计不能单独用来算姿态角。因为当导弹做机动飞行时，加速度计测到的值包含了运动加速度和重力加速度，你分不清哪个是哪个。必须和陀螺仪配合使用。
4.3 GPS/INS组合导航原理
GPS和INS，一个长稳好但更新慢，一个短稳差但更新快。组合起来，就是绝配。
我打个比方：GPS像个慢性子，每秒钟告诉你一次“你在哪”，但很准。INS像个急性子，每毫秒告诉你一次“你动了多少”，但会越飘越远。组合导航就是让INS在GPS两次更新之间“撑住”，等GPS来了再校准一下。
具体怎么组合？有两种方式：
- 松耦合：GPS输出位置和速度，INS输出位置和速度，两者做差后反馈修正INS。
- 紧耦合：GPS输出原始伪距和伪距率，直接和INS的预测值做差。这种方式精度更高，但计算量也大。
我在项目中用过紧耦合。说实话，调试起来挺折磨人的。有一次GPS信号被遮挡，INS的误差累积得很快，等GPS恢复时，组合滤波器差点发散。后来我加了一个信号质量检测模块，GPS信号不好时自动降低权重，这才稳定下来。
4.4 传感器数据融合：卡尔曼滤波入门
卡尔曼滤波，说白了就是“用预测+测量，算出最优估计”。我刚开始学的时候，觉得公式一堆很吓人。其实核心就五个公式：
// 预测阶段
x_pred = A * x_prev + B * u // 状态预测
P_pred = A * P_prev * A' + Q // 协方差预测
// 更新阶段
K = P_pred * H' * (H * P_pred * H' + R)^(-1) // 卡尔曼增益
x_est = x_pred + K * (z - H * x_pred) // 状态更新
P_est = (I - K * H) * P_pred // 协方差更新你看，就这五个公式。我习惯这么理解：
- 预测：根据上一时刻的状态，猜现在应该在哪
- 更新：用测量值来修正这个猜测
- 卡尔曼增益：说白了就是“信谁多一点”——信预测还是信测量
调参经验：Q和R这两个矩阵，我建议先调R。R是测量噪声协方差，你可以通过静态测试来估算。Q是过程噪声协方差，这个比较玄学，我一般先设成对角矩阵，然后根据实际效果慢慢调。记住一个原则：Q越大，滤波器越相信测量；R越大，滤波器越相信预测。
举个例子，用加速度计和陀螺仪做姿态估计：
- 陀螺仪提供角速度，用来做预测
- 加速度计提供重力方向，用来做更新
- 卡尔曼滤波把两者融合，得到稳定的姿态角
我曾经犯过一个错误：把加速度计的测量噪声设得太小，结果滤波器对机动加速度特别敏感，姿态角跟着乱跳。后来我把R调大了一些，问题就解决了。嗯，调参就是这样，有时候就是试出来的。
4.5 小结
这一章内容不少，我帮你理一下重点：
- 陀螺仪测角速度，三种类型各有优劣，选型看精度和成本
- 加速度计测比力，不能单独用，必须和陀螺仪配合
- GPS/INS组合导航，松耦合简单，紧耦合精度高
- 卡尔曼滤波就五个公式，核心是调Q和R
下一章我们讲执行机构——舵机和推力矢量控制。到时候你会看到，传感器算出来的指令，怎么变成导弹的实际动作。咱们下节课见。