通过MATLAB实现基于dijkstra算法的障碍物规避功能

630 篇文章 1035 订阅 ¥39.90 ¥99.00

目录

1.算法概述

2.仿真效果

3.MATLAB仿真源码


1.算法概述

 Dijkstra(迪杰斯特拉)算法是典型的最短路径路由算法,用于计算一个节点到其他所有节点的最短路径。主要特点是以起始点为中心向外层层扩展,直到扩展到终点为止(BFS、prime算法都有类似思想)。Dijkstra算法能得出最短路径的最优解,但由于它遍历计算的节点很多,所以效率低。

算法描述

(1)S为已经找到的从v出发的最短路径的终点集合,它的初始状态为空集,将源点加入S中。 其余顶点构成集合U。

(2)构建源点到其余顶点的距离列表,与源点不相连的顶点距离记为∞。

(3)广度遍历与源点相连的顶点,找到距离最近的顶点,则到这个顶点的最短路径就确定了,最短距离就是当前距离,将这个顶点从U中拿出,放入S中。

(4)用当前的顶点作为中间点,对其进行广度遍历,对遍历到的顶点距离进行更新。

(5)在U中搜索最短距离的顶点,将其放入S。

(6)以这个节点作为中间点广度搜索,更新距离。

(7)重复这个过程,直至U为空。

2.仿真效果

  • 1
    点赞
  • 0
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 0
    评论
以下是使用Dijkstra算法求解迷宫问题的MATLAB代码实现,假设迷宫是一个二维矩阵maze,其中0表示可以通过的通路,1表示障碍物,起点为(startx, starty),终点为(endx, endy): ```matlab function [path, dist] = dijkstra_maze(maze, startx, starty, endx, endy) % Dijkstra算法求解迷宫问题 n = size(maze, 1) * size(maze, 2); dist = ones(n, 1) * inf; % 到起点的距离初始化为无穷大 visited = zeros(n, 1); % 记录节点是否已被访问过 prev = zeros(n, 1); % 记录每个节点的前驱节点 dist((startx-1)*size(maze, 2)+starty) = 0; % 起点到自己的距离为0 while sum(visited) < n % 如果还有节点未被访问过 % 找到未被访问过的离起点最近的节点 mindist = inf; for i = 1:n if ~visited(i) && dist(i) < mindist mindist = dist(i); u = i; end end visited(u) = 1; % 标记该节点为已访问 if u == (endx-1)*size(maze, 2)+endy % 如果已经找到终点 break; end % 更新与该节点相邻的节点的距离 x = floor((u-1) / size(maze, 2)) + 1; y = mod(u-1, size(maze, 2)) + 1; for i = max(1, x-1) : min(size(maze, 1), x+1) for j = max(1, y-1) : min(size(maze, 2), y+1) if i == x && j == y % 不考虑自己 continue; end if maze(i, j) == 1 % 是障碍物 continue; end v = (i-1)*size(maze, 2) + j; alt = dist(u) + sqrt((i-x)^2 + (j-y)^2); % 计算新的距离 if alt < dist(v) % 如果新的距离更短 dist(v) = alt; prev(v) = u; end end end end % 构造最短路径 if visited((endx-1)*size(maze, 2)+endy) path = [endx endy]; u = (endx-1)*size(maze, 2)+endy; while prev(u) ~= 0 x = floor((prev(u)-1) / size(maze, 2)) + 1; y = mod(prev(u)-1, size(maze, 2)) + 1; path = [x y; path]; u = prev(u); end else path = []; end ``` 其中,使用了欧几里得距离计算节点之间的距离。如果只考虑上下左右四个方向的相邻节点,可以将sqrt((i-x)^2 + (j-y)^2)改为1。

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

Simuworld

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值