dijkstra算法matlab程序_Dijkstra算法例子
在Dijkstra算法代码下载本文涉及到的代码。
程序代码
Dijkstra算法的程序如下:
function [d, p] = dijkstra(adj, s, t)
% 使用dijkstra求最短路径
% adj 输入 矩阵 邻接矩阵
% s 输入 整数 起点
% t 输入 整数 或 [] 终点
% d 输出 向量 路径长度,若t==[],则返回从起点到所有节点的路径长度
% p 输出 向量 或 元胞 路径,若t==[],则返回从起点到所有节点的路径(cell)
nodes_num = size(adj, 1);
dist = inf(nodes_num, 1);
previous = inf(nodes_num, 1);
Q = [1:nodes_num]';% 求邻居
neighbors = cell(nodes_num, 1);
for i = 1:nodes_num; neighbors{i} = find(adj(i, :) > 0); enddist(s) = 0;
while ~isempty(Q)% 取出距离最小点[~, min_ind] = min(dist(Q));min_node = Q(min_ind);Q = setdiff(Q, min_node);% 若是终点,则结束程序if min_node == td = dist(min_node);p = generate_path(previous, t);return;end% 更新邻居的距离for i = 1:length(neighbors{min_node})neighbor = neighbors{min_node}(i);alt = dist(min_node) + adj(min_node, neighbor);if alt < dist(neighbor)dist(neighbor) = alt;previous(neighbor) = min_node;endend
end
d = dist;
p = cell(nodes_num, 1);
for i = 1:nodes_num; p{i} = generate_path(previous, i); end
end% 由前趋推出路径
function path = generate_path(previous, t)
path = [t];
while previous(t) <= length(previous)path = [previous(t) path];t = previous(t);
end
end
找图中顶点间最短距离
在这样一张图中,找到从A到D的最短距离和路径。构造邻接矩阵如下:
adj = [0 12 0 0 0 16 14;12 0 10 0 0 7 0;0 10 0 3 5 6 0;0 0 3 0 4 0 0;0 0 5 4 0 2 8;16 7 6 0 2 0 9;14 0 0 0 8 9 0];
指定起点和终点,使用上面的程序计算即可:
[dist, path] = dijkstra(adj, 1, 4);
结果如下:
最短距离: 22.00
路径 : 'A' 'F' 'E' 'D'
找栅格地图中两点间最短距离
如下图所示栅格地图,指定起点和终点,智能体(或机器人)只能在“上、下、左、右”四个方向移动,找出最短路径:
结果如下:
可以直接提供邻接矩阵给上面的程序,但是需要修改程序中求邻居的部分(四个方向相邻栅格中不是障碍物的栅格),同时还需要在程序中对某栅格是否是障碍物进行判断,因为是障碍物的话程序不需要对该栅格进行规划。
也可以为程序提供栅格数量(除障碍物)和每个栅格的邻居,删除程序中求邻居的部分,修改程序中邻居间的距离(比如为1)即可。
dijkstra算法matlab程序_Dijkstra算法例子相关推荐
- bfgs算法matlab程序,bfgs算法matlab代码
(对 Large -scale 问题) 对应文件 \\toolbox\\matlab\\funfun\\fminbnd.m \\toolbox\\optim\\sfminbx.m \\toolbox\ ...
- 爬山算法matlab程序,爬山算法和模拟退火算法
爬山算法 大体思路 爬山算法即是模拟爬山的过程,随机选择一个位置爬山,每次朝着更高的方向移动,直到到达山顶 具体操作 把当前的节点和要走的节点的值进行比较. 如果当前节点是最大的,那么不进行操作:反之 ...
- dijkstra的matlab程序,最短路径算法dijkstra的matlab程序,让大家来找茬,交流
%初始化 MAXNUM=5; MAXINT=32767; dij=MAXINT*ones(MAXNUM,MAXNUM); dij(1,2)=10; dij(1,4)=30; dij(1,5)=100; ...
- ncut算法matlab程序,Ncut算法的MATLAB代码下载及实现在MATLAB上正常运行
这里我所使用的平台是:win7(64bit)+MATLAB2014a(64bit) Ncut算法全称应该是:Multiscale Normalized Cut image segmentation,是 ...
- simple算法matlab程序,metropolis算法的简单c++实现以及matlab实现
标签:算法metropolis是一种采样方法,一般用于获取某些拥有某些比较复杂的概率分布的样本. 1.采样最基本的是随机数的生成,一般是生成具有均匀分布的随机数,比如C++里面的rand函数,可以直接 ...
- 亮度均匀性 matlab,求:亮度保持的夜景图像直方图均衡算法 matlab程序
该楼层疑似违规已被系统折叠 隐藏此楼查看此楼 求:亮度保持的夜景图像直方图均衡算法 matlab程序 我是大四学生,最近在做一个论文,头疼死了,不知道这个论文的程序怎么写.这里是matlab论坛 我想 ...
- 标准差分进化算法matlab程序实现(转载)
标准差分进化算法matlab程序实现 自适应差分演化算法方面的Matlab和C++代码及论文 差分进化算法 DE-Differential Evolution matlab练习程序(差异演化DE) [ ...
- 极值滤波matlab,极值滤波算法MATLAB程序及处理结果对比
<极值滤波算法MATLAB程序及处理结果对比>由会员分享,可在线阅读,更多相关<极值滤波算法MATLAB程序及处理结果对比(5页珍藏版)>请在人人文库网上搜索. 1.极值滤波算 ...
- 鲍威尔法源程序码matlab,鲍威尔算法matlab程序f.doc
鲍威尔算法matlab程序f.doc functionf=fun(x)f=10*(x(1)+x(2)-5)^2+(x(1)-x(2))^2;functionf=fx(x0,alpha,s)x1=x0+ ...
最新文章
- 301 Remove Invalid Parentheses 删除无效的括号
- 维塔与 Magic Leap 的MR游戏发布概念片
- mysql 的条件 if else_使用If else条件在mysql中选择列?
- 网址http格式的拆分
- 量子计算机打破智子封锁,人类科技会被“智子”锁死?来看量子计算机如何打破技术壁垒...
- jvm_虚拟机参数讲解(三)
- loading怎么关闭 vant_vant-ui组件调用Dialog弹窗异步关闭操作
- HDU2167 Pebbles(状压DP)
- 一个类加载的谜团解决了
- mac下安装elasticsearch
- 安卓案例:利用帧动画动态显示时间
- 安装第三方插件BeautifulSoup
- 在过程中要正式批准可交付成果_2014年PMP考试模拟题
- elementUI---使用按钮切换折叠侧边栏
- 耐福-NTP8849音频功放芯片有哪些功能?
- 2021暑假Leetcode刷题——Two Pointers(3)
- vulnhub——XXE练习
- 百里挑一,4款免费又实用的软件,用一次就爱上
- android 采集音频输出,Android系统分析之Audio音频流, 音频策略, 输出设备之间的关系...
- Tensorflow2 图像分类-Flowers数据及分类代码详解