第1章：姿态解算概述

各位同学好，我是你们这门课的老朋友。今天咱们聊聊姿态解算到底是个啥。

说实话，我第一次接触“姿态解算”这四个字时，脑子里全是问号。后来在无人机项目里摔了几次机，才真正明白这东西有多重要。嗯，咱们慢慢来。

1.1 什么是姿态？

姿态，说白了就是物体在空间中的朝向。你想想看，一架无人机在空中，它机头朝哪？机身是平着还是歪着？这些信息就是姿态。

我习惯用三个角度来描述姿态：

• 俯仰角（Pitch）：机头抬起来还是低下去
• 横滚角（Roll）：机身向左歪还是向右歪
• 偏航角（Yaw）：机头朝北还是朝南

这三个角合起来，就是咱们常说的欧拉角。我在项目中遇到过一个问题：用欧拉角做姿态控制时，如果俯仰角接近90度，整个系统就乱套了。这就是著名的“万向锁”问题。后面咱们会详细讲。

1.2 欧拉角与四元数

欧拉角直观，但有个致命缺陷——万向锁。我曾经在调试一个四轴飞行器时，就因为没处理好这个问题，飞机在空中突然失控，差点砸到人。从那以后，我坚决推荐用四元数。

四元数是什么？你可以把它理解成一个“超级旋转描述器”。它用四个数来表示旋转：

q = w + x*i + y*j + z*k

其中w是实部，x、y、z是虚部。别被这个公式吓到，后面我会手把手教你推导。

表示方法	优点	缺点
欧拉角	直观，容易理解	有万向锁，插值困难
四元数	无万向锁，计算高效	不够直观
旋转矩阵	数学性质好	参数多，计算量大

1.3 坐标系定义

搞姿态解算，坐标系是绕不开的坎。我见过太多新手因为坐标系搞反，导致飞机倒着飞。

咱们主要用两个坐标系：

机体坐标系（Body Frame）

固定在无人机上。原点在重心，x轴指向机头，y轴指向右翼，z轴指向下方（符合右手定则）。

地理坐标系（Navigation Frame）

固定在地面上。常用的是北东地（NED）坐标系：x轴指北，y轴指东，z轴指向地心。

为什么要区分这两个坐标系？因为传感器数据是在机体坐标系下测量的，而导航指令是在地理坐标系下给出的。姿态解算，说白了就是找到这两个坐标系之间的旋转关系。

1.4 姿态解算的应用场景

姿态解算不只是无人机的事。我这些年接触过的项目包括：

• 无人机飞控：这是最经典的应用。没有姿态解算，无人机就是一块会飞的砖头。
• 手机导航：你手机里的指南针、计步器，都依赖姿态解算。
• 虚拟现实（VR）：头显需要实时跟踪你的头部姿态，不然你会晕到吐。
• 机器人平衡：两轮平衡车、四足机器人，都需要知道自己的姿态才能站稳。
• 船舶稳定：大型船舶的减摇系统，也是靠姿态解算来工作的。

你想想看，这些场景的共同点是什么？都需要实时、准确地知道物体在空间中的朝向。这就是姿态解算的价值所在。

1.5 本章小结

这一章咱们聊了：

• 姿态是什么——三个角度描述朝向
• 欧拉角和四元数——两种表示方法，各有优劣
• 坐标系定义——机体坐标系和地理坐标系
• 应用场景——从无人机到手机，无处不在

下一章，咱们会深入传感器数据，看看加速度计和陀螺仪到底是怎么工作的。嗯，到时候我会分享一个我当年踩过的坑——传感器数据融合没做好，飞机在天上跳起了舞。

今天就到这儿。记住，搞姿态解算，坐标系先画清楚，四元数用起来，别怕数学公式。咱们下章见。