【无人机】多障碍避障轨迹设计的混合整数线性规划（Matlab实现）

最新推荐文章于 2024-11-03 21:07:22 发布

荔枝科研社

最新推荐文章于 2024-11-03 21:07:22 发布

阅读量377

点赞数 8

文章标签：无人机 matlab 开发语言

本文链接：https://blog.csdn.net/weixin_46039719/article/details/136819598

版权

💥💥💞💞欢迎来到本博客❤️❤️💥💥

🏆博主优势：🌞🌞🌞博客内容尽量做到思维缜密，逻辑清晰，为了方便读者。

⛳️座右铭：行百里者，半于九十。

📋📋📋本文目录如下：🎁🎁🎁

目录

💥1 概述

📚2 运行结果

🎉3 参考文献

🌈4 Matlab代码实现

💥1 概述

多障碍避障轨迹设计的混合整数线性规划是一种数学优化方法，用于设计机器人或自动驾驶车辆等智能系统的运动轨迹，以避开多个障碍物。该问题涉及在给定环境中，通过调整机器人或车辆的运动路径，使其在避开多个障碍物的同时达到特定的目标位置。混合整数线性规划（MILP）是一种优化技术，它结合了线性规划和整数规划的特点，能够在考虑连续变量和离散变量的情况下进行优化。

📚2 运行结果

主函数部分代码：

function CollisionMILP5
%%Mixed integer linear programming of trajectory in 3 dimensional space
% with obstacle avoidance. Bounded by initial and final postion and 
% velocity, max thrust, and total time.
% 
% Accepts values for total time (tf), time step (dt), inital and final
% states (x0,v0,xf,vf), max thrust for each axis (uxmax), and mass (m).
% Also accepts the locations of multiple objects to avoid collsion.
clc,close all

%% Inputs
% Simulation time
tf = 30; %sec
dt = 0.5; %sec

% Initial state
x0 = 0; %m
y0 = 20;
z0 = 5;
vx0 = 4; %m/s
vy0 = 0;
vz0 = 0;

% Final state
xf = 40; %m
yf = 40;
zf = 0;
vxf = 0; %m/s
vyf = 0;
vzf = 0;

% Vehicle parameters
uxmax = 0.25; %N
uymax = uxmax;
uzmax = uxmax;
m = 1; %kg

% Restricted area
xbmin = [10 30 15]; %m
ybmin = [10 20 25];
zbmin = [-10 -10 -10];
xbmax = [20 40 25];
ybmax = [20 30 35];
zbmax = [10 7 15] ;

% Safety buffer
d = 0.5; %m

%% Pre-optimization setup
t = 0:dt:tf;
Nsim = length(t)-1;
Nvar = 6*Nsim;
NObjs = length(xbmin);
Nbi = NObjs*Nvar;

alpha = dt/m;
beta = dt^2/m;
g = 0;

% Parameter bounds, function coefficients, integer contraints
lb = zeros(Nvar+Nbi,1);
ub = ones(Nvar+Nbi,1);
f = zeros(Nvar+Nbi,1);
for i = 1:6:Nvar
    ub(i:i+1) = [uxmax;uxmax];
    ub(i+2:i+3) = [uymax;uymax];
    ub(i+4:i+5) = [uzmax;uzmax];
    f(i:i+5) = dt*ones(6,1);