1. 姿态角解算概述
各位同学好，我是老张。今天咱们开始聊姿态角解算。说实话，这个主题我做了十几年，踩过的坑能写一本书。但别担心，我会把最核心的东西掰开揉碎了讲给你听。
姿态角解算，说白了就是回答一个问题：一个物体现在朝哪个方向？ 你想想看，无人机在天上飞，它得知道自己是不是歪了；机器人走路，它得知道自己有没有摔倒；VR眼镜戴在头上，它得知道你扭头看了哪里。这些场景背后，都离不开姿态角解算。
1.1 姿态角定义
我们先说清楚三个角分别是什么。我习惯用飞机来打比方，这样最直观。
- 横滚角（Roll，φ）：绕机体纵轴旋转的角度。说白了就是飞机翅膀一高一低，像要侧翻的样子。范围通常是 -180° 到 180°。
- 俯仰角（Pitch，θ）：绕机体横轴旋转的角度。就是飞机抬头或低头。范围 -90° 到 90°。
- 偏航角（Yaw，ψ）：绕机体竖轴旋转的角度。相当于飞机在地面上转圈，机头指向哪个方向。范围 0° 到 360°。
重要提醒：这三个角不是独立的。它们之间存在耦合关系。我在项目中遇到过有人把横滚和偏航搞混，结果无人机直接翻了个跟头。嗯，这个教训很深刻。
1.2 坐标系定义
搞姿态解算，坐标系是地基。地基没打好，后面全白搭。我们主要用两个坐标系：
导航坐标系（n系）
也叫地理坐标系。我习惯用北-东-地（NED）作为参考。说白了，这就是一个固定在地球上的坐标系，不随物体转动而变化。原点在物体质心，X轴指向北，Y轴指向东，Z轴指向地心。
机体坐标系（b系）
这个坐标系是跟着物体走的。原点在物体质心，X轴指向机头方向，Y轴指向右侧机翼，Z轴指向下方。你想想看，当飞机转弯时，这个坐标系也跟着转。
姿态角解算的核心任务，就是求出从机体坐标系到导航坐标系的旋转关系。这个关系用一个3×3的旋转矩阵来表示，也就是我们常说的方向余弦矩阵（DCM）。
我的小技巧：刚开始学的时候，别急着背公式。先在脑子里想象一架飞机，然后手动转它。横滚、俯仰、偏航，每个动作对应哪个轴，转几圈就明白了。
1.3 姿态解算的应用场景
姿态解算不是纸上谈兵，它实实在在用在很多地方。我挑三个典型的说说：
| 应用场景 | 核心需求 | 常见传感器 | 我的经验 |
|---|---|---|---|
| 无人机 | 稳定飞行、自主导航 | IMU（加速度计+陀螺仪）、磁力计 | 无人机最怕振动干扰，滤波要下功夫 |
| 机器人 | 平衡控制、路径规划 | IMU、编码器 | 轮式机器人要注意地面摩擦带来的误差 |
| VR/AR | 头部追踪、手势识别 | IMU、摄像头 | 延迟是致命问题，算法要轻量 |
拿无人机来说吧。我曾经做过一个四旋翼项目，刚开始姿态解算总是飘。后来发现是陀螺仪的零偏没校准好。你想想看，陀螺仪每秒钟偏0.1度，一分钟就偏了6度。无人机飞个十分钟，姿态早就不知道歪到哪里去了。所以，误差分析是姿态解算里绕不开的一环。
再比如VR眼镜。用户一扭头，画面必须立刻跟上。如果延迟超过20毫秒，人就会头晕。我见过一个团队，算法写得花里胡哨，但跑在嵌入式芯片上太慢，最后只能砍功能。所以，实时性和精度之间要找到平衡点。
避坑指南：我曾经在机器人项目里直接用无人机的姿态解算代码，结果机器人走路东倒西歪。为什么？因为机器人有轮子，地面接触会产生额外的加速度干扰。不同场景，传感器特性完全不同，千万别直接套用。
1.4 本章知识体系
为了让你更直观地理解本章内容，我画了一张图。这张图展示了姿态角解算的整体框架，从定义到坐标系，再到应用场景，最后引出误差分析这个核心问题。
这张图你看懂了吗？从姿态角定义出发，到坐标系定义，再到应用场景，最后引出误差分析与消除这个核心问题。后面的章节，我们会一步步深入每个环节。
好了，第一章就讲到这里。记住一句话：姿态解算没有银弹。每个场景都有自己的特殊性，理解原理比背公式重要得多。下一章我们开始聊传感器，看看加速度计和陀螺仪到底是怎么工作的。
公众号:蓝海资料掘金营，微信deep3321