MATLAB YALMIP工具箱调用cplex求解TSPTW

function [dij]=distance(pi,pj)%%[zi bi ri ti],[zj bj rj tj] %% 求任意两场箱位之间的距离: %%pi,pj为输入，表示两个点的坐标，以一行向量形式表示; %%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(bi,bj))*(12+2)+(6+2); %% i和j两贝位通道之间的通道距离（考虑小贝） end dij=stsi+ssi+stai+stsj+ssj+staj+sbbij; end end