目录手把手教你学 Simulink—— 无人机蜂群目标追踪分布式控制算法仿真一、为什么用“分布式”而不是“中心式”1.1 对比表二、系统总体架构三、关键算法与参数教学默认3.1 控制律结构分布式3.2 关键参数四、Simulink 建模 Step‑by‑StepStep ① —— 目标机动模型Step ② —— 通信拓扑动态生成Step ③ —— 单无人机分布式控制器核心■ 输入■ 控制律MATLAB FunctionStep ④ —— 无人机动力学统一Step ⑤ —— 编队偏移分配环形包围Step ⑥ —— 指标统计五、典型结果判读5.1 匀速目标0~30s5.2 8字机动30~60s5.3 通信半径影响5.4 可扩展性N6 vs N12六、参数调优与常见坑6.1 增益调优稳定性关键6.2 常见坑七、工程扩展方向八、结论九、下一步可继续手把手教你学 Simulink—— 无人机蜂群目标追踪分布式控制算法仿真✅ 本讲目标理解蜂群分布式控制核心一致性Consensus 虚拟结构 局部规则在 Simulink 中用多智能体模块 通信拓扑 控制律 建蜂群实现目标追踪包围/跟随 编队保持 避碰 的分布式算法定量对比集中式 vs 分布式、不同通信半径、目标机动下的表现一、为什么用“分布式”而不是“中心式”1.1 对比表维度中心式Leader‑Follower分布式蜂群单点故障中心失效→全瘫无中心个别失效可容错扩展性差N 大→计算/通信瓶颈好局部通信 O(1)通信需求所有→中心→所有仅邻居实时性中心处理延迟本地快响应任务弹性改中心算法局部规则可涌现全局行为适用小规模、固定编队大规模、动态目标、对抗/搜救 蜂群本质简单局部规则 → 复杂全局行为一致性、包围、覆盖二、系统总体架构┌─────────────┐ │ 目标模型 │ (机动: 匀速/转弯/变速) │ 速度/加速度 │ └──────┬──────┘ │ 目标状态 x_t(t) │ ├──────────────▶ ┌──────────────────┐ │ │ 通信拓扑管理 │ │ │ • 邻接矩阵 A(t) │ │ │ • 通信半径 R_com │ │ │ • 延迟/丢包 │→ neighbor_list_i └──────────────▶ └──────────────────┘ │ ┌──────────────┐ │ 每个无人机 i │ │ (并行子系统) │ │ • 感知邻居状态 │ │ • 一致性协议 │ │ • 追踪编队避碰│→ u_i(t) └──────┬───────┘ │ ┌──────▼───────┐ │ 无人机动力学 │ │ 位置/速度积分 │→ x_i(t) └──────┬───────┘ │ ┌──────▼───────┐ │ 指标统计 │ │ 追踪误差/编队 │ │ 通信负载/碰撞 │ └──────────────┘三、关键算法与参数教学默认3.1 控制律结构分布式每个无人机 i 的控制输入加速度指令u_i u_track_i u_consensus_i u_formation_i u_avoid_i u_obstacle_i项作用公式简化u_track追踪目标K_t·(x_t − x_i) K_tv·(v_t − v_i)u_consensus邻居状态一致位置/速度Σ_j∈N_i a_ij·[(x_j−x_i)(v_j−v_i)]u_formation保持期望相对偏移K_f·(x_j d_ij* − x_i)u_avoid邻居避碰Σ_j K_a·(1/d_ij − 1/d_safe)·n_iju_obstacle静态障碍避让K_o·(1/d_io − 1/d_osafe)·n_io3.2 关键参数参数值无人机数 N6~12通信半径 R_com50~80 m感知半径 R_sense R_com安全间距 d_safe5 m目标速度0~5 m/s 机动追踪增益 K_t0.8一致性增益 K_c0.5编队偏移 d_ij*环形均布半径 15 m控制周期10 ms控制/ 50 ms通信仿真时长120 s四、Simulink 建模 Step‑by‑StepStep ① —— 目标机动模型MATLAB Function多种模式function [xt, yt, vxt, vyt] target_model(t) % 模式匀速→转弯→变速 if t 30 xt 0.5*t; yt 0; vxt 0.5; vyt 0; elseif t 60 % 8字机动 w 0.1; xt 15*sin(w*t); yt 10*sin(2*w*t); vxt 15*w*cos(w*t); vyt 20*w*cos(2*w*t); else % 变速直线 xt 15*sin(6) 0.3*(t-60)*(10.5*sin(0.2*t)); yt 0; vxt 0.3*(10.5*sin(0.2*t)); vyt 0; end endStep ② —— 通信拓扑动态生成核心邻接矩阵 A(t) 随距离变化function A comm_topology(positions, R_com) N size(positions,1); A zeros(N); for i 1:N for j i1:N d norm(positions(i,:) - positions(j,:)); if d R_com A(i,j) 1; A(j,i) 1; end end end endSimulink 实现用MATLAB Function 周期性50 ms更新 A输出给各无人机子系统作为neighbor_list扩展加通信延迟/丢包延迟用 Delay 模块或 buffer丢包随机数 p_drop 则 A_ij0Step ③ —— 单无人机分布式控制器核心每个无人机 i 一个 Subsystem■ 输入自身状态x_i, v_i目标状态x_t, v_t可通过邻居转发或自身偶尔感知邻居状态x_j, v_jj∈N_i期望编队偏移d_i*预先分配如环形均布■ 控制律MATLAB Functionfunction u swarm_control(xi, vi, xt, vt, neigh, di_star, prm) % xi,vi: 自身位置/速度 (1x3) % neigh: 邻居状态结构体数组 % di_star: 期望相对目标偏移 (1x3) % 1. 目标追踪 u_track prm.Kt*(xt - xi) prm.Ktv*(vt - vi); % 2. 一致性位置速度 u_cons [0,0,0]; for j 1:length(neigh) u_cons u_cons (neigh(j).x - xi) (neigh(j).v - vi); end u_cons prm.Kc * u_cons; % 3. 编队相对目标偏移 % 期望位置 目标位置 di_star x_des xt di_star; u_form prm.Kf * (x_des - xi); % 4. 邻居避碰 u_avoid [0,0,0]; for j 1:length(neigh) rij xi - neigh(j).x; d norm(rij); if d prm.d_safe u_avoid u_avoid prm.Ka * (1/d - 1/prm.d_safe) * rij/d; end end % 5. 障碍避让静态 u_obs obstacle_avoid(xi, prm.obstacles, prm); % 总控制 u u_track u_cons u_form u_avoid u_obs; % 限幅 u max(min(u, prm.u_max), -prm.u_max); end关键点无中心 Leader目标信息通过邻居一致性传播或每机间歇感知编队偏移di_star可动态重分配如按 ID 排序环形均布Step ④ —— 无人机动力学统一二阶积分模型教学简化function [xi, vi] uav_dyn(xi, vi, u, dt) % 加速度限幅已在控制律做 vi vi u * dt; xi xi vi * dt; endSimulink 实现每个无人机一个State Space / Integrator 链输入 u_i输出 x_i, v_i 反馈给控制器和拓扑模块Step ⑤ —— 编队偏移分配环形包围初始化时分配function d_star assign_formation(N, radius) d_star zeros(N, 3); for i 1:N ang 2*pi*i/N; d_star(i,:) [radius*cos(ang), radius*sin(ang), 0]; end end动态重分配可选有新成员加入 → 重新均布目标机动快 → 缩小半径Step ⑥ —— 指标统计指标计算追踪误差mean(‖x_i − x_t‖) over all i编队误差mean(‖x_i − (x_t d_i*)‖)碰撞次数min(d_ij) d_collision 的次数通信负载Σ A_ij(t) 随时间积分目标丢失所有 ‖x_i−x_t‖ R_sense 的时长五、典型结果判读5.1 匀速目标0~30s指标数值追踪误差稳态 2 m编队误差 1 m通信连接全连通R_com 足够蜂群快速形成环形包围一致追踪。5.2 8字机动30~60s指标集中式分布式追踪误差峰值3 m4 m稍大但可接受编队保持优良局部变形后恢复通信断链次数—2~3 次短暂自恢复 分布式在强机动下略有误差但无中心失效风险自组织恢复。5.3 通信半径影响R_com连通性追踪误差编队误差30 m频繁断链8 m5 m50 m偶发断链3 m2 m80 m稳定连通1.5 m1 m5.4 可扩展性N6 vs N12N通信负载相对追踪误差编队误差61×2 m1.2 m122.1×非 4×2.3 m1.5 m 分布式通信负载亚线性增长体现 scalability 优势。六、参数调优与常见坑6.1 增益调优稳定性关键增益太小合适太大K_t追踪目标丢失0.5~1.0振荡K_c一致性编队散0.3~0.6高频抖K_f编队编队松0.8~1.2刚性过强K_a避碰碰撞1~3排斥过度调法先调 K_t 让单机跟得上目标加 K_c 让邻居协同加 K_f 形成编队最后加 K_a 避免碰撞逐步增大6.2 常见坑现象原因Fix编队发散K_c 过大或拓扑不连通降 K_c / 增大 R_com目标丢失目标信息未传播加间歇性全局感知或共识加速高频抖动控制周期与通信周期不匹配通信 50ms / 控制 10ms局部聚集避碰增益不均对称 K_a 编队项平衡仿真爆炸增益×N 累积归一化一致性项除以度数七、工程扩展方向✅更真实模型六自由度动力学 姿态控制通信延迟/带宽限制不是简单邻接能量约束电量低→退出蜂群✅算法升级一致性 虚拟结构混合事件触发控制降低通信对抗环境欺骗/干扰下的鲁棒一致性✅任务拓展目标包围 识别载 SAR/光电区域搜索 蜂群覆盖物资投送部分机携带八、结论✅ 你已完成✅ 蜂群分布式控制一致性追踪编队避碰Simulink 实现✅ 动态通信拓扑 目标机动闭环✅ 定量验证分布式在追踪误差略增 20~30% 的前提下获得无中心容错、亚线性通信负载、强可扩展性✅ 明确增益调优顺序与稳定性边界
)
