【⽆⼈机导航】复杂环境下的⽆⼈机编队路径规划matlab源码 1 模型介绍
模型参考。
2 部分代码
clear; matlabrc; clc; close all;
addpath(genpath('controllers'))
addpath(genpath('dynamics'))
addpath(genpath('tools'))
% Initial Control gains:
k_ria = 20;  %(inter-agent position)
k_via = .26;  %(inter-agent velocities)
k_rvl = .5; %(virtual-leader position)
k_vvl = .25;  %(virtual-leader velocity)
k_obs = 10;  %(obstacle position)
exp = 4;
gains = [k_ria,k_via,k_rvl,k_vvl,k_obs]';
% Optimize:
options = optimoptions('fmincon','FiniteDifferenceStepSize',1e-1);
% A = [4 0 0 0 30/31.5];
% b = 0;
A =[];
b = [];
Aeq = [];
导航页源码
beq = [];
lb = [0 0 0 0 0];
ub = [];
x = fmincon(@simulate, gains, A,b,Aeq,beq,lb,ub,[], options);
%%
gains = x;
[ts, total_error, broke] = simulate_dev(gains,1);
total_error(total_error == 0) = [];
dt = 1e-1;
num_steps = length(total_error);
tfinal = num_steps*dt;
tspan = dt:dt:tfinal;
%%
figure()
plot(tspan,total_error); hold on
xlabel('Time (sec)')
ylabel('Total Error')
yl = ylim;
plot([broke broke],[yl(1) yl(2)],'--k')
3 仿真结果
4 参考代码
[1]屈耀红, 闫建国. 曲线拟合滤波在⽆⼈机导航数据处理中的应⽤[J]. 系统⼯程与电⼦技术, 2004(12):1912-1914.
博主简介：擅长智能优化算法、神经⽹络预测、信号处理、元胞⾃动机、图像处理、路径规划、⽆⼈机等多种领域的Matlab仿真，相关matlab代码问题可私信交流。
部分理论引⽤⽹络⽂献，若有侵权联系博主删除。

版权声明：本站内容均来自互联网，仅供演示用，请勿用于商业和其他非法用途。如果侵犯了您的权益请与我们联系QQ:729038198，我们将在24小时内删除。