序:很多工程上"搞不定"的问题,本质是原理不清晰。
一、先建立一个具体的工程困境
假设只在载体上装一枚 MEMS 陀螺仪,要求测出真北方向。难点在于量级:
- 地球自转角速率:ωie≈15∘/h≈0.0042∘/s\omega_{ie} \approx 15^\circ/h \approx 0.0042^\circ/sωie≈15∘/h≈0.0042∘/s
- 消费级/工业级 MEMS 陀螺零偏:0.1∼10∘/s0.1 \sim 10^\circ/s0.1∼10∘/s,噪声更大
也就是说,待测信号比器件噪声低 1~2 个数量级。所以传统高精度捷联惯导(SINS)的"双矢量定姿"静基座对准,在 MEMS 上直接失效。工程上通常退而求其次用磁罗经或卫星天线提供航向,代价是怕铁磁干扰 / 怕遮挡多径。城市峡谷、地下、钢铁环境,二者都不稳。
核心命题:能不能纯靠 MEMS 惯性器件,在晃动基座上自对准出航向? 答案是能,靠两件武器:旋转调制 与 惯性空间重力矢量对准。
二、为什么晃动基座下传统寻北会失效:从信号模型说起
先给信号建模。陀螺测得的角速度可写为:
ωibb=ωieb+ωswayb+b+n\boldsymbol{\omega}_{ib}^b = \boldsymbol{\omega}_{ie}^b + \boldsymbol{\omega}_{sway}^b + \boldsymbol{b} + \boldsymbol{n}ωibb=ωieb+ωswayb+b+n
其中 ωieb\boldsymbol{\omega}_{ie}^bωieb 为地球自转在载体系的分量(待求),ωswayb\boldsymbol{\omega}_{sway}^bωswayb 为载体晃动角运动,b\boldsymbol{b}b 为常值零偏,n\boldsymbol{n}n 为随机噪声。
- 静基座:ωswayb=0\boldsymbol{\omega}_{sway}^b = 0ωswayb=0。常值零偏 b\boldsymbol{b}b 可用多位置法(如四位置转位)通过差分抵消,再反解航向——因为 b\boldsymbol{b}b 在多个位置的投影关系已知。
- 晃动基座:ωswayb≠0\boldsymbol{\omega}_{sway}^b \neq 0ωswayb=0,且通常远大于 ωieb\boldsymbol{\omega}_{ie}^bωieb,还是时变的。此时"测量值"里载体运动分量淹没了一切,差分法根本无法分离 b\boldsymbol{b}b,传统算法直接失效。
一句话:晃动把"信号"压进"干扰"里,而干扰本身不可先验补偿。
三、第一件武器:旋转调制——把常值误差"调制"成可滤掉的周期信号
3.1 核心思想
既然 b\boldsymbol{b}b 消不掉,那就让它"动起来"——对常值误差做周期调制,再用滤波/平均把它干掉。
让 IMU 绕轴以角速度 ωr\boldsymbol{\omega}_rωr 连续旋转(或往复旋转),在导航坐标系下观察,陀螺常值零偏被旋转矩阵调制:
bn(t)=Rsn(t) bs=R(t) bs\boldsymbol{b}^n(t) = \boldsymbol{R}_s^n(t)\, \boldsymbol{b}^s = \boldsymbol{R}(t)\, \boldsymbol{b}^sbn(t)=Rsn(t)bs=R(t)bs
其中 R(t)\boldsymbol{R}(t)R(t) 为旋转产生的时变方向余弦阵。连续旋转时,bn(t)\boldsymbol{b}^n(t)bn(t) 变成以旋转频率为基频的周期信号:
∫0Tbn(t) dt →T→∞ 0\int_0^T \boldsymbol{b}^n(t)\, dt \;\xrightarrow{T \to \infty}\; \mathbf{0}∫0Tbn(t)dtT→∞0
周期分量在积分/滤波后被平均抵消,而地球自转角速率分量(在导航系中近似恒定)被保留。这就是旋转调制的误差抑制本质。
3.2 工程上必须知道的两个边界
- 只有"常值/慢变"误差能被调制:随机游走、高频噪声调制不掉——这直接决定器件选型(低 ARW 比低零偏更重要)。
- 角度传感器精度是隐形瓶颈:旋转角度测量误差会直接进入调制残余,角度编码器精度不够,调制效果大打折扣。
四、第二件武器:惯性空间重力矢量对准——晃动下的姿态解算
旋转调制能消常值零偏,但消不掉载体晃动引入的角运动。第二层武器登场:把测量变换到惯性空间去对准。
4.1 原理
- 陀螺输出 ωb\boldsymbol{\omega}^bωb 积分得到姿态,用于把加速度计输出变换到惯性系:
fi=Cbi fb\boldsymbol{f}^i = \boldsymbol{C}_b^i\, \boldsymbol{f}^bfi=Cbifb
- 在惯性坐标系中,重力矢量 gi(t)\boldsymbol{g}^i(t)gi(t) 的理论变化规律是已知的(由地球自转决定,方向以 24h 为周期缓慢旋转)。
- 将"测量得到的重力矢量轨迹"与"理论轨迹"做姿态匹配(最小化二者误差),即可同时解算出姿态和航向。
4.2 为什么它对晃动鲁棒
载体晃动是高频运动,而重力矢量在惯性系中是慢变的。经过惯性系积分/平滑,高频晃动分量被自然抑制,只剩低频重力信息参与对准。这就是 ISGBA 抗晃动的本质——把"难处理的时变干扰"通过坐标变换变成"可平滑的高频项"。
五、为什么这套组合有效:可观测性视角(第一性原理)
滤波/对准能不能收敛,取决于状态是否可观测。这是惯导系统设计最该先想清楚的问题:
- 单 IMU 静止:航向状态不可观测——信息根本进不来,任何算法都白搭;
- 引入旋转:周期性运动相当于持续激励,把原本不可观测的状态"激活";
- 定量手段:对可观测性矩阵做 SVD 分解,奇异值大小直接对应各状态的可观测度强弱。
方法论提炼:做任何惯导系统,先问"这个状态下哪些状态可观测、激励够不够",再谈算法和选型。
六、可复用的方法论总结(给做惯导/传感器/融合的工程师)
- 先问原理,再谈选型:系统不可观测时,堆器件没有意义;先做可观测性分析。
- 误差调制是 MEMS 的"免费外挂":旋转调制把常值误差从"误差"变成"可滤信号",性价比极高。
- 水平姿态是航向的地基:任何寻北/对准系统,先把水平姿态做扎实。
- 融合权重要有物理依据:Allan 方差等误差参数,比"经验调参"可靠得多。
- 坐标变换是抗干扰的利器:把"时变干扰"变换到"可平滑"的参考系,可迁移到很多多传感器融合问题。
本文全部内容基于已公开的研究成果,不涉及任何保密信息。从理论验证可行,但实际工程样机会涉及组装,标定等多种误差源,工程中遇到的难度会大于实验室验证分析。
如果你正在研究卡尔曼滤波、多传感器融合、惯导对准,欢迎评论区聊聊你的场景,互相学习交流。
368



被折叠的 条评论
为什么被折叠?



