4. 传感器误差特性分析
在气压高度与垂直速度融合中，融合算法能否给出可信结果，首先取决于对两路传感器误差特性的认识。气压高度计提供的是绝对高度参考，但它的误差往往表现为慢变偏差、温度相关漂移和动态滞后；惯性器件（加速度计、陀螺）提供的是高频运动信息，但误差以零偏、随机游走和尺度因子误差为主。若把两类误差混为一谈，滤波器就会把本应被抑制的慢变误差当成真实运动，或把真实机动当成传感器漂移而错误修正。
一、气压高度计的误差构成
气压高度计通过测量静压，再按标准大气模型反算高度。其误差可拆成四类：
- 噪声：由压力传感器电噪声、ADC量化、气流扰动和振动引起，表现为高频随机波动。典型MEMS气压计在1 Hz带宽下高度噪声可达0.1～0.5 m RMS，若不做滤波，直接差分求垂直速度会放大成数米每秒的虚假速度。
- 偏差：包括安装位置静压误差、当地气压基准与标准大气不符、以及传感器自身零点偏移。偏差在短时间内近似常值，但会随飞行阶段和外界条件缓慢变化。
- 滞后：压力通过导管、静压孔进入传感器存在气动与机械时间常数，导致高度读数滞后于真实高度变化。在快速爬升或俯冲时，滞后会直接表现为高度误差和垂直速度相位延迟。
- 温度漂移：压力敏感元件、信号调理电路和参考电压均随温度变化，形成与温度相关的零点漂移和灵敏度漂移。未补偿时，温度每变化10 ℃，高度偏差可能达到数米。
这四类误差在频域上分布不同：噪声在高频，偏差和温度漂移在极低频，滞后则在中频段引入相位损失。融合时通常用低通滤波抑制噪声，用外部基准或GPS高度修正慢变偏差，用温度补偿模型减小漂移，而滞后则需要在动态建模中显式考虑或通过互补滤波补偿。
二、惯性器件的误差构成
惯性器件包括加速度计和陀螺。在垂直速度融合中，加速度计直接测量比力，经姿态投影和重力补偿后可得到垂直加速度，再积分得到垂直速度。其误差主要有：
- 零偏：输入为零时输出不为零的常值或慢变成分。加速度计零偏经一次积分变成速度误差，经二次积分变成位置误差，是垂直速度发散的主要原因。典型消费级MEMS加速度计零偏约0.01～0.1 m/s²，若不加修正，10 s积分可产生0.1～1 m/s的速度误差。
- 随机游走：零偏本身随时间随机变化，其积分表现为角度或速度的随机游走。加速度计的速度随机游走系数常用 m/s/√h 表示，决定积分误差随时间的增长速率。
- 尺度因子误差：实际输出与理想输入之比偏离1，表现为比例误差。例如尺度因子误差0.1%，在1 g输入下产生约0.01 m/s²的等效零偏；在机动较大时，尺度因子误差与真实加速度成正比，难以通过零速修正完全消除。
此外还有安装误差、非正交误差和振动整流误差，但在垂直速度融合中，零偏、随机游走和尺度因子是最需要建模和补偿的三项。
三、误差在融合中的传播与观察
把两类传感器放在同一时间轴上观察，可以更直观地理解融合的必要性。下图给出气压高度计与惯性器件误差在频域和时域上的对应关系，以及它们对高度、垂直速度估计的影响路径。
从图中可以看出，气压高度计的误差集中在低频和极低频，惯性器件的误差则在高频积分中迅速累积。互补融合的基本思路是：用气压高度计的低频信息约束惯性积分，用惯性器件的高频信息弥补气压高度计的噪声和滞后。但前提是，必须对两类误差分别建模，而不是简单地把两路数据加权平均。
四、误差补偿的工程做法
在实际系统中，误差补偿通常分三步完成。第一步是静态标定：在恒温条件下采集加速度计和气压计的多组输出，拟合零偏、尺度因子和温度系数。例如，将加速度计置于六面体上，每个面采集30 s数据，取均值作为该轴在该姿态下的输出，再通过最小二乘解出零偏和尺度因子。气压计则放入温箱，在-20 ℃、0 ℃、25 ℃、40 ℃、60 ℃各保温20 min，记录高度输出与温度的关系，建立温度补偿多项式。
第二步是动态补偿：对气压高度计设计低通滤波器，截止频率通常取0.5～2 Hz，以抑制高频噪声，同时尽量保留爬升率信息。对惯性器件，则通过零速修正或外部基准修正零偏。例如，在垂直速度融合中，当检测到飞行器处于悬停或匀速平飞时，认为垂直加速度真值为零，此时加速度计输出即为零偏估计，可用一阶低通缓慢更新零偏。
第三步是融合中的误差状态建模：在卡尔曼滤波器中，将气压高度计的偏差和惯性器件的零偏作为状态量估计。典型状态向量可写为：
x = [h, v, b_a, b_p]^T
其中：
h —— 垂直高度
v —— 垂直速度
b_a —— 加速度计零偏
b_p —— 气压高度计偏差
状态方程：
h(k+1) = h(k) + v(k)·T + 0.5·(a_m(k) - b_a(k))·T²
v(k+1) = v(k) + (a_m(k) - b_a(k))·T
b_a(k+1) = b_a(k) + w_a
b_p(k+1) = b_p(k) + w_p
观测方程：
z_p(k) = h(k) + b_p(k) + v_p
z_a(k) = a_m(k) - b_a(k) + v_a其中T为采样周期，a_m为加速度计测量值，z_p为气压高度观测，z_a为加速度观测，w_a、w_p为过程噪声，v_p、v_a为观测噪声。通过调节过程噪声和观测噪声的协方差，滤波器会自动在气压高度计的低频可信度和惯性器件的高频可信度之间分配权重。
五、典型参数与量级参考
| 误差项 | 典型量级 | 主要影响 | 常用补偿手段 |
|---|---|---|---|
| 气压高度计噪声 | 0.1～0.5 m RMS | 垂直速度虚假波动 | 低通滤波、卡尔曼观测噪声 |
| 气压高度计偏差 | 数米至数十米 | 高度绝对误差 | 外部基准修正、状态估计 |
| 气压高度计滞后 | 0.5～3 s 时间常数 | 动态高度与速度相位延迟 | 动态建模、互补滤波 |
| 气压高度计温度漂移 | 每10 ℃数米 | 慢变高度偏差 | 温度补偿多项式 |
| 加速度计零偏 | 0.01～0.1 m/s² | 速度积分发散 | 零速修正、卡尔曼估计 |
| 加速度计随机游走 | 0.001～0.01 m/s/√h | 积分误差随时间增长 | 过程噪声建模 |
| 加速度计尺度因子误差 | 0.05%～0.5% | 机动时比例误差 | 静态标定、在线估计 |
需要强调的是，表中数值属于典型量级参考，实际系统会因传感器型号、安装方式、飞行环境和标定质量而有明显差异。在工程实践中，应优先通过静态标定和温度试验获得本系统真实参数，再据此设置滤波器噪声矩阵，而不是直接套用通用数值。
总结来看，气压高度计的误差以噪声、偏差、滞后和温度漂移为主，惯性器件的误差以零偏、随机游走和尺度因子为主。融合前必须分别建模，融合中通过状态估计和噪声调节实现互补，融合后通过悬停漂移、爬升相位差和高度残差等指标判断误差是否被有效抑制。只有把误差特性分析清楚，后续的融合算法才有可靠的输入基础。