一、姿态控制概述

各位同学，欢迎来到《姿态调参参数含义与调优》的第一章。我是你们这门课的主讲，一个在飞控圈子里摸爬滚打了十来年的老工程师。今天咱们先不急着调参数，先把地基打牢——搞清楚姿态控制到底是个什么东西。

说实话，我见过太多新手一上来就盯着PID那三个系数猛调，结果飞机越调越晃，最后炸了机还不知道问题出在哪。说白了，你不理解姿态控制的核心逻辑，调参就是瞎蒙。

1.1 什么是姿态控制

姿态控制，用大白话讲，就是让无人机或机器人按照你想要的姿势待着，或者按照你想要的轨迹运动。

你想想看，一架四旋翼在天上飞，它得保持水平吧？不能翻个跟头栽下来。一个机械臂抓东西，末端执行器得对准目标吧？不能歪歪扭扭。这些都需要姿态控制来完成。

从控制理论的角度看，姿态控制是一个典型的反馈控制问题。系统实时测量当前的姿态角（比如俯仰、横滚、偏航），跟目标姿态做比较，算出误差，然后通过控制器（最常见的就是PID）输出控制量，驱动电机或舵机去修正这个误差。

我记得刚入行那会儿，带我的老师傅跟我说过一句话，我一直记到现在：「姿态控制是飞控的灵魂，姿态控不好，什么高级功能都是扯淡。」嗯，这话一点不假。

1.2 姿态控制在无人机/机器人中的作用

姿态控制到底有多重要？我列几个场景你就明白了。

• 稳定飞行：无人机在空中会受到风、气流、自身振动等各种干扰。姿态控制能实时对抗这些干扰，让飞机稳稳当当。我曾在海边测试一架测绘无人机，海风一阵一阵的，没有好的姿态控制，那数据根本没法用。
• 精准执行任务：不管是航拍、测绘、还是物流配送，都需要无人机按照预定轨迹飞行。姿态控制是轨迹跟踪的基础。姿态偏一度，飞出去一百米，位置可能就偏了好几米。
• 安全保护：当姿态角超过安全阈值（比如倾斜超过45度），姿态控制系统需要能快速响应，把飞机拉回来，防止坠机。我曾经遇到过传感器故障导致姿态估计错误的情况，幸亏姿态控制器足够鲁棒，才没炸机。
• 机器人操作：对于地面机器人或机械臂，姿态控制决定了它能否稳定站立、能否精确抓取物体。比如双足机器人，姿态控制一旦失效，直接就摔倒了。

1.3 常见坐标系介绍

聊姿态控制，坐标系是绕不开的概念。很多新手搞混坐标系，导致控制逻辑完全写反。我刚开始做飞控的时候也犯过这个错，飞机一解锁就往地上怼……

咱们主要用两个坐标系：机体坐标系和世界坐标系（也叫地理坐标系或惯性坐标系）。

机体坐标系 (Body Frame)

机体坐标系是固定在飞行器或机器人身上的。原点通常在飞行器的重心。三个轴的定义如下：

• X轴：指向飞行器前方（机头方向）
• Y轴：指向飞行器右侧（右翼方向）
• Z轴：指向飞行器下方（符合右手定则，向下为正）

你想想看，飞行器自身的传感器（比如陀螺仪、加速度计）测量的数据，天然就是在机体坐标系下的。陀螺仪测的是绕机体三个轴的角速度，加速度计测的是机体三个轴上的加速度。

世界坐标系 (World Frame)

世界坐标系是固定在地面上的，不随飞行器转动。通常采用北-东-地（NED）坐标系：

• X轴：指向正北
• Y轴：指向正东
• Z轴：指向地心（向下为正）

GPS、磁力计这些传感器给出的数据，通常是在世界坐标系下的。比如GPS告诉你当前位置的经纬度，磁力计告诉你机头相对于正北的夹角。

两个坐标系的关系

姿态控制的核心任务之一，就是在这两个坐标系之间进行转换。飞行器的目标姿态通常是在世界坐标系下给出的（比如「保持水平，机头朝北」），而控制执行（电机转速）是在机体坐标系下完成的。所以我们需要一个数学工具来完成这个转换——旋转矩阵或四元数。

下面这张图可以帮你直观理解两个坐标系的关系：

在实际的飞控代码中，坐标系转换通常由姿态估计模块（比如互补滤波或卡尔曼滤波）来完成。它会融合陀螺仪、加速度计、磁力计的数据，输出当前飞行器在世界坐标系下的姿态角（欧拉角）或四元数。