资源简介
基于蚁族算法的二维路径规划算法,可以用于机器人的路径规划问题,寻找最优路径。
代码片段和文件信息
function path = DijkstraPlan(positionsign)
%% 基于Dijkstra算法的路径规划算法
%position input %节点位置
%sign input %节点间是否可达
%path output %规划路径
%% 计算路径距离
cost = ones(size(sign))*10000;
[nm] = size(sign);
for i = 1:n
for j = 1:m
if sign(ij) == 1
cost(ij) = sqrt(sum((position(i:)-position(j:)).^2));
end
end
end
%% 路径开始点
dist = cost(1:); %节点间路径长度
s = zeros(size(dist)); %节点经过标志
s(1) = 1;dist(1) = 0;
path = zeros(size(dist)); %依次经过的节点
path(1:) = 1;
%% 循环寻找路径点
for num = 2:n
% 选择路径长度最小点
mindist = 10000;
for i = 1:length(dist)
if s(i) == 0
if dist(i)< mindist
mindist = dist(i);
u = i;
end
end
end
% 更新点点间路径
s(u) = 1;
for w = 1:length(dist)
if s(i) == 0
if dist(u)+cost(uw) < dist(w)
dist(w) = dist(u)+cost(uw);
path(w) = u;
end
end
end
end
属性 大小 日期 时间 名称
----------- --------- ---------- ----- ----
文件 225 2013-12-20 09:39 基于蚁族算法的二维路径规划算法\barrier.asv
文件 190 2013-12-20 09:44 基于蚁族算法的二维路径规划算法\barrier.txt
文件 1158 2010-11-17 08:41 基于蚁族算法的二维路径规划算法\DijkstraPlan.m
文件 122 2009-07-19 18:08 基于蚁族算法的二维路径规划算法\lines.txt
文件 5599 2014-02-27 09:22 基于蚁族算法的二维路径规划算法\main.asv
文件 5599 2014-03-02 10:57 基于蚁族算法的二维路径规划算法\main.m
文件 989 2009-08-05 18:33 基于蚁族算法的二维路径规划算法\matrix.txt
文件 3730 2013-12-22 19:44 基于蚁族算法的二维路径规划算法\unti
目录 0 2013-12-22 19:44 基于蚁族算法的二维路径规划算法
----------- --------- ---------- ----- ----
17612 9
- 上一篇:汇编语言-推箱子
- 下一篇:dsp2812 ADC程序
相关资源
- Arduino实现可手动绘制路线的智能小车
- 蚁群算法路径规划
- 基于A*算法的路径规划
- 模糊控制在机器人超声避障系统的应
- 移动机器人的路径规划以及避障
- 蚁群算法路径规划蚁群算法路径规划
- Reciprocal Velocity Obstacles for Real-Time Mu
- Astar算法机器人路径规划
- rrt算法改进
- 基于蚁群算法的机器人路径规划源码
- A*全局路径规划器ros
- 基于蚁群算法的三维路径规划
- pso算法路径规划
- Lazy_Theta_star
- 遗传算法进行机器人路径规划代码
- 平面改进RRT算法路径规划
- 基于蚁群算法的路径规划
- 基于蚁群算法的多机器人路径规划
- RRT 随机森林全局路径规划
- 蚁群算法进行三维路径规划
- 3维RRT避障路径规划算法
- 基于蚁群算法的无人机三维路径规划
- 随机快速扩展树RRT路径规划算法代码
- ROS 全局路径规划讲解,以及怎么编写
- 基于PSO移动机器人路径规划算法
- 多机器人路径规划算法
- 智能扫地机器人全覆盖遍历路径规划
- 机械臂避障路径规划仿真 蚁群算法
- D_star Lite.zip
- 移动机器人路径规划
评论
共有 条评论