飞控算法中双环串级PID深度解析：角度环与角速度环的协同机制

在四旋翼无人机飞控系统设计中，双环串级PID是实现姿态稳定控制的核心架构，也是工业级飞控（如PX4、ArduPilot、Betaflight）的主流控制方案。对于刚接触飞控开发的开发者而言，最易困惑的问题的是：双环串级PID的核心逻辑是什么？外环（角度环）的PID输出为何能直接作为内环（角速度环）的期望输入？为何角度环的输出物理意义是期望角速度？

本文将从串级PID的核心原理、双环协同机制、关键疑问解析、工程实操要点四个维度，结合飞控动力学特性与代码示例，全面且深入地拆解双环串级PID，帮助开发者真正理解其设计逻辑，而非单纯记忆"外环管角度、内环管角速度"的表面结论，为飞控算法的调试与优化提供理论支撑和实操参考。

关键词：飞控算法；双环串级PID；角度环；角速度环；姿态控制；四旋翼无人机；PID调试

一、前言：串级PID在飞控中的核心价值

四旋翼无人机的姿态稳定是飞控系统的基础，直接决定飞行安全性与操控性。单环PID（仅角度环）虽能实现姿态控制，但存在响应慢、抗扰动能力弱、易震荡等致命问题------比如遇到风扰、电机不平衡等扰动时，单环PID无法快速抑制偏差，极易导致无人机姿态失控、翻机。

双环串级PID通过"外环角度环+内环角速度环"的分层控制，将姿态控制拆分为"目标角度跟踪"和"角速度快速响应"两个核心任务，实现"粗调+细调"的协同控制：外环负责稳定姿态角度，内环负责快速跟踪角速度、抑制高频扰动，最终让无人机姿态更稳定、响应更迅速、抗扰能力更强。

本文重点解答开发者最易困惑的核心问题：外环（角度环）的PID输出为何能作为内环（角速度环）的期望输入？其输出的物理意义为何是期望角速度？结合动力学原理与工程实践，彻底讲透双环的协同逻辑。

二、双环串级PID的核心结构与工作流程

飞控中的双环串级PID，本质是"两层闭环控制的嵌套"，内环为角速度环（快速响应环），外环为角度环（稳定控制环），两者协同工作，形成完整的姿态控制闭环。先明确双环的核心结构与工作流程，为后续疑问解析奠定基础。

2.1 核心结构拆解

双环串级PID的结构可概括为"感知→外环决策→内环执行→反馈修正"，具体分层如下：

感知层：通过传感器（MPU6050、MPU9250等）采集无人机的实际姿态数据------包括角度环所需的姿态角（俯仰角pitch、横滚角roll、航向角yaw），以及角速度环所需的角速度（pitch角速度、roll角速度、yaw角速度），经卡尔曼滤波或互补滤波消除噪声后，作为双环的反馈输入。
外环（角度环）：输入为"目标姿态角"（如手动操控时的遥控器指令、自主飞行时的规划姿态），反馈为"实际姿态角"，通过PID算法计算偏差，输出一个控制量，这个控制量就是内环（角速度环）的"期望角速度"。
内环（角速度环）：输入为"外环输出的期望角速度"，反馈为"实际角速度"，同样通过PID算法计算偏差，输出控制量（电机转速修正量），驱动电调与电机，调整无人机姿态。
反馈修正：电机转速调整后，无人机姿态发生变化，传感器重新采集姿态数据，重复上述流程，形成持续的闭环控制，确保姿态稳定。

2.2 简化工作流程（以俯仰角控制为例）

设定目标俯仰角：比如手动操控时，遥控器发送目标pitch=0°（水平姿态）；
角度环计算：采集实际pitch角（假设为5°，存在偏差），通过角度环PID计算偏差（目标角-实际角），输出期望角速度（比如-10°/s，负号表示反向转动回正）；
角速度环计算：采集实际pitch角速度（假设为0°/s），通过角速度环PID计算偏差（期望角速度-实际角速度），输出电机转速修正量；
执行与反馈：调整前后电机转速差，无人机开始以10°/s的角速度回正，传感器实时采集姿态数据，持续修正，直到实际pitch角接近目标角、角速度接近0，实现姿态稳定。

三、核心疑问解析：为何角度环输出是期望角速度？

这是所有飞控开发者入门时的核心困惑------从物理量维度看，角度（单位：°）与角速度（单位：°/s）是两个不同的物理量，为何角度环的PID输出，能直接作为角速度环的期望输入？这并非人为规定，而是由无人机动力学特性和控制逻辑天然决定的。

3.1 从动力学角度：角度偏差的修正，本质是"控制转动速度"

四旋翼无人机的姿态变化，本质是"绕三个轴的转动运动"，而转动运动的核心控制量是"角速度"------角度是转动的结果，角速度是转动的过程。我们无法直接"控制角度"，只能通过"控制转动角速度"，间接实现角度的稳定。

举个通俗的例子：无人机当前俯仰角为5°（前倾），目标是回到0°（水平）。此时存在5°的角度偏差，要消除这个偏差，必须让无人机以一定的角速度向后转动（负向角速度），转动的角速度越大，回正的速度越快，但角速度过大，会导致姿态超调、震荡；角速度过小，回正太慢，无法快速响应扰动。

因此，角度环的核心任务，就是根据"角度偏差的大小和变化趋势"，计算出"最合适的转动角速度"------这个角速度既能快速消除角度偏差，又能避免超调与震荡，这就是角度环PID输出的物理意义：为消除角度偏差，所需的期望角速度。

3.2 从控制逻辑：外环"定目标"，内环"保执行"

串级PID的设计逻辑，是将"慢响应、大惯性"的控制任务（角度稳定），交给外环；将"快响应、小惯性"的控制任务（角速度跟踪），交给内环，两者分工明确、协同工作：

角度环（外环）：属于"慢环"，响应速度较慢，主要负责"稳定目标角度"，不直接控制电机，只输出"控制指令"------也就是期望角速度。它的核心作用是"决策"：根据角度偏差，判断需要以多大的速度转动，才能平稳回正。
角速度环（内环）：属于"快环"，响应速度极快，主要负责"执行指令"------跟踪外环给出的期望角速度，快速调整电机转速，抑制高频扰动（如振动、风扰）。它的核心作用是"执行"：确保无人机的实际转动速度，严格跟随外环的指令。

举个工程类比：角度环相当于"指挥官"，负责下达"以10°/s的速度回正"的指令；角速度环相当于"士兵"，负责精准执行指令，快速调整动作，确保不偏离指令。因此，角度环的输出（期望角速度），自然就是内环的期望输入------这是串级控制"分工协同"的必然结果。

3.3 数学层面：PID输出的物理量适配性

从PID算法的数学表达式来看，角度环的输出物理量，恰好与角速度环的输入物理量匹配。我们以角度环PID的离散化公式为例（工程中常用离散PID，适配单片机实时计算）：

其中：

：k时刻的角度偏差（目标角 - 实际角），单位为°；
、、：角度环的比例、积分、微分系数；
：角度环的输出控制量，单位为°/s（角速度）。

从公式可以看出，角度偏差经过PID计算后，输出的控制量单位是"°/s"，恰好是角速度的单位，与角速度环的输入物理量完全匹配。这不是巧合，而是在PID参数整定的过程中，通过调整Kp、Ki、Kd，让角度环的输出自然映射为"期望角速度"------参数整定的核心目标之一，就是确保角度环输出的物理意义与内环输入一致。

四、补充：为何不能只用单环PID？（工程实践视角）

理解了双环的协同逻辑，就不难明白"为何成熟飞控都用串级PID，而非单环PID"。从工程实践来看，单环PID（仅角度环）存在三个致命问题，而串级PID能完美解决：

响应速度慢：角度环的响应特性决定了其无法快速跟踪扰动，比如遇到突发风扰，无人机姿态发生偏差，单环PID需要先检测角度偏差，再直接调整电机，响应滞后，极易导致姿态震荡；
抗扰动能力弱：无人机飞行中存在大量高频扰动（电机振动、风扰、传感器噪声），单环PID无法区分"角度偏差"和"高频扰动"，容易误判偏差，导致控制失稳；
调参难度大：单环PID需要同时兼顾"角度稳定"和"响应速度"，参数整定难度极高------Kp太大易震荡，太小响应慢；而串级PID可分层调参，先调内环（角速度环），再调外环（角度环），调参逻辑更清晰，控制效果更稳定。

举个实际测试案例：在相同扰动条件下，单环PID控制的无人机，姿态偏差最大可达8°，震荡次数多；而双环串级PID控制的无人机，姿态偏差可控制在±1°以内，震荡快速衰减，抗扰能力显著提升。这也是串级PID成为飞控主流控制方案的核心原因。

五、工程实操要点与代码示例

结合工程开发场景，补充双环串级PID的实操要点和核心代码片段，帮助开发者快速落地到飞控项目中（以STM32单片机、四旋翼roll角控制为例）。

5.1 实操核心要点

调参顺序：先调内环（角速度环），再调外环（角度环）。内环优先保证"快速跟踪"，外环优先保证"姿态稳定"；
参数范围（入门参考）：角速度环Kp=5~10，Ki=0.1~0.5，Kd=0.1~0.3；角度环Kp=2~5，Ki=0.01~0.1，Kd=0.1~0.5（需根据无人机机型、重量调整）；
滤波处理：角速度数据需经过低通滤波（如一阶低通）消除高频噪声，避免干扰内环控制；
限幅保护：角度环输出的期望角速度需限幅（如±50°/s），避免角速度过大导致姿态失控；内环输出的电机转速需限幅，避免超出电调工作范围（如1000~2000us）。

5.2 核心代码示例（STM32实操）

cs 复制代码

#include "pid.h"

// 双环PID结构体（roll角控制为例）
typedef struct {
    // 角度环PID参数
    float Kp_angle;
    float Ki_angle;
    float Kd_angle;
    // 角速度环PID参数
    float Kp_rate;
    float Ki_rate;
    float Kd_rate;
    
    // 角度环变量
    float target_angle;  // 目标角度（°）
    float actual_angle; // 实际角度（°）
    float err_angle;    // 角度偏差
    float err_angle_sum; // 角度偏差积分
    float err_angle_last; // 上一次角度偏差
    
    // 角速度环变量
    float target_rate;  // 目标角速度（°/s），即角度环输出
    float actual_rate;  // 实际角速度（°/s）
    float err_rate;     // 角速度偏差
    float err_rate_sum; // 角速度偏差积分
    float err_rate_last; // 上一次角速度偏差
    
    // 输出限幅
    float rate_max;     // 期望角速度最大限制（°/s）
    float motor_out_max; // 电机输出最大限制（us）
} CascadePID;

// 串级PID初始化
void CascadePID_Init(CascadePID *pid) {
    // 初始化参数（入门参考值）
    pid->Kp_angle = 3.0f;
    pid->Ki_angle = 0.05f;
    pid->Kd_angle = 0.2f;
    
    pid->Kp_rate = 8.0f;
    pid->Ki_rate = 0.3f;
    pid->Kd_rate = 0.2f;
    
    // 限幅设置
    pid->rate_max = 50.0f; // 最大期望角速度±50°/s
    pid->motor_out_max = 2000.0f;
    
    // 初始化偏差变量
    pid->err_angle = 0.0f;
    pid->err_angle_sum = 0.0f;
    pid->err_angle_last = 0.0f;
    
    pid->err_rate = 0.0f;
    pid->err_rate_sum = 0.0f;
    pid->err_rate_last = 0.0f;
}

// 串级PID计算（每10ms调用一次，即100Hz）
float CascadePID_Calc(CascadePID *pid) {
    // 1. 角度环PID计算（输出为期望角速度）
    pid->err_angle = pid->target_angle - pid->actual_angle;
    pid->err_angle_sum += pid->err_angle * 0.01f; // 积分时间0.01s
    // 积分限幅，防止积分饱和
    if(pid->err_angle_sum > 10.0f) pid->err_angle_sum = 10.0f;
    if(pid->err_angle_sum < -10.0f) pid->err_angle_sum = -10.0f;
    
    // 角度环输出（期望角速度）
    pid->target_rate = pid->Kp_angle * pid->err_angle + 
                       pid->Ki_angle * pid->err_angle_sum + 
                       pid->Kd_angle * (pid->err_angle - pid->err_angle_last);
    
    // 期望角速度限幅
    if(pid->target_rate > pid->rate_max) pid->target_rate = pid->rate_max;
    if(pid->target_rate < -pid->rate_max) pid->target_rate = -pid->rate_max;
    
    // 更新上一次角度偏差
    pid->err_angle_last = pid->err_angle;
    
    // 2. 角速度环PID计算（输出为电机控制量）
    pid->err_rate = pid->target_rate - pid->actual_rate;
    pid->err_rate_sum += pid->err_rate * 0.01f;
    // 积分限幅
    if(pid->err_rate_sum > 50.0f) pid->err_rate_sum = 50.0f;
    if(pid->err_rate_sum < -50.0f) pid->err_rate_sum = -50.0f;
    
    // 角速度环输出（电机控制量，单位us）
    float motor_out = pid->Kp_rate * pid->err_rate + 
                     pid->Ki_rate * pid->err_rate_sum + 
                     pid->Kd_rate * (pid->err_rate - pid->err_rate_last);
    
    // 电机输出限幅（适配电调1000-2000us）
    motor_out += 1500.0f; // 基础转速1500us
    if(motor_out > pid->motor_out_max) motor_out = pid->motor_out_max;
    if(motor_out < 1000.0f) motor_out = 1000.0f;
    
    // 更新上一次角速度偏差
    pid->err_rate_last = pid->err_rate;
    
    return motor_out;
}

注：代码仅为核心逻辑示例，实际开发中需结合传感器数据采集、滤波处理、电机混控等模块，根据具体无人机机型调整参数与限幅范围。

六、总结与注意事项

本文从核心原理、协同机制、疑问解析、工程实操四个维度，深入拆解了飞控双环串级PID的设计逻辑，重点解答了"角度环输出为何是期望角速度"的核心疑问，可总结为三点核心结论：

物理意义上：角度偏差的修正，本质是控制转动角速度，角度环的核心任务是根据偏差计算"合适的转动速度"，其输出自然是期望角速度；
控制逻辑上：串级PID的"外环定目标、内环保执行"分工，决定了角度环输出（期望角速度）作为内环输入的合理性；
工程实践上：双环串级PID通过分层控制，解决了单环PID响应慢、抗扰弱的问题，是飞控姿态稳定的最优方案。

最后补充两个工程开发注意事项：

参数整定是关键：双环PID的参数需根据无人机的重量、电机性能、传感器精度调整，没有固定标准，需通过"调参→测试→修正"的循环，逐步优化控制效果；
重视滤波与限幅：传感器噪声、电机振动会干扰控制效果，需对角度、角速度数据进行滤波处理；同时对双环输出进行限幅，避免控制量过大导致失控。

掌握双环串级PID的核心逻辑，不仅能理解飞控姿态控制的底层原理，更能为后续飞控算法的优化（如加入鲁棒控制、自适应PID）、路径规划与姿态控制的协同，奠定坚实的基础。