最短路径源代码matlab

%最短路径算法
clearclc
G=[
    0 20 50 30 inf inf inf ;
    inf 0 25 inf inf 70 inf;
    inf inf 0 40 25 50 inf;
    inf inf inf 0 55 inf inf;
    inf inf inf inf 0 10 70;
    inf inf inf inf inf 0 50;
    inf inf inf inf inf inf 0;
];  %邻接矩阵 
N=size（G1）; %顶点数
v0=1; %源点
v1=ones（1N）; %除去原点后的集合
v1（v0）=0;
%计算和源点最近的点
D=G（v0:）;
while 1
    D2=D;
    for i=1:N
        if v1（i）==0
            D2（i）=inf;
        end
    end
    D2
    [Dmin id]=min（D2）;
    if isinf（Dmin）break