1. 课程导入
在惯性导航与姿态测量系统中,陀螺仪是感知角运动的核心器件。它不依赖外部卫星、地磁或视觉基准,而是通过测量载体相对于惯性空间的角速度,为姿态解算、航向保持、稳定控制提供最基础的输入。无论是无人机飞控、自动驾驶定位、导弹制导,还是手机屏幕旋转、云台增稳,陀螺仪的输出质量都直接决定了系统能否“知道自己朝哪里、转得多快、转了多少”。
然而,陀螺仪输出的角速度并不是理想真值。它通常可以简化为一个线性误差模型:
ω_meas = (1 + S) · ω_true + B + n
其中,ω_meas 是陀螺仪测量值,ω_true 是真实角速度,S 是尺度因子误差,B 是零偏,n 是随机噪声。零偏决定了“静止时是否误认为在转动”,尺度因子决定了“转动幅度是否被放大或缩小”。如果这两项不标定,姿态解算会随时间发散,导航结果会快速漂移。
为什么零偏与尺度因子标定如此重要
以典型的MEMS陀螺为例,零偏可能达到每小时几十度甚至上百度的等效漂移。若直接积分角速度得到角度,零偏会带来随时间线性增长的角度误差。例如,零偏为 0.1°/s,积分 60 秒就会产生 6° 的姿态误差;积分 10 分钟,误差可达 60°。对于需要长时间保持航向的应用,这是不可接受的。
尺度因子误差则常在动态场景中暴露。当载体进行快速转弯、振动或往复摆动时,尺度因子误差会使测量角速度与实际角速度不成比例。例如,真实角速度为 100°/s,尺度因子误差为 1%,测量值就会偏差 1°/s。在振动环境下,这种误差还会与零偏、非正交误差耦合,形成复杂的姿态解算偏差。
因此,标定的意义在于:在系统使用前,通过实验和计算获得零偏与尺度因子的估计值,并在后续输出中进行补偿,使陀螺仪输出尽可能逼近真实角速度。标定不是“可选项”,而是惯性器件从“能输出”到“能可用”的关键步骤。
课程目标与整体框架
本课程围绕“陀螺零偏与尺度因子标定”展开,目标是让学习者建立从误差机理、标定模型、实验设计、数据处理到结果验证的完整能力。具体包括:
- 理解零偏、尺度因子、非正交误差、随机噪声的定义与区别;
- 掌握静态标定、速率标定、多位置标定等常用方法;
- 能够设计转台实验或利用地球自转角速度进行现场标定;
- 能够使用最小二乘、递推估计等方法求解标定参数;
- 能够评估标定效果,识别温度、振动、安装误差等影响因素;
- 能够将标定结果写入系统,完成补偿与验证。
课程整体分为四个阶段:基础认知、标定方法、工程实现、验证与复盘。基础认知阶段建立误差模型和坐标系概念;标定方法阶段讲解静态、动态和组合标定流程;工程实现阶段关注数据采集、参数求解和补偿落地;验证与复盘阶段通过案例和排障,帮助学习者形成可复用的标定规范。
核心原理:从角速度到姿态的误差传播
陀螺仪标定的本质,是建立“测量输出”与“真实输入”之间的映射关系。最常用的线性模型如下:
ω_meas_x = (1 + Sx) · ω_true_x + Mxy · ω_true_y + Mxz · ω_true_z + Bx + nx
ω_meas_y = Myx · ω_true_x + (1 + Sy) · ω_true_y + Myz · ω_true_z + By + ny
ω_meas_z = Mzx · ω_true_x + Mzy · ω_true_y + (1 + Sz) · ω_true_z + Bz + nz
其中,Bx、By、Bz 为三轴零偏,Sx、Sy、Sz 为三轴尺度因子误差,Mxy 等为轴间耦合或非正交误差。实际标定时,常先忽略小量耦合,分别估计零偏和尺度因子,再逐步引入更完整的模型。
零偏的估计通常利用“静止时真实角速度为零”这一条件:在陀螺静止放置时,采集一段数据,取平均值作为零偏估计。尺度因子的估计则需要已知角速度输入,例如使用转台提供精确角速率,或利用地球自转角速度作为参考。通过比较测量值与参考值,可以求解尺度因子。
方法流程:标定的基本步骤
无论采用哪种具体方法,陀螺零偏与尺度因子标定通常遵循以下流程:
- 准备与预热:将陀螺仪安装在转台或稳定基座上,通电预热至温度稳定,避免温度漂移干扰。
- 静态零偏采集:保持陀螺静止,采集 1~5 分钟数据,计算三轴均值作为零偏初值。
- 速率/多位置激励:使用转台提供多个已知角速率,或利用多位置翻转改变重力与地球自转投影,获得不同输入条件下的测量值。
- 数据预处理:去除异常值、趋势项,必要时进行低通滤波,保留有效频段。
- 参数求解:建立线性方程组,使用最小二乘法求解零偏、尺度因子和耦合系数。
- 补偿与验证:将估计参数写入系统,重新采集数据,比较补偿前后残差,评估标定效果。
案例/场景:无人机航向漂移的标定复盘
某小型无人机在悬停时航向缓慢偏转,10 分钟偏转约 15°。排查发现,飞控中使用的陀螺零偏为出厂默认值,未进行现场标定。实际零偏约为 0.025°/s,与默认值相差 0.02°/s。重新进行静态零偏标定后,航向漂移降至 10 分钟 2° 以内。
进一步测试发现,无人机在快速偏航时航向角速度存在约 2% 的幅度偏差,原因是尺度因子未标定。使用转台在 ±50°/s、±100°/s、±200°/s 三个速率点进行标定后,动态航向精度明显改善。这个案例说明:零偏影响静态和长期性能,尺度因子影响动态和幅度性能,二者需要分别标定、联合补偿。
常见误区与复盘清单
| 误区 | 表现 | 正确做法 |
|---|---|---|
| 只标零偏,忽略尺度因子 | 静态漂移改善,动态幅度仍偏差 | 静态零偏 + 多速率尺度因子联合标定 |
| 未预热直接采集 | 零偏估计随温度变化,重复性差 | 预热至温度稳定,记录温度并做温补 |
| 用单点速率估计尺度因子 | 线性度无法评估,外推误差大 | 至少 3 个速率点,覆盖正负量程 |
| 忽略安装误差 | 轴间耦合被误认为尺度因子误差 | 多位置标定,分离零偏、尺度与耦合 |
| 标定后不验证 | 参数写入错误或符号反了未被发现 | 补偿前后残差对比,独立数据验证 |