✅作者简介:热爱科研的Matlab仿真开发者,修心和技术同步精进,matlab项目合作可私信。
🍎个人主页:Matlab科研工作室
🍊个人信条:格物致知。
更多Matlab仿真内容点击👇
⛄ 内容介绍
基于一阶一致性(First-Order Consensus)的有领导多无人机协同编队控制旨在实现在存在领导无人机的情况下多个无人机之间的协同行动。领导无人机负责引导和控制其他从属无人机,使整个编队保持一致的行为。以下是一般实现步骤:
- 确定编队行为和领导指标:定义期望的编队形状、间距和运动规律。确定领导无人机的策略和指标,例如位置或速度等。
- 领导无人机控制:设计领导无人机的控制策略,使其维持期望的运动状态,并提供给从属无人机参考。
- 一阶一致性控制:每个从属无人机通过与相邻无人机交换信息,并根据一阶原则(位置或速度差异的线性组合)来调整自身运动。具体操作可以是调整速度、加入修正项等。
- 信息交流和传递:建立从属无人机之间的通信网络,确保实时信息交流。从属无人机共享领导无人机的状态信息,并根据领导无人机的控制指令调整自身。
- 实时跟踪和更新:每个从属无人机实时性控制策略进行自身动作的调整。
- 异常处理与鲁棒性设计:考虑可能出现的输入错误、通信延迟、传感器误差以及外部干扰等问题。设计异常处理机制和鲁棒控制策略,确保编队控制系统的稳定性和可靠性。
需要注意的是,具体实现方法和控制策略可能因应用场景和需求而有所差异。根据实际情况,还需要考虑无人机的动态特性、通信带宽、路径规划等其他因素来实现高效且可靠的有领导多无人机协同编队控制。
⛄ 部分代码
clcclearclose allt0=0;tf=100; step_qw=0.01;p1=20;q0=[(rand(1)-0.5)*p1;(rand(1)-0.5)*p1; (rand(1)-0.5)*p1;(rand(1)-0.5)*p1; (rand(1)-0.5)*p1;(rand(1)-0.5)*p1; (rand(1)-0.5)*p1;(rand(1)-0.5)*p1; (rand(1)-0.5)*p1;(rand(1)-0.5)*p1 ];%save('q0.mat','q0'); load('q0.mat','q0');[t,q]=ode45('Whole_Twodimension_total_state',t0:step_qw:tf,q0);figure(1);hold onxlabel('x position','FontName','Times New Roman','FontSize',14);ylabel('y position','FontName','Times New Roman','FontSize',14);plot(q(:,1),q(:,2),'g');hold onplot(q(:,3),q(:,4),'r');hold onplot(q(:,5),q(:,6),'b');hold onplot(q(:,7),q(:,8),'k');hold onplot(q(:,9),q(:,10),'c');hold onlegend('leader ','follower 1','follower 2','follower 3','follower 4');plot(q(1,1),q(1,2),'ro');hold onplot(q(1,3),q(1,4),'bo');hold onplot(q(1,5),q(1,6),'bo');hold onplot(q(1,7),q(1,8),'bo');hold onplot(q(1,9),q(1,10),'bo');hold onplot(q(end,1),q(end,2),'rp');hold onbox onfigure(2)hold onxlabel('t/s','FontName','Times New Roman','FontSize',14);ylabel('xi-x0','interpreter','latex','fontsize',14);hold onplot(t,q(:,3)-q(:,1),'r:',t,q(:,4)-q(:,2),'r-');hold onplot(t,q(:,5)-q(:,1),'b:',t,q(:,6)-q(:,2),'b-');hold on;plot(t,q(:,7)-q(:,1),'k:',t,q(:,8)-q(:,2),'k-');hold on;plot(t,q(:,9)-q(:,1),'m:',t,q(:,10)-q(:,2),'m-');hold onlegend('leader ','follower 1','follower 2','follower 3','follower 4');box ongrid off
⛄ 运行结果
⛄ 参考文献
[1] 王瑾.变质量无人机编队控制技术及其在农业植保场景下的应用研究[D].浙江大学[2023-06-29].
[2] 吴宇,梁天骄.基于改进一致性算法的无人机编队控制[J].航空学报, 2020.DOI:10.7527/S1000-6893.2020.23848.
[3] 熊涛,曹科才,柴运,等.基于输入约束一致性算法的多无人机编队控制[J].计算机工程与应用, 2018, 54(12):7.DOI:10.3778/j.issn.1002-8331.1704-0458.