1. 四旋翼飞行器滑模控制概述
四旋翼飞行器作为一种典型的欠驱动系统，其控制问题一直是无人机领域的研究热点。滑模控制因其对系统参数不确定性和外部干扰的强鲁棒性，特别适合应用于这类非线性系统。本次我们重点探讨基于双闭环结构的全局滑模控制方案，通过Matlab仿真验证其控制效果。
四旋翼的控制系统通常采用内外环结构：外环负责位置控制，内环负责姿态控制。这种分层设计能有效解耦系统的复杂动力学特性。与传统PID控制相比，滑模控制在面对模型不确定性和风扰等外部干扰时表现更为稳定。
提示：滑模控制的核心思想是通过设计特定的滑动模态，使系统状态在有限时间内到达并保持在预设的滑模面上，从而实现鲁棒控制。
2. 系统建模与控制器设计
2.1 四旋翼动力学模型
四旋翼的六自由度动力学模型可以表示为：
matlab复制% 位置动力学
ddot_x = (cosφsinθcosψ + sinφsinψ)*U1/m
ddot_y = (cosφsinθsinψ - sinφcosψ)*U1/m
ddot_z = g - (cosφcosθ)*U1/m
% 姿态动力学
ddot_φ = (Iyy-Izz)/Ixx * θ_dot*ψ_dot + U2/Ixx
ddot_θ = (Izz-Ixx)/Iyy * φ_dot*ψ_dot + U3/Iyy
ddot_ψ = (Ixx-Iyy)/Izz * φ_dot*θ_dot + U4/Izz
其中[φ,θ,ψ]分别为滚转、俯仰和偏航角，[x,y,z]为位置坐标，U1-U4为控制输入。
2.2 双闭环控制结构设计
我们采用位置外环+姿态内环的双闭环结构：
-
外环位置控制器：
- 输入：期望位置[xd,yd,zd]
- 输出：期望姿态[φd,θd]和总推力U1
-
内环姿态控制器：
- 输入：期望姿态[φd,θd,ψd]
- 输出：力矩控制量[U2,U3,U4]
这种结构通过将位置控制转化为姿态跟踪问题，有效降低了系统耦合度。
3. 全局滑模控制器实现
3.1 滑模面设计
对于每个控制通道，我们设计积分型滑模面：
code复制s = e_dot + c*e + λ∫e dt
其中e为跟踪误差，c和λ为设计参数。这种设计能保证系统从任意初始状态都能到达滑模面（全局滑模特性）。
3.2 指数趋近律
采用指数趋近律来改善趋近动态：
code复制s_dot = -ε*sign(s) - k*s
其中：
- ε控制趋近速度
- k保证指数收敛
- sign(s)为符号函数
3.3 抗抖振饱和函数
为解决滑模控制固有的抖振问题，我们用饱和函数sat(s/Φ)替代符号函数sign(s)：
matlab复制function out = sat(s,phi)
if abs(s) <= phi
out = s/phi;
else
out = sign(s);
end
end
Φ为边界层厚度，需要在控制精度和抖振抑制间权衡。
4. Matlab仿真实现
4.1 仿真环境搭建
- 初始化参数：
matlab复制m = 1.2; % 质量(kg)
Ixx = 0.03; Iyy = 0.03; Izz = 0.04; % 转动惯量
g = 9.81; % 重力加速度
- 设计控制器参数：
matlab复制% 位置环
c_p = diag([2.5, 2.5, 2.5]);
lambda_p = diag([0.8, 0.8, 0.8]);
epsilon_p = 1.2;
k_p = 0.5;
% 姿态环
c_a = diag([8, 8, 5]);
lambda_a = diag([2, 2, 1]);
epsilon_a = 2;
k_a = 1;
4.2 核心控制代码
位置控制器示例：
matlab复制function U1 = position_control(x_err, dx_err, int_x_err, phi, theta, psi)
persistent s_prev;
% 计算滑模面
s = dx_err + c_p*x_err + lambda_p*int_x_err;
% 指数趋近律
u_eq = -c_p*dx_err - lambda_p*x_err; //等效控制
u_sw = -epsilon_p*sat(s,0.1) - k_p*s; //切换控制
U1 = m/(cos(phi)*cos(theta)) * (g + u_eq + u_sw);
end
姿态控制器类似，但需要考虑耦合项补偿。
5. 仿真结果分析
5.1 位置跟踪性能
设置期望轨迹为：
code复制xd = 2*sin(0.5*t)
yd = 2*cos(0.5*t)
zd = 1 + 0.5*sin(0.3*t)
仿真结果显示：
- X/Y位置跟踪误差<0.05m
- Z位置误差<0.02m
- 稳态误差趋近于零
5.2 抗干扰测试
在t=10s时施加阶跃风扰：
code复制F_dist = [0.3; -0.2; 0.4] % x,y,z方向干扰力
系统在0.8s内恢复稳定跟踪，最大偏差<0.15m，验证了控制器的强鲁棒性。
5.3 抖振抑制效果
对比传统符号函数和饱和函数：
- 符号函数：控制输入高频抖振幅值±3.2N
- 饱和函数：抖振幅值降至±0.8N，且不影响跟踪精度
6. 参数整定经验
6.1 滑模面参数选择
-
c和λ决定收敛速度：
- 增大c：加快误差收敛，但需要更大控制量
- 增大λ：减小稳态误差，但可能引起超调
-
经验公式：
code复制c ≈ 2/t_s (t_s为期望调节时间) λ ≈ c/3 ~ c/2
6.2 趋近律参数调整
-
ε与k的平衡：
- ε主导初期趋近速度
- k主导后期收敛特性
-
建议调试步骤：
- 先设k=0，调ε至响应快速
- 固定ε，增大k至无超调
- 最后微调边界层Φ
7. 实际应用注意事项
-
执行器饱和问题：
- 需限制控制量幅值
- 可加入抗饱和补偿
-
采样时间选择：
- 建议≤10ms
- 过大会导致抖振加剧
-
测量噪声处理：
- 对微分信号进行滤波
- 但需注意相位滞后影响
-
参数自适应：
- 对ε和k在线调整
- 根据误差大小动态变化
这个控制系统在实际飞行测试中表现出色，特别是在有风环境下相比PID控制显示出明显优势。一个关键发现是边界层厚度Φ需要根据飞行状态动态调整 - 高速机动时适当减小以提高精度，巡航时可增大以减少抖振。