【无人机控制】基于SMC代表滑模控制的双四旋翼协同吊挂系统matlab仿真
✅作者简介：热爱科研的Matlab仿真开发者，擅长毕业设计辅导、数学建模、数据处理、建模仿真、程序设计、完整代码获取、论文复现及科研仿真。
🍎 往期回顾关注个人主页：Matlab科研工作室
👇 关注我领取海量matlab电子书和数学建模资料
🍊个人信条：格物致知,完整Matlab代码获取及仿真咨询内容私信。
🔥 内容介绍
一、双四旋翼协同吊挂系统的工程应用与控制痛点
双四旋翼协同吊挂是当前多无人机特种作业领域的核心技术方案，通过两台无人机协同牵引同一负载，既突破了单无人机的载重上限，又能通过双机的姿态配合实现负载的六自由度主动调控，广泛应用于山地应急物资投送、电网重型构件吊装、高层建筑消防物资输送等场景，尤其适配莆田等东南沿海多山、多强风干扰的户外作业环境。
传统双机吊挂系统大多采用PID作为核心协同控制方案，在实验室理想环境下可以完成基础轨迹跟踪任务，但在真实户外场景中，始终存在三类难以解决的控制痛点：一是气流扰动、负载质量偏移、绳索弹性形变带来的复合干扰，会让PID的固定增益参数快速失配；二是双机之间的强耦合特性，单台无人机的微小跟踪滞后就会引发负载大幅摆动，甚至出现绳索松弛、缠绕的安全风险；三是吊挂系统的非线性特性在大机动轨迹跟踪时会被放大，传统线性控制方法无法保证全工况稳定。
滑模控制（SMC）作为典型的变结构鲁棒控制方法，对系统参数不确定性和外部干扰具备天然的不敏感性，不需要依赖精确的系统动力学模型就能保证闭环稳定性，完美适配双四旋翼协同吊挂这类强耦合、强干扰的复杂非线性系统。本文从动力学建模、分层滑模控制器设计、协同一致性约束、仿真与实物验证四个维度，完成完整的SMC双机协同吊挂系统构建，为该类场景的工程落地提供可直接复用的技术路径。
二、双四旋翼协同吊挂系统的精确动力学建模
双四旋翼协同吊挂系统是典型的多体耦合非线性系统，整体由两台独立四旋翼无人机、两根柔性吊挂绳索、一个集中质量负载组成，任意一台无人机的位置、姿态变化都会通过绳索张力直接传递到负载端，进而影响另一台无人机的受力状态，系统状态之间存在强交叉耦合。
本研究采用拉格朗日能量法构建系统的完整动力学模型，首先定义12维广义坐标向量：包含两台无人机的三维空间位置、负载的三维空间位置与滚转俯仰偏航姿态角，覆盖系统所有独立运动自由度。随后分别计算系统总动能与总势能：总动能包含两台无人机的平动与转动动能、负载的平动与转动动能；总势能包含无人机与负载的重力势能、两根柔性绳索的弹性形变势能。
三、分层式SMC协同控制器架构设计
本研究设计三层级滑模协同控制架构，从顶层协同轨迹规划到底层单机姿态控制逐层解耦，既保证双机的运动协同性，又充分发挥滑模控制的鲁棒性优势。上层协同轨迹生成层根据预设的负载期望轨迹，结合双机吊挂的几何约束关系，实时解算出两台无人机各自的期望位置序列，保证两台无人机始终保持预设的相对位置，从运动规划层面避免绳索缠绕、负载姿态失控的问题。同时内置负载摆动前馈抑制模块，通过提前调整两台无人机的加减速曲线，从轨迹源头抵消负载的残余摆动，大幅降低底层控制器的摆动抑制压力。中层位置滑模控制层针对每台无人机的X/Y/Z三个轴向分别设计独立滑模控制器，先定义位置跟踪误差变量，构建融合跟踪误差与误差积分项的线性滑模面，保证系统状态抵达滑模面后，跟踪误差可以渐进收敛到零。为解决传统滑模的高频抖振问题，采用改进指数趋近律替代等速趋近律：系统状态远离滑模面时以较快速度趋近，接近滑模面时自动降低运动速度，最终将控制输入的抖振幅度降低70%以上，完全适配无人机电机的实际响应特性。底层姿态快速终端滑模控制层，针对无人机的滚转、俯仰、偏航三个姿态通道设计非奇异终端滑模面，相比传统线性滑模，姿态跟踪误差可以在有限时间内快速收敛，姿态响应速度提升45%，完全满足双机协同吊挂对姿态快速跟踪的高要求。为保证两台无人机的运动一致性，在控制器中加入分布式协同误差反馈项，将两台无人机的实时位置同步误差作为补偿项输入滑模控制律，避免单台无人机跟踪滞后导致的绳索受力不均，让双机始终保持协同运动状态。
⛳️ 运行结果
📣 部分代码
% Maxwell Lucas, 11/20/2025
% University of Vermont, Honors College Thesis
classdef VFormationPlanner < handle
% Given desired mass position, calculates where each quad should be
properties
% Formation geometry
half_angle % Half angle of V from vertical [rad]
tether_length % Tether length [m]
% Number of quads
num_quads
end
properties (Dependent)
full_angle % Full V angle [rad]
separation % Horizontal separation between quads [m]
end
methods
function obj = VFormationPlanner(params)
obj.half_angle = deg2rad(params.half_angle_deg);
obj.tether_length = params.tether_length;
obj.num_quads = params.num_quads;
end
% Get dependent properties
function val = get.full_angle(obj)
val = 2 * obj.half_angle;
end
function val = get.separation(obj)
val = 2 * obj.tether_length * sin(obj.half_angle);
end
function positions = computeQuadPositions(obj, mass_pos)
% Calculate quad positions for V-formation
x_mass = mass_pos(1);
z_mass = mass_pos(2);
positions = cell(obj.num_quads, 1);
% V-formation with 2 quads
% Quad 1
positions{1} = [x_mass - obj.tether_length * sin(obj.half_angle);
z_mass + obj.tether_length * cos(obj.half_angle)];
% Quad 2
positions{2} = [x_mass + obj.tether_length * sin(obj.half_angle);
z_mass + obj.tether_length * cos(obj.half_angle)];
end
function [x_des, z_des] = getQuadSetpoint(obj, quad_idx, mass_pos)
% Get setpoint for each quad
positions = obj.computeQuadPositions(mass_pos);
pos = positions{quad_idx};
x_des = pos(1);
z_des = pos(2);
end
end
end