1. 姿态参考系统概述

各位同学好，我是老张。今天咱们开始聊姿态参考系统——说白了，就是让机器知道自己"怎么躺"的技术。你想想看，无人机在天上飞，它得知道自己是不是歪了；机器人走路，也得知道自己是前倾还是后仰。这些背后，都离不开姿态参考系统。

我个人习惯把姿态参考系统比作机器的"平衡感"。就像人靠内耳前庭感知身体姿态一样，机器靠传感器来感知自己的朝向和转动。嗯，这里要注意，姿态参考系统其实分两种：一种是AHRS（航姿参考系统），另一种是INS（惯性导航系统）。

1.1 核心传感器原理

做姿态估计，离不开三个"老伙计"：陀螺仪、加速度计、磁力计。我在项目中遇到过不少新手，上来就对着数据手册猛调参数，结果越调越乱。其实，理解每个传感器的脾气更重要。

陀螺仪

陀螺仪测量的是角速度，单位是°/s。说白了，就是告诉你转得有多快。我刚开始做无人机飞控时，总觉得陀螺仪数据很准，后来发现它有个毛病——漂移。你静止不动，它也会慢慢累积误差。为什么会这样？因为陀螺仪有零偏，时间一长，积分出来的角度就飞了。

加速度计

加速度计测量的是比力，单位是m/s²。静止时，它测的是重力加速度g。利用这个特性，我们可以算出俯仰角和横滚角。但加速度计有个致命弱点——怕运动。你想想看，无人机一加速，加速度计就分不清是重力还是运动加速度了。

我记得有一次做车载导航，车辆过减速带时加速度计数据剧烈跳动，姿态角直接乱套。所以，加速度计适合做长期参考，不适合快速响应。

磁力计

磁力计测量磁场强度，用来确定航向角（偏航角）。它就像电子罗盘，告诉你哪边是北。但磁力计特别娇气——怕铁磁干扰。我在机器人项目里遇到过，电机一启动，磁力计数据就飘了。

传感器	测量量	优点	缺点
陀螺仪	角速度	动态响应快	有漂移
加速度计	比力	长期稳定	怕运动干扰
磁力计	磁场强度	提供绝对航向	怕电磁干扰

1.2 姿态表示方法

姿态怎么表示？说白了，就是怎么用数学语言描述"物体转了多少"。常用的有三种：欧拉角、四元数、旋转矩阵。我建议初学者先搞懂欧拉角，但实际项目中，四元数用得最多。

欧拉角

欧拉角用三个角度表示姿态：横滚角（Roll）、俯仰角（Pitch）、偏航角（Yaw）。直观好理解，但有个大坑——万向锁。当俯仰角接近±90度时，横滚和偏航会耦合，丢失一个自由度。

我在做飞行器仿真时遇到过万向锁，姿态突然跳变，差点把仿真模型搞崩。所以，如果你做的是全姿态运动（比如特技飞行），千万别用欧拉角。

四元数

四元数用四个数表示姿态：q = [w, x, y, z]。它没有万向锁问题，计算效率高，是工程界的首选。我个人习惯用四元数做姿态解算，配合卡尔曼滤波，效果很好。

// 四元数转欧拉角示例
float qw = 0.707, qx = 0.0, qy = 0.707, qz = 0.0;
float roll  = atan2(2*(qw*qx + qy*qz), 1 - 2*(qx*qx + qy*qy));
float pitch = asin(2*(qw*qy - qz*qx));
float yaw   = atan2(2*(qw*qz + qx*qy), 1 - 2*(qy*qy + qz*qz));

旋转矩阵

旋转矩阵是3x3的正交矩阵，用于坐标变换。它很直观，但参数多（9个数），计算量大。一般用于理论推导，工程中很少直接用。

1.3 应用场景

姿态参考系统无处不在。我做了十几年导航，总结下来，主要分三大类：

• 无人机：飞控的核心就是姿态估计。没有准确的姿态，无人机根本飞不稳。我见过不少炸机案例，都是因为姿态解算出了问题。
• 机器人：双足机器人、四足机器人、AGV小车，都需要姿态信息来保持平衡和导航。特别是足式机器人，姿态更新频率要快，否则容易摔倒。
• 自动驾驶：车辆在坡道、弯道行驶时，姿态信息用于控制车身稳定。我记得有次测试，车辆在冰雪路面打滑，全靠IMU的姿态数据才稳住车身。

好了，第一章就聊这么多。姿态参考系统是后续所有内容的基础，搞懂了传感器原理和姿态表示方法，后面学视觉融合就轻松多了。下一章，咱们深入讲讲传感器标定和误差模型——这可是工程落地的关键。