Matlab编程实现迪杰斯特拉算法Dijkstra算法

function[P,d] = fun_Dijkstra(G,start,End)
% 建立权重矩阵
% 判断是否存在权重矩阵，如果不存在，那么默认权重为1
[n,m] = size(G.Edges);x = length(unique(G.Edges.EndNodes));
W(1:x,1:x) = inf;W(logical(eye(size(W)))) = 0; % 初始化权重矩阵W,对角线赋值为0

if m ==1
    for i = 1:n
        W(G.Edges.EndNodes(i,1),G.Edges.EndNodes(i,2)) = 1; 
        
        try
            if class(G) == 'graph' % 如果为有向图，那么该权重矩阵为对称
                W(G.Edges.EndNodes(i,2),G.Edges.EndNodes(i,1)) = W(G.Edges.EndNodes(i,1),G.Edges.EndNodes(i,2));
            end
        end
    end
elseif m == 2
    for i = 1:n
        W(G.Edges.EndNodes(i,1),G.Edges.EndNodes(i,2)) = G.Edges.Weight(i);
        try
            if class(G) == 'graph' % 如果为有向图，那么该权重矩阵为对称
                W(G.Edges.EndNodes(i,2),G.Edges.EndNodes(i,1)) = W(G.Edges.EndNodes(i,1),G.Edges.EndNodes(i,2));
            end
        end
    end
end


% 建立距离矩阵Distend 父节点矩阵Parent 是否已访问矩阵Visit
% 初始化距离矩阵，默认初始距离为无穷,起始点距离为0
D(1,1:x) = inf;D(1,start) = 0;D_ = D; % D_为D的傀儡
% 初始化父节点矩阵为0
Parent = zeros(1,x);
% 初始化访问矩阵 为访问完成为0，访问完成为1
Visit = zeros(1,x);

% 计算起始点到每个点的最短距离
for i = 1:x
    [~,index] = min(D_);
    for j = 1:x
        if W(index,j) ~= inf && W(index,j) ~= 0 && Visit(j) == 0
            distent = W(index,j) + D(index);
            if distent < D(j)
                D(j) = distent;D_(j) = distent;
                Parent(j) = index; % 更新父节点
            end
        end     
    end
    Visit(index) = 1;D_(index) =inf; %这里把已访问过的节点距离设为inf方便之后查询D的最短路径时排除已访问过的节点
end
% 得到最短路径
d = D(End);
% 得到父节点们
% 初始化路径
P = [];
p = Parent(End);
for i = 1:x
    if any(P==start) == 0
        P(1,i) = p;
        p = Parent(p);
    end
end
P = fliplr(P);P(1,end+1) =End;
end