【最短路】必须通过两个指定点的最短路径算法及其matlab实现

代码来源：《图论算法及其matlab实现》（北京航空航天出版社）

P25

 

 

 

首先，函数n2shorf用来计算任意两点之间最短路径长度及最短路经过的节点

 

需输入起点、终点

 

function [ P u] = n2shorf( W,k1,k2)

%W表示权值矩阵
%k1表示始点，k2表示终点
%P表示两顶点之间最短路，u表示最短路的距离


%初始化
n=length(W);
U=W;
m=1;
%Floyd算法思想
while m<=n
    for i=1:n
        for j=1:n
            if U(i,j)>U(i,m)+U(m,j)
                U(i,j)=U(i,m)+U(m,j);
            end
        end
    end
    m=m+1;
end
u=U(k1,k2);%最短路的距离

%求任意给定两个顶点的最短路包含的顶点

P1=zeros(1,n);
k=1;
P1(k)=k2;
V=ones(1,n)*inf;
kk=k2;
while kk~=k1
    for i=1:n
        V(1,i)=U(k1,kk)-W(i,kk);
        if V(1,i)==U(k1,i)
            P1(k+1)=i;
            kk=i;
            k=k+1;
        end
    end
end
k=1;
wrow=find(P1~=0);
for j=length(wrow):(-1):1
    P(k)=P1(wrow(j));
    k=k+1;
end



end

 

 

接下来，cn2shorf函数用来寻找通过指定两个点的最短路径

需要输入起点、终点

需要通过的两个点

 

function [P d]=cn2shorf(W,k1,k2,t1,t2)
% 必须通过指定的两个点的最短路
% function [P d]=cn2shorf(W,k1,k2,t1,t2)
% W 图的权值矩阵 k1 始点 k2 终点 t1 指定的点1 t2 指定的点2
% P 最终得到的路
% d 路的长度
% 路中的重复点记做一个点
[p1 d1]=n2shorf(W,k1,t1);  % 计算k1,t1之间的最短路
[p2 d2]=n2shorf(W,t1,t2);  % 计算t1,t2之间的最短路
[p3 d3]=n2shorf(W,t2,k2);  % 计算t2,k2之间的最短路
dt1=d1+d2+d3;
[p4 d4]=n2shorf(W,k1,t2);  % 计算k1,t2之间的最短路
[p5 d5]=n2shorf(W,t2,t1);  % 计算t2,t1之间的最短路
[p6 d6]=n2shorf(W,t1,k2);  % 计算t1,k2之间的最短路
dt2=d4+d5+d6;
% 比较两个和值
if dt1<dt2
    d=dt1;
    P=[p1 p2(2:length(p2)) p3(2:length(p3))];
else 
    d=dt2;
    P=[p4 p5(2:length(p5)) p6(2:length(p6))];
end
P;
d;

 

 

 

检验一下

 

clc
W=[0 1 inf 2 inf 6;
    2 0 4 inf inf inf;
    inf 3 0 inf inf 2;
    inf 1 inf 0 3 inf;
    inf inf inf 2 0 1;
    inf inf 3 inf 1 0];

%有向图始点为3终点为4，必须经过1、6两点
k1=3;
k2=4;
t1=1;
t2=6;
[P d]=cn2shorf(W,k1,k2,t1,t2)

运行结果：

P =

     3     6     5     4     2     1     1     4


d =

    10