4. 椭球模型与误差模型
在磁传感器标定中，最核心的几何直觉是：理想三轴磁传感器在均匀磁场中旋转时，其输出点应分布在一个以原点为球心的球面上。然而真实传感器受硬铁、软铁、比例因子与非正交误差影响，这个球面会被平移、拉伸、剪切，最终变成一个偏离原点的椭球。标定的本质，就是找到从椭球回到球面的逆映射。
一、核心原理：为什么是椭球而不是球
设真实磁场矢量为 B，传感器原始输出为 m。理想情况下 m = B，且 |m| 恒定。但实际链路中存在三类误差：
- 硬铁偏移 b：由永磁体、磁化铁芯等恒定磁场引起，表现为球心平移，与姿态无关。
- 软铁矩阵 A：由导磁材料改变磁场分布引起，表现为球面被拉伸、压缩和剪切，与姿态相关。
- 比例因子与非正交误差：三轴灵敏度不一致、轴间不正交，表现为各轴缩放和轴间耦合。
将三者统一，可写成如下线性模型：
m = S · N · A · B + b + n
= M · B + b + n
其中：
S 比例因子对角阵 diag(sx, sy, sz)
N 非正交误差矩阵（上三角，含轴间夹角）
A 软铁矩阵（3×3）
M = S·N·A 综合等效矩阵
b 硬铁偏移向量
n 噪声当 B 遍历半径为 R 的球面时，m 的轨迹为：
(m - b)ᵀ · (M·Mᵀ)⁻¹ · (m - b) = R²这正是椭球方程。因此，标定问题转化为：从采样点拟合椭球参数，再反解出 b 与 M，最终将 m 映射回球面。
二、方法流程：椭球拟合与参数反解
工程上通常采用最小二乘椭球拟合，将椭球方程展开为二次型：
ax² + by² + cz² + 2dxy + 2exz + 2fyz + 2gx + 2hy + 2iz = 1把每个采样点代入，构成超定方程组 D·p = 1，求解参数向量 p。随后通过矩阵分解得到：
- 椭球中心即硬铁偏移
b； - 椭球形状矩阵分解为
M·Mᵀ，通过 Cholesky 或特征值分解得到M； - 补偿时计算
B̂ = M⁻¹(m - b)，并归一化到已知R。
统一建模要点：硬铁是平移项，软铁、比例因子、非正交都是线性变换项，可合并为单一矩阵 M。这样标定只需估计 9 个矩阵参数 + 3 个偏移参数，共 12 个未知量，采样点足够即可稳定求解。
三、案例场景：无人机磁罗盘标定
某无人机磁罗盘在机载状态下采样 800 个点，原始数据呈明显椭球，中心偏移约 [42, -18, 27] μT，三轴半径差异达 15%。采用椭球拟合后得到：
b = [41.6, -17.8, 26.9] μT
M = [[1.08, 0.02, -0.01],
[0.02, 0.95, 0.03],
[-0.01, 0.03, 1.03]]
R = 48.2 μT
补偿后残差 RMS = 0.6 μT补偿后航向误差从 ±8° 降至 ±1.2°，满足导航要求。该案例说明：椭球模型能同时吸收硬铁、软铁、比例与非正交误差，是工程上最通用的统一模型。
四、误区与复盘
| 常见误区 | 后果 | 正确做法 |
|---|---|---|
| 只做硬铁偏移补偿 | 软铁误差残留，航向随姿态漂移 | 同时估计 b 与 M |
| 采样点分布不均 | 椭球拟合病态，参数不稳定 | 覆盖各姿态，避免共面采样 |
| 忽略比例因子与非正交 | 三轴半径不一致，椭球畸变 | 统一纳入 M 矩阵建模 |
| 用未标定数据评估标定 | 残差虚低，实际误差大 | 留出验证集，独立评估 RMS |
复盘提醒：椭球拟合对异常点敏感。采样前应剔除电机、扬声器等强磁干扰时段的数据，否则椭球会被“拉偏”，导致 b 与 M 估计失真。建议先做粗差剔除，再进行最小二乘拟合。
综上，椭球模型把硬铁偏移、软铁矩阵、比例因子与非正交误差统一到一个线性变换加平移的框架中。理解“球面被映射为椭球”的几何本质，就能在标定中准确反解参数，把原始磁传感器输出还原为可信的磁场矢量。