两点间最短路的Dijkstra算法

%% *****************两点间最短路的Dijkstra算法*********
% 输入：a 表示图的权值矩阵                                                       //
% 输出：d 表示所求最短路的权和                                                 //
% index1 表示标号顶点顺序                                                        //
% index2 表示标号顶点索引                                                        //

%%
function [d index1 index2] = Dijkf(a)

% 参数初始化
M = max(max(a));
pb(1:length(a)) = 0;
pb(1) = 1;
index1 = 1;
index2 = ones(1, length(a));
d(1:length(a)) = M; d(1) = 0; temp = 1;
% 更新t(x),同时记录顶点顺序和顶点索引
while sum(pb) < length(a)
    tb = find(pb == 0);
    d(tb) = min(d(tb), d(temp) + a(temp, tb));
    tmpb = find(d(tb) == min(d(tb)));
    temp = tb(tmpb(1));   % tmpb可能有多个
    pb(temp) = 1;
    index1 = [index1, temp];
    index = index1(find(d(index1) == d(temp) - a(temp, index1)));
    if length(index) >= 2
        index = index(1);
    end
    index2(temp) = index;
end
index1;
index2;