求带便函数权值的最短路径

Posted 2022-01-06 fpga&matlab

function [distance,path]=zuiduanlujing(D,start1,terminal);
%求带便函数权值的最短路径
%嵌套调用函数
[B,F]=datainfun;    %获得路段距离和公路铁路性质数据数据
for k=1:7
    39+k
    for t=1:15
start1=39+k;
terminal=t;
D=B;    % 赋值
%function [d,EE]=dijkstra(D,start1,end)
[m,n]=size(D);
path=[];
d=inf.*ones(1,m);
d(1,start1)=0;   %用以标记此刻各顶点离集合距离，初始为inf
dd=zeros(1,m);  %标记顶点集合，初始为零
dd(1,start1)=1;  
ind=zeros(1,m);   %给逆向路径数组
y=start1;
length1=zeros(1,m);  %定义初始的各位置的路径长度（包含运输费用的计算）
%DD=zeros(m,m);
%DD(y,y)=1;
time=0;
while length(find(dd==1))<m  %当集合未包含所有的顶点时
    for i=1:m   %以y为起始点时更新d（i）
        if dd(i)==0  
            temp=length1(i);   %记录此长度值
            if(F(y,i)==1)
                length1(i)=length1(y)+B(y,i); %计算长度
            else
                length1(i)=0;    %铁路运输结束
            end
            t=d(i); %标记记录
            % volum=(d(y)-fun(length(y))); %就算公路段前的运输费
            d(i)=min(d(i),fun(length1(i)).*F(y,i)+(d(y)-fun(length1(y))*F(y,i))+D(y,i)*~F(y,i));  %更新tag，包含多方面
            if(t>d(i))  %若变化后d(i)值小于原来值
                ind(i)=y;   %最短路径的前一节点 
            else
                length1(i)=temp;    %恢复长度
            end
        end
    end
    ddd=inf;
    for i=1:m
        if dd(i)==0&&d(i)<ddd  %需要记录所有值
            ddd=d(i);   %有多个点时，取最后一个
            yy=i;
        end
    end
    %yy=find(d==ddd);    %找到这样点的坐标
   % counter=counter+1;
    %DD(y,yy(1,1))=counter;
    %DD(yy(1,1),y)=counter;
    y=yy;
    dd(1,y)=1;

end
here1=terminal;
    while 1 %用于输出路径
        path(end+1)=terminal;
    if ind(terminal)~=0
        terminal=ind(terminal);
    else
        break;
    end
    end
    path=fliplr(path);   %正序输出最短路径
    
    distance=d(here1)
    end
end
end