1 简介
2 部分代码
%% load map
clear;
ImpRgb = imread('maze.png');
Imp = rgb2gray(ImpRgb);
Imp = im2bw(Imp)*255;
MAX_X=size(Imp,1);
MAX_Y=size(Imp,2);
distanceFcn = @(p1,p2) norm(p1-p2);
%% AStar
GlbTab = zeros(MAX_X, MAX_Y); % 0|new 1|open 2|close
PathTab = zeros(MAX_X, MAX_Y, 2);
nodeStartXY = [1, 1];
nodeTargetXY = [250, 250];
startGn = 0;
startHn = distanceFcn(nodeTargetXY,nodeStartXY);
startFn = startGn + startHn;
% [fn | gn | hn | x | y]
nodeStart = [startFn, startGn, startHn, nodeStartXY];
3 仿真结果
4 参考文献
[1]周毅, 崔刚. 基于机器视觉和A*算法的迷宫机器人路径规划[J]. 微计算机信息, 2010, 26(8):155-156.
博主简介:擅长智能优化算法、神经网络预测、信号处理、元胞自动机、图像处理、路径规划、无人机等多种领域的Matlab仿真,相关matlab代码问题可私信交流。
部分理论引用网络文献,若有侵权联系博主删除。