目录
前言
1.1 角动量的定义
1.2 角动量的大小与方向
1.3 特殊形式
圆环绕固定轴转动
刚体绕固定轴转动
圆盘绕固定轴转动
1.4 转动惯量表示
二、力矩
2.1 力矩的定义
2.2 力矩的大小与方向
三、角动量守恒
四、科里奥利力
4.1 科里奥利的定义
4.2 科里奥利的大小和方向
五、IMU 器件工作原理
5.1 三轴加速度如何得到
5.2 三轴角速度与角位移如何得到
路径 1:陀螺仪积分
路径 2:加速度计读重力
路径 3:磁力计读地磁场
实际做法:传感器融合
5.3 信息误差排序
5.4 为什么 Z 轴(yaw)精度最差
5.5 消费级 IMU 目前最大的局限
总结
前言
在很多 IMU 相关文章中,陀螺仪的工作原理常常被一句“利用科里奥利力”一笔带过,却很少把背后的物理逻辑真正讲顺。 本文尝试从最基础的角动量、力矩和角动量守恒讲起,再引出科里奥利力的物理图像,最后连到 MEMS 加速度计、陀螺仪与磁力计在 IMU 中如何协同工作。 只要你愿意耐心读完这条链路,你会看到:IMU 并不是一个“黑盒传感器”,而是一整套基于角动量与惯性力构建的精巧工程系统,同时也会理解为什么消费级 IMU 在位移、航向精度上存在看似“天生治不好的”局限
(因为编辑器向量符合不友好,用A~表示向量A)
一、角动量
1.1 角动量的定义
在直线运动中,我们用动量来描述"物体运动的多少"。但很多运动不是平动,而是转动——陀螺旋转、地球绕太阳公转、车轮绕轴转动。
转动有自己的"惯性"和"运动量",动量无法完整描述。于是物理学家引入一个新的物理量——角动量(Angular Momentum),记作 L~。
一个质量为 m、速度为 v~ 的质点,相对于参考点 O 的角动量定义为:
其中:
- r~:从参考点 O 指向质点的位矢;
- p~:质点的动量;
- "×"是叉乘(向量积)
从定义式出发做量纲分析可得到角动量的单位:
关键点:角动量永远是"相对于某一点"而言的,离开参考点谈角动量没有意义。
1.2 角动量的大小与方向
由叉乘的定义直接得到角动量的大小:
其中 θ 是 r~ 与 p~ 之间的夹角。
理解 sinθ 的物理含义
把动量 p~ 分解为两个分量:
- 径向分量(沿 r~ 方向):只改变质点离 O 点的距离,不产生转动;
- 切向分量(垂直 r⃗):真正让质点绕 O 点转的部分,大小为 psinθ。
所以:
两个特例:
- 若 v~ 与 r~ 平行(θ=0,径直朝 O 点冲去):L=0,因为没有绕 O 的转动;
- 若 v~ 垂直 r~(θ=90∘,圆周运动):L=mvr,达到最大。
角动量是矢量,其方向由叉乘的数学定义给出,实际操作中用右手定则:
方法一:右手四指弯曲法(最直观)
- 伸出右手;
- 四指沿物体转动方向弯曲(想象你要握住转轴);
- 大拇指的指向就是角动量 L~ 的方向。
方法二:叉乘顺序法(从定义出发)
按 L~ = r~ × p~ 的顺序:
- 右手四指先指向 r~ 的方向;
- 沿小于 180∘ 的角度转向 p~ 的方向;
- 大拇指的指向即为 L~。
平面内的约定符号
当转动发生在纸面内时,约定:
逆时针转动:L~ 垂直纸面向外,指向读者,符号 ⊙(箭头尖朝向你);
顺时针转动:L~ 垂直纸面向里,符号 ⊗(箭头尾部的羽毛朝向你)。
1.3 特殊形式
圆环绕固定轴转动
一个密度均匀圆环用几根不计质量的轻质钢缆连接一圆心固定轴,圆环绕固定轴转动,问整个圆环的角动量是多少?
用微元法分析,圆环的极小一段质量为mi,角动量大小为:
整个圆环的角动量就是所有极小一段角动量的累加:
其中 r 为圆环的半径,v 是角速度,w 是线速度。
刚体绕固定轴转动
一根密度均匀的刚体绕固定轴转动时(比如说一根木棍绕某一固定轴转动),问整个刚体(木棍)的角动量是多少?
用微元法分析,距离端点距离 ri 的质量为 mi 的极小一段角动量大小为:
整体积分后得到整个刚体的角动量:
其中 m 是刚体(整个木棍)总质量,r 是刚体(整个木棍)的长度,w 是刚体(木棍)绕固定轴转动的角速度。
圆盘绕固定轴转动
一个密度均匀的圆盘绕圆心固定轴转动时,问整个圆盘的角动量是多少?
从圆环绕固定轴转动可知,圆盘的某一个半径为 r ,质量为 mi 的圆环角动量为:mi * r^2 * w
整体积分后得到整个圆盘的角动量:
其中m是圆盘总质量,r 是圆盘半径,w 是角速度。
1.4 转动惯量表示
还有一个用转动惯量表达式如下:
- I=∑mi ri^2:转动惯量
- ω:角速度。
转动惯量 I 是衡量"转动惯性"的大小(质量分布离轴越远,I 越大);各物体转动惯量如下:
二、力矩
2.1 力矩的定义
开门时,你会推离门轴远的地方,而不是贴着门轴推——同样的力,推的位置不同,效果完全不同。再比如用扳手拧螺母:扳手越长越省力;而且你必须垂直于扳手用力才有效,顺着扳手方向推拉则毫无效果。
这些经验说明:力能不能让物体转动,不仅取决于力的大小,还取决于力的作用点和方向。描述这种"力的转动效果"的物理量,就是力矩(Torque / Moment of Force),记作 τ~ 或 M~。
力对某参考点 O(支点/转轴上的点)的力矩定义为:
- r~:从参考点 O 指向力的作用点的位矢;
- F~:作用在物体上的力;
- "×"是叉乘。
由 τ=Fr 直接得到:
注意:虽然 1 N⋅m=1 J,但力矩绝不写成焦耳。因为功是力与位移的点乘(标量),力矩是位矢与力的叉乘(矢量),物理含义完全不同。约定俗成地,力矩用 N⋅m,能量用 J,以示区分。
2.2 力矩的大小与方向
由叉乘定义:
其中 θ 是 r~ 与 F~ 的夹角。
把力 F~ 分解成两部分:
- 沿 r~ 方向的分量(Fcosθ):只把物体推向/拉离支点,不产生转动;
- 垂直 r~ 的分量(Fsinθ):真正让物体绕支点转的部分。
所以:
其中 d=rsinθ 叫做力臂——它是支点 O 到力的作用线(沿力方向的延长线)的垂直距离。
两个特例:
- 力的作用线通过支点(d=0):力矩为零,比如门轴处的力推不开门;
- 力垂直于r~(d=r):力矩最大,τ=Fr,这就是为什么垂直扳手用力最有效。
力矩是矢量,方向由定义公式决定,判断方法与角动量完全一样:
- 右手四指先指向 r~ 的方向;
- 沿小于 180∘ 的角转向 F~ 的方向;
- 大拇指指向即 τ~ 的方向。
τ~ 垂直于 r~ 和 F~ 所在的平面(即转动平面)。
平面内的约定:
- 使物体逆时针转动的力矩:方向垂直纸面向外 ⊙,取正;
- 使物体顺时针转动的力矩:方向垂直纸面向里 ⊗,取负。
还可以用转动惯量表示:
其中 α 是角加速度 ,说明同样的力矩作用在转动惯量不同的物体上,角加速度不同——这就是"转动惯量大 = 难改变转动状态"。
三、角动量守恒
对 L~ = r~ × p~ 求导:
(因为 v~ 与 p~ 平行,叉乘为零。)于是得到角动量定理:
即:合外力矩等于角动量的变化率。
由此立即推出角动量守恒定律:若合外力矩不变,则角动量恒定不变。
四、科里奥利力
4.1 科里奥利的定义
想象你站在一个旋转的圆盘(游乐场转盘)中心,想让手里的球笔直地扔向站在边缘的朋友。在你自己看来,球飞出去后,轨迹开始弯曲,好像被一只无形的手从侧面推了一把。
但站在地面上(不转动的)朋友会说:球的轨迹根本没有弯曲,球从出手那一刻起就是直线运动的,只是你脚下的圆盘在转,你的参考系在转。所以你会觉得球的轨迹开始弯曲了。
这个在旋转的圆盘的我看到球的轨迹会弯曲,那么对我来说,就必须有一个侧向力作用到球,这个侧向力就是科里奥利力。但是我们知道,侧向力是不存在的,是旋转参考系下产生的假象,所以说:科里奥利力不是物体间真实的相互作用力,而是因为观察者处在旋转参考系中,为了仍然能用牛顿定律描述运动,而被迫"虚构"出来的力。这类力统称惯性力(或称虚拟力)。
科里奥利力类似我们已知的离心力,可以计算大小,可以确定方向,但不是真实存在的。
在角速度为 ω~ 的旋转参考系中,质量为 m、相对速度为 v~ 的物体,受到的科里奥利力为:
其中:
- m:物体质量;
- ω~:旋转参考系的角速度矢量;方向等同与角动量的方向
- v~:物体在旋转参考系内的相对速度;
- ×:叉乘;
- 负号:表示力的方向与 ω~ × v~ 相反。
4.2 科里奥利的大小和方向
科里奥利力的大小由叉乘的定义给出:
θ 是ω~ 与 v~ 两个矢量之间的夹角。
理解 θ 的三种情形:
| θ | 运动方向 | sinθ | 科里奥利力 |
|---|---|---|---|
| 0° | 平行于转轴(顺着/逆着转轴运动) | 0 | 为零 |
| 90° | 垂直于转轴 | 1 | 最大 |
| 其他角度 | 斜着运动 | sinθ | 介于两者之间 |
只有速度中垂直于转轴的分量vsinθ 才会产生科里奥利效应。因为:
- 沿转轴方向运动时,物体只是"沿着轴滑动",没有跨越不同半径的旋转圈层,不存在线速度差异,自然不受侧推力;
- 垂直于转轴运动时,物体在旋转平面内穿越不同半径,线速度差异最显著,侧推力最大。
方向用右手定则加负号判断(等同于左手定则)
先算 ω~×v~ 的方向:右手四指从 ω~ 转向 v~,拇指指向即叉乘结果方向。再取负号反向,就是 Fc~ 的实际方向。
从以上可以看出:
速度越大、转速越快,偏转越强;若运动方向平行于转轴(θ=0),则不受影响;方向永远垂直于运动方向,所以它只改变运动方向,不改变速度大小(不做功);
为什么有系数 2:一半来自"你运动到新位置时该处的线速度变了"(位置效应),另一半来自"旋转系本身的方向在转,你的速度矢量也随之转动"(方向效应),两者恰好各贡献 mωv,加起来是 2mωv。
五、IMU 器件工作原理
IMU(Inertial Measurement Unit,惯性测量单元)的本质是一颗(或一组)MEMS 微机械芯片,把几类"惯性传感器"集成在一起:
| 传感器 | 数量 | 直接测量量 | 单位 |
|---|---|---|---|
| 加速度计 Accelerometer | 三轴 | 比力(含重力)ax,ay,az | m/s²(常用 g) |
| 陀螺仪 Gyroscope | 三轴 | 角速度 ωx,ωy,ωz | °/s |
| 磁力计 Magnetometer(可选) | 三轴 | 磁场分量 Bx,By,Bz | μT |
- 加速度计 + 陀螺仪 =6 轴 IMU(手机标配);
- 再加磁力计 =9 轴(常称 AHRS 姿态参考系统的基础)。
IMU 芯片只"直接"测出加速度和角速度两个物理量。速度、位移、角度全部靠积分算出来——这一件事决定了后面所有误差的大小排序。
5.1 三轴加速度如何得到
物理原理:弹簧-质量块-电容
加速度计内部是一个微小的质量块(proof mass),通过弹性悬臂梁固定在框架上,两侧布置叉指状电容极板:
- 芯片静止或匀速运动时,质量块居中,左右电容相等;
- 当芯片有加速度 a 时,质量块因惯性滞后,相对框架产生位移 x;
- 由牛顿第二定律与弹簧力平衡:ma=kx,即位移 x∝a;
- 位移改变了左右叉指电容的差值 ΔC,电路测出 ΔC,换算出加速度;
为了得到ax,ay,az三轴加速度,原理都是三套这样的结构互相垂直摆放。但在实际应用中,有的是"单质量块六方向检测"(就是一个质量块,六个方向全部接上弹簧和电容电极),也有的是"面内一个结构测 X/Y + 单独一个结构测 Z"的两块方案,但物理本质完全一样。
重要细节:加速度计测的是"比力"——它分不清真实的加速度和重力。静止时 z 轴仍会读出 1g。这一点后面既是优点(测姿态)也是缺点(污染运动测量)。
IMU 从不直接测速度和位移,它们是纯计算量,由积分而来:
5.2 三轴角速度与角位移如何得到
测角速度靠的就是科里奥利力。
质量块被静电驱动,始终在 x 方向振动(这叫"驱动模态");一旦芯片绕 z 轴以角速度 ω~ 旋转,质量块就会受到一个水平 y 方向的科里奥利力,那么质量块就会在水平 y 方向发生偏移;在 y 方向上布置了检测电容("检测模态"),电容大小变化,体现了质量块偏移量,从而求出科里奥利力 Fc,继续求出角速度。
总结:陀螺仪能通过振动质量块受到的侧向力,测出瞬时角速度 ω,单位是 °/s。
沿某一方向振动的质量块,只能检测与振动方向垂直的那两个转轴。
3轴角速度的振动/检测方向安排如下:
| 结构 | 检测目标 | 驱动振动方向 v⃗ | 科里奥利力方向 F⃗c(检测方向) | 检测方式 |
|---|---|---|---|---|
| ① | ωz | X(面内左右) | Y(面内上下) | 面内叉指电容 |
| ② | ωy | X(面内左右) | Z(垂直纸面) | 上下平行板电容 |
| ③ | ωx | Y(面内上下) | Z(垂直纸面) | 上下平行板电容 |
由此得到两个重要结论:
- 最少只需两个振动方向:结构①和②共用同一个"沿 X 振动"的质量块,就能同时测 ωy 和 ωz;再加一个沿 Y 振动的质量块测 ωx,三轴齐了。这就是为什么实际芯片常见 2 质量块设计;
- 也有厂商做成 4 个对称质量块(如音叉式、环式结构),目的是抵消共模干扰、降低零偏——但原理仍然是上表的"驱动方向 × 检测方向"组合。
但实际输出不是理想值,而是:
- b:零偏(bias)——即使静止不动,陀螺仪也输出一个非零的小值(例如 0.5°/s)。它由制造工艺不对称、温度变化决定,且会随时间缓慢变化;
- n:噪声——随机抖动。
角度不是直接测出来的,而是从传感器数据"算"出来的。主要有三条路径:
路径 1:陀螺仪积分
角度是角速度对时间的积分:
优点:动态响应极快,短时期内非常精确——挥动手腕、转一下头,姿态立刻跟上。
致命缺陷:积分会把误差累积放大。静止时陀螺仪输出的零偏 b 也会被积分进去:
零偏只有 1°/s 的话,一分钟就累积 60° 的假角度,而且随时间线性增长,永不回头。这就是所谓的陀螺漂移。
路径 2:加速度计读重力
加速度计能测出重力方向。静止或缓动时,重力矢量在三轴上的投影告诉我们"哪边是下",于是能算出俯仰(pitch)和横滚(roll):
优点:这是一个绝对参考——不管设备之前怎么动过,重力永远指向地心,算出的倾斜角不随时间漂移。
缺陷:
- 只能算出相对重力的两个倾斜角,算不出绕竖直轴的水平朝向(yaw)——因为无论设备绕 z 轴转到哪个方向,重力在 z 轴上的投影都不变,重力对 yaw 完全"失明";
- 任何线性加速度(走路震动、车辆加减速)都会污染重力读数,所以只适合准静态修正。
路径 3:磁力计读地磁场
有些IMU还有三轴磁力计,原理如下:
- 某些坡莫合金(NiFe)薄膜中,电流方向与磁化方向的夹角会改变材料电阻——磁化方向平行于电流时电阻最大,垂直时最小;
- 芯片上有四组磁阻条,分别对 x、y 方向磁场敏感,组成惠斯通电桥;
- 外磁场(地磁场)改变磁化方向 → 电阻变化 → 电桥输出电压变化;
- 三组正交摆放 → 测出磁场矢量 (Bx,By,Bz)。
地磁场方向基本恒定(指向磁北),据此可解算航向:
(M′ 为经倾斜补偿后的水平磁场分量。)
它补上了 IMU 最大的短板:yaw 的绝对锚点。9 轴融合后,三轴姿态都能长期稳定。
缺陷:地磁场很弱(约 50 μT),而扬声器磁钢、电机、钢筋、USB 电流产生的干扰场动辄几百 μT。室内磁力计数据基本不可信,所以很多产品(如手机、手柄)干脆不用磁力计,或只偶尔参考。
实际做法:传感器融合
真实 IMU 用互补滤波 / Madgwick / 卡尔曼滤波把三者融合:
- 短期信任陀螺仪(动态快、噪声小);
- 长期用加速度计的重力方向持续"拉回"pitch 和 roll,抵消陀螺积分的漂移;
- yaw 只能靠陀螺积分,偶尔由磁力计修正(如果有的话)。
完整的数据流如下:
5.3 信息误差排序
所有误差根源是同一个:传感器输出含零偏 b 和噪声 n,积分把误差逐级放大:
| 物理量 | 获取方式 | 误差增长规律 | 误差等级 |
|---|---|---|---|
| 加速度、角速度本身 | 直接测量 | 有零偏和噪声,但有界 | ★★★★(相对最准) |
| 角位移、速度 | 一次积分 | 误差 ∝b⋅t(线性增长) | ★★★ |
| 位移 | 二次积分 | 误差 ∝12b⋅t2(平方增长) | ★(最差) |
设加速度零偏仅 0.01 m/s^2(约千分之一 g,消费级 IMU 的常见水平):
- 10 秒后:速度误差 0.1 m/s,位移误差 ≈12×0.01×100=0.5 m;
- 60 秒后:位移误差 ≈18 m;
- 10 分钟后:误差上百米。
且噪声经二次积分同样发散。这就是为什么任何手机都不可能"只靠 IMU"长期追踪位置——误差按 t2 爆炸,没有任何重力或磁场参考能修正"水平位移"(重力只告诉你上下方向,不告诉你移动了多远)。
陀螺零偏典型 1∼10 °/h 量级(消费级),积分后角度线性漂移。其中yaw(Z 轴航向)最严重。
结论:位移误差最大(二次积分、平方增长),其次是航向角(无绝对参考),再次是速度;直接测量的加速度和角速度相对最可信。
5.4 为什么 Z 轴(yaw)精度最差
根本原因是:yaw 是"不可观测"的,没有任何绝对参考
- pitch/roll 有重力做绝对锚点,漂移随时被纠正,长期看误差被"钉死"在一个小范围内;
- yaw 没有任何天然锚点——重力帮不上忙,磁力计又不可靠。yaw 只能靠陀螺仪一路积分下去,零偏 b 的积分 b⋅t 无限累积。
所以漂移不是"Z 轴传感器特别烂",而是yaw 这个量天生没有修正机制,误差只增不减。这是信息论层面的必然,任何算法都救不了。
硬件层面:工艺决定 Z 轴零偏往往本来就更大
陀螺仪结构是平面工艺制造的,驱动与检测结构都躺在芯片平面内(xy 平面):
- 绕 x、y 轴旋转时,科里奥利力的方向与驱动震动方向是竖直平面,检测方式相对对称;
- 绕 z 轴旋转时,科里奥利力的方向与驱动震动方向是水平平面,结构上对平面内的工艺偏差、应力不对称更敏感。
结果就是 Z 轴的零偏 b 和零偏不稳定性(bias instability)通常比 X/Y 轴更大,积分起来漂得更快。消费级 IMU 中这是普遍现象。
5.5 消费级 IMU 目前最大的局限
综合来看,手机等电子产品中 IMU 的局限可归结为三点,其中第一点是根本瓶颈:
位移解算的 t^2 发散——"惯性导航"在消费级器件上不可行,即使零偏做到极小,二次积分的误差平方律也无法消除。这导致:
- 手机计步靠的是步态检测算法(数震动峰值),不是真积分位移;
- 室内定位靠 Wi-Fi/蓝牙/UWB 信标,而不是 IMU;
- VR 手柄/头显靠外部摄像头或基站追踪,IMU 只负责高频率的姿态插值。
消费级 MEMS 工艺下,零偏不稳定性(bias instability)约为 1∼10 °/h(陀螺)、几十 μg(加速度计),比导航级器件差 2~3 个数量级,且无法靠纯算法根治。
总结
| 问题 | 结论 |
|---|---|
| 加速度怎么得到 | 质量块惯性位移 → 电容变化,三轴正交结构直接测出 |
| 速度/位移怎么得到 | 一次/二次积分,纯计算量,不直接测量 |
| 角速度怎么得到 | 科里奥利力:振动质量块的侧向偏移 ∝ω |
| 角位移怎么得到 | 角速度一次积分;倾斜角另可用重力绝对校准 |
| 误差最大的是什么 | 位移(二次积分,t2 发散)> 航向角(无绝对参考)> 速度 > 加速度/角速度本身 |
| 磁力计原理 | 磁阻效应(AMR):磁场改变磁化方向 → 电阻变化 → 电桥输出 |
| 磁力计作用 | 提供航向绝对参考,补齐 yaw 短板;但易受磁干扰 |
| 最大局限 | 消费级器件零偏大 + 位移误差平方律 → 纯惯性导航不可行,必须依赖 GPS/视觉/信标等外部参考 |
一句话收尾:IMU 只能可靠地测"加速度"和"角速度"这两个瞬时量;凡是需要积分才能得到的量(角度、速度、位移),积分次数越多误差增长越快,位移因此成为永远做不好的那个量——这是消费级 IMU 一切工程妥协的总根源。