基于几何图形搭建障碍物地图的方法(MATLAB)

您所在的位置:网站首页 matlab如何导入地图信息 基于几何图形搭建障碍物地图的方法(MATLAB)

基于几何图形搭建障碍物地图的方法(MATLAB)

2024-07-14 09:05| 来源: 网络整理| 查看: 265

讲解一下,我的算法,基于几何图形搭建的障碍物地图的算法,一般使用在移动机器人路径规划或者地图构建的领域,算法是由matlab编写的,代码会提供下载链接,关于代码的讲解,现在开始。

1   基于几何图形搭建的障碍物地图的算法构建的障碍物图形如下图1所示:

                                           

                                                                                                图1

其中黑色线条围成的蓝色区域,即为障碍物区域,这些基本的几何图形构成了障碍物区域,本算法主要采用的是线性规划的原理构建的障碍物信息。如下所示,

                              

由这四条 直线构成的图形所围成的区域可以通过我写的Barrier函数完成障碍物区域的构建,你只需要先计算出构成你的障碍物图形的每一条边的直线方程即可,代码如下,

function [numbarrier,quadrantBarrier] = Barrier( x,y,confine) %构建障碍物区域 %输入参数 % x----x轴坐标 % y----y轴坐标 % confine----地图边界 % 输出参数 % orderBarrier----返回改点在第几象限 % numbarrier----该象限第几个障碍物,若numbarrier == 32代表到达地图边界,若numbarrier==0代表不在障碍物区域,numbarrier = 16,代表坐标轴 %% quadrant = 0; numbarrier = 0; quadrantBarrier = 0; %判断点在哪一个象限 if x >= 0 && y >= 0 quadrant = 1; elseif x < 0 && y > 0 quadrant = 2; elseif x < 0 && y < 0 quadrant = 3; else quadrant = 4; end switch (quadrant) case 1 quadrantBarrier = 1; %第一象限 if x = confine numbarrier = 32; end if x-2-y


【本文地址】


今日新闻


推荐新闻


CopyRight 2018-2019 办公设备维修网 版权所有 豫ICP备15022753号-3