目录前言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 点冲去L0因为没有绕 O 的转动若 v~ 垂直 r~θ90∘圆周运动Lmvr达到最大。角动量是矢量其方向由叉乘的数学定义给出实际操作中用右手定则方法一右手四指弯曲法最直观伸出右手四指沿物体转动方向弯曲想象你要握住转轴大拇指的指向就是角动量 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⋅m1 J但力矩绝不写成焦耳。因为功是力与位移的点乘标量力矩是位矢与力的叉乘矢量物理含义完全不同。约定俗成地力矩用 N⋅m能量用 J以示区分。2.2 力矩的大小与方向由叉乘定义其中 θ 是 r~ 与 F~ 的夹角。把力 F~ 分解成两部分沿 r~ 方向的分量Fcos⁡θ只把物体推向/拉离支点不产生转动垂直 r~ 的分量Fsin⁡θ真正让物体绕支点转的部分。所以其中 drsin⁡θ 叫做力臂——它是支点 O 到力的作用线沿力方向的延长线的垂直距离。两个特例力的作用线通过支点d0力矩为零比如门轴处的力推不开门力垂直于r~dr力矩最大τ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 器件工作原理IMUInertial Measurement Unit惯性测量单元的本质是一颗或一组MEMS 微机械芯片把几类惯性传感器集成在一起传感器数量直接测量量单位加速度计 Accelerometer三轴比力含重力ax,ay,azm/s²常用 g陀螺仪 Gyroscope三轴角速度 ωx,ωy,ωz°/s磁力计 Magnetometer可选三轴磁场分量 Bx,By,BzμT加速度计 陀螺仪 6 轴 IMU手机标配再加磁力计 9 轴常称 AHRS 姿态参考系统的基础。IMU 芯片只直接测出加速度和角速度两个物理量。速度、位移、角度全部靠积分算出来——这一件事决定了后面所有误差的大小排序。5.1 三轴加速度如何得到物理原理弹簧-质量块-电容加速度计内部是一个微小的质量块proof mass通过弹性悬臂梁固定在框架上两侧布置叉指状电容极板芯片静止或匀速运动时质量块居中左右电容相等当芯片有加速度 a 时质量块因惯性滞后相对框架产生位移 x由牛顿第二定律与弹簧力平衡makx即位移 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检测方向检测方式①ωzX面内左右Y面内上下面内叉指电容②ωyX面内左右Z垂直纸面上下平行板电容③ωxY面内上下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×1000.5 m60 秒后位移误差 ≈18 m10 分钟后误差上百米。且噪声经二次积分同样发散。这就是为什么任何手机都不可能只靠 IMU长期追踪位置——误差按 t2 爆炸没有任何重力或磁场参考能修正水平位移重力只告诉你上下方向不告诉你移动了多远。陀螺零偏典型 1∼10 °/h 量级消费级积分后角度线性漂移。其中yawZ 轴航向最严重。结论位移误差最大二次积分、平方增长其次是航向角无绝对参考再次是速度直接测量的加速度和角速度相对最可信。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 信标而不是 IMUVR 手柄/头显靠外部摄像头或基站追踪IMU 只负责高频率的姿态插值。消费级 MEMS 工艺下零偏不稳定性bias instability约为 1∼10 °/h陀螺、几十 μg加速度计比导航级器件差 2~3 个数量级且无法靠纯算法根治。总结问题结论加速度怎么得到质量块惯性位移 → 电容变化三轴正交结构直接测出速度/位移怎么得到一次/二次积分纯计算量不直接测量角速度怎么得到科里奥利力振动质量块的侧向偏移 ∝ω角位移怎么得到角速度一次积分倾斜角另可用重力绝对校准误差最大的是什么位移二次积分t2 发散 航向角无绝对参考 速度 加速度/角速度本身磁力计原理磁阻效应AMR磁场改变磁化方向 → 电阻变化 → 电桥输出磁力计作用提供航向绝对参考补齐 yaw 短板但易受磁干扰最大局限消费级器件零偏大 位移误差平方律 → 纯惯性导航不可行必须依赖 GPS/视觉/信标等外部参考一句话收尾IMU 只能可靠地测加速度和角速度这两个瞬时量凡是需要积分才能得到的量角度、速度、位移积分次数越多误差增长越快位移因此成为永远做不好的那个量——这是消费级 IMU 一切工程妥协的总根源。