MATLAB YALMIP工具箱调用cplex求解TSPTW

用MATLAB的yalmip工具箱调用CPLEX求解器求解带有时间窗的TSP问题，MATLAB编写代码，可以直接运行，有部分备注描述

function [dij]=distance（pipj）%%[zi bi ri ti][zj bj rj tj]
%%  求任意两场箱位之间的距离:
%%pipj为输入，表示两个点的坐标，以一行向量形式表示;
%%dij为函数的输出:
%%dij表示求出的两点之间的距离结果;
zi=pi（1）;bi=pi（2）;ri=pi（3）;ti=pi（4）;
zj=pj（1）;bj=pj（2）;rj=pj（3）;tj=pj（4）;

if zi~=zj   %跨箱区作业！！
    % stsi  stai
    if  ti == 1 %%第一层的箱子
        stsi=0; %% i到扶梯的距离
        stai=（ri-1）*2.5;%%从某一贝位第一层某位置（扶梯处或第一层其他排位处）到通道的距离
    else %%非第一层的箱子
        stsi=abs（ri-4） *2.5; %% i到扶梯的距离
        stai=（4-1）*2.5;	%%从某一贝位第一层某位置（扶梯处或第一层其他排位处）到通道的距离
    end
    % stsj  staj
    if  tj == 1 %%第一层的箱子
        stsj=0; %% i到扶梯的距离
        staj=（rj-1）*2.5;%%从某一贝位第一层某位置（扶梯处或第一层其他排位处）到通道的距离
    else %%非第一层的箱子
        stsj=abs（rj-4） *2.5; %% i到扶梯的距离
        staj=（4-1）*2.5;	%%从某一贝位第一层某位置（扶梯处或第一层其他排位处）到通道的距离
    end
    %ssi  ssj
    ssi=（ti-1）*2.5; %%i下扶梯的距离
    ssj=（ti-1）*2.5; %%j上扶梯的距离
    %%关于i的 sb1i
    if  bi <=9
        sb1i=（bi-1） *（12+2）; %%从i所在贝位到Bay1的通道距离（大贝）
    elseif  bi>9
        sb1i=（bi-1） *（12+2）+（6+2）; %%从i所在贝位到Bay1的通道距离（小贝）
    end
    %%关于j的 sb1j
    if  bj <=9
        sb1j=（bj-1） *（12+2）; %%从j所在贝位到Bay1的通道距离（大贝）
    elseif  bj>9
        sb1j=（bj-1） *（12+2）+（6+2）; %%从j所在贝位到Bay1的通道距离（小贝）
    end
    zij=abs（zi-zj）*50;
    dij=stsi+ssi+stai+sb1i+zij+sb1j+staj+ssj+stsj;
else        %zi==zj，同一箱区
    if  bi==bj    %同一箱区同一贝位
        if  ti==tj    %同贝同层
            dij=abs（ri-rj）*2.5;
        else       %同贝不同层
            stsi=abs（ri-4）*2.5;
            stsj=abs（rj-4）*2.5;
            ssi=abs（ti-tj）*2.5;
            dij=stsi+ssi+stsj;
        end
    else    %同箱区不同贝
        % stsi  stai
        if  ti == 1 %%第一层的箱子
            stsi=0; %% i到扶梯的距离
            stai=（ri-1）*2.5;%%从某一贝位第一层某位置（扶梯处或第一层其他排位处）到通道的距离
        else %%非第一层的箱子
            stsi=abs（ri-4） *2.5; %% i到扶梯的距离
            stai=（4-1）*2.5;	%%从某一贝位第一层某位置（扶梯处或第一层其他排位处）到通道的距离
        end
        % stsj  staj
        if  tj == 1 %%第一层的箱子
            stsj=0; %% i到扶梯的距离
            staj=（rj-1）*2.5;%%从某一贝位第一层某位置（扶梯处或第一层其他排位处）到通道的距离
        else %%非第一层的箱子
            stsj=abs（rj-4） *2.5; %% i到扶梯的距离
            staj=（4-1）*2.5;	%%从某一贝位第一层某位置（扶梯处或第一层其他排位处）到通道的距离
        end
        ssi=（ti-1）*2.5; %%i下扶梯的距离
        ssj=（ti-1）*2.5; %%j上扶梯的距离
        if  bi<=9&&bj<=9
            sbbij=abs（bi-bj） *（12+2）; %% i和j两贝位通道之间的通道距离（不考虑小贝）
        elseif  bi>=9&&bj>=9
            sbbij=abs（bi-bj） *（6+2）;	%% i和j两贝位通道之间的通道距离（考虑小贝）
        else
            sbbij= （9-min（bibj））*（12+2）+（6+2）; %% i和j两贝位通道之间的通道距离（考虑小贝）
        end
        dij=stsi+ssi+stai+stsj+ssj+staj+sbbij;
    end
end

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----
     文件        3146  2017-08-23 13:31  distance.m
     文件        2351  2017-08-25 10:55  YALMIP_reefer_container_bestRoute.m