无人机姿态控制与双环PID的工程实践

1. 无人机姿态控制与双环PID的工程实践

四旋翼无人机的姿态控制一直是飞控系统设计的核心难点。在实际工程中，我们常采用双环PID控制结构来实现稳定控制。内环（角速度环）负责快速响应电机扰动，外环（角度环）确保姿态跟踪精度。这种结构能有效解决单环PID在动态响应和稳态精度之间的矛盾。

关键经验：角速度环的采样周期通常设置为角度环的1/5~1/10，实测表明2ms的内环周期配合10ms的外环周期能获得最佳控制效果。

1.1 控制结构设计要点

典型的串级控制框图包含以下关键环节：

1. 角度环接收期望姿态角（φ_d,θ_d,ψ_d）与当前姿态的误差
2. 经过外环PID计算后输出角速度期望值（p_d,q_d,r_d）
3. 角速度环根据误差输出电机控制量（M1-M4）

matlab复制% 外环PID示例代码
function torque = angle_PID(error, dt)
    persistent integral prev_error;
    
    % PID参数
    Kp = 1.2; 
    Ki = 0.05;
    Kd = 0.3;
    
    integral = integral + error*dt;
    derivative = (error - prev_error)/dt;
    
    torque = Kp*error + Ki*integral + Kd*derivative;
    prev_error = error;
end

1.2 角速度限幅的工程考量

内环角速度限幅值直接影响飞行性能和安全：

• 经验值通常设为±300°/s（约5.23rad/s）
• 大疆Mavic系列实测限幅为±400°/s
• 穿越机可达±1000°/s以上

调试技巧：先用50%的保守值开始测试，逐步提高直到出现振荡再回退20%作为最终值。

2. 无人机运动学建模关键步骤

2.1 坐标系定义与转换

建立完整的运动学模型需要三个坐标系：

1. 机体坐标系（Body Frame）
2. 地面坐标系（Earth Frame）
3. 惯性坐标系（Inertial Frame）

坐标转换矩阵（以俯仰角θ为例）：

code复制R_x(θ) = [1,