传感器与检测技术 / 系统课时

用陀螺仪测量角速度

用陀螺仪测量角速度

陀螺仪直接给出的不是角度,而是绕各轴旋转的角速度。要把它用于姿态估计,需要同时理解 MEMS 陀螺仪如何把旋转转成电信号,以及零偏、噪声、量程和积分为什么会让角度逐渐漂移。

学习目标

  • 说明 MEMS 陀螺仪利用科里奥利效应感知角速度的基本过程
  • 根据三轴角速度理解量程、零偏与积分漂移对测量结果的影响
  • 掌握从角速度积分得到角度时必须处理的校准与采样问题

从旋转到科里奥利位移

MEMS 陀螺仪内部通常包含一个被驱动做周期运动的微小质量块。设备没有旋转时,质量块主要沿驱动方向振动;当器件绕某一敏感轴旋转时,运动质量会受到科里奥利力,产生与驱动方向垂直的微小位移。

科里奥利力可以写成:

Fc=2m(v×ω)\mathbf{F}_c=2m(\mathbf{v}\times\boldsymbol{\omega})

其中 mm 是质量块质量,v\mathbf{v} 是内部振动速度,ω\boldsymbol{\omega} 是外部角速度。由于结构参数和驱动振动受芯片控制,检测垂直方向的位移或电容变化,就可以反推出对应轴的角速度。

MEMS陀螺仪从驱动振动到科里奥利检测的工作关系

三轴陀螺仪把三个近似正交的敏感结构组合起来,因此常输出 ωx\omega_x、ωy\omega_y、ωz\omega_z。正负号取决于芯片定义的坐标系和右手规则,接入姿态算法前必须先确认数据手册中的轴向与安装方向。

看懂角速度输出与量程

角速度常用 °/s 或 rad/s 表示。例如某轴输出 90 ∘/s90\ ^\circ/s,表示设备当前以每秒 90° 的速度绕该轴旋转,并不代表已经旋转了 90°。

数字陀螺仪通常提供多个满量程,例如 ±125、±250、±500、±1000 或 ±2000 °/s。量程越小,同样位数下每个数字码对应的角速度通常越细;量程越大,则更不容易在高速旋转时饱和。

选择量程时应先估计真实运动的最大角速度,并保留一定瞬态余量。调试阶段尤其要检查原始数据是否经常贴近正负满量程,这比只观察最终姿态角更容易发现饱和问题。

零偏为什么会变成积分漂移

静止时,理想陀螺仪三个轴都应输出 0,但真实器件通常存在零偏。假设某轴静止时仍有 0.5 ∘/s0.5\ ^\circ/s 的偏差,如果直接积分,那么 60 秒后仅这一项就会造成约 30° 的角度误差。

离散采样下,最简单的积分写成:

θk=θk−1+ωkΔt\theta_k=\theta_{k-1}+\omega_k\Delta t

若测量值实际为 ωk+b+nk\omega_k+b+n_k,其中 bb 为零偏、nkn_k 为噪声,那么固定零偏会不断累积成随时间增长的角度误差。随机噪声也会经过积分形成随机游走,因此单纯依靠陀螺仪无法长期保持绝对姿态稳定。

陀螺仪零偏经积分形成角度漂移

实际系统通常会在已知静止阶段估计零偏,并在计算角速度前扣除:

ωcorrected=ωmeasured−b\omega_{corrected}=\omega_{measured}-b

但零偏还会随温度、供电、机械应力和时间变化,因此一次开机校准并不能保证整个运行周期都没有漂移。要求长期姿态稳定时,通常还要结合加速度计、磁力计或其他外部参考进行融合校正。

积分时还要处理采样周期

把角速度积分成角度时,采样周期必须来自真实时间间隔,而不是想当然地写死一个值。假设程序以 100 Hz 为目标运行,但偶尔因调度或总线读取延迟变成 8 ms 或 13 ms,如果仍固定使用 10 ms,积分误差会持续累积。

对于相邻两个采样点,更稳妥的基础方法是梯形积分:

θk=θk−1+ωk−1+ωk2Δt\theta_k=\theta_{k-1}+\frac{\omega_{k-1}+\omega_k}{2}\Delta t

它利用前后两个角速度估计区间平均值,在角速度变化较平滑时通常比单点矩形积分更准确。不过积分公式本身无法消除零偏,校准错误仍会被持续累积。

为姿态估计选择合适的测量策略

陀螺仪的优势是短时间内响应快,不依赖重力方向,也不会因为瞬时线加速度而直接把姿态判断错;它的核心弱点则是缺少稳定的绝对参考,任何残余零偏都会被积分放大。

因此实际使用时,应把陀螺仪理解为“短时旋转变化”的高质量信息源。先确认坐标轴和单位,再选择不会频繁饱和的量程,通过静止阶段估计零偏,并用真实采样周期进行积分。需要长时间可靠姿态时,再通过其他传感器提供绝对方向约束,才能阻止积分误差无限增长。

按自己的节奏,确认真正理解。

目录与阅读设置

阅读设置

17

记录一个想法

用陀螺仪测量角速度

0 / 10000 · 笔记保存到账号。未提交的修改会在关闭、离开或刷新后丢失。

登录哪都通