90 lines
3.4 KiB
Matlab
90 lines
3.4 KiB
Matlab
function PBCIndex=findPBCIndex(src,dst,dis,mesh)
|
|
%src+dis=dst
|
|
%PBCIndex n*3 1-edgeIndedxOfsrc 2-edgeIndexOfdst 3-+-1
|
|
|
|
%查找src和dst的对应edge索引
|
|
tempSrcTriIndex=findTri(src,mesh);%mesh.tri索引
|
|
tempDstTriIndex=findTri(dst,mesh);
|
|
tempSrcTriCoon=mesh.ConnOfTri(tempSrcTriIndex,:);%mesh.connOfTri数据
|
|
tempDstTriCoon=mesh.ConnOfTri(tempDstTriIndex,:);
|
|
tempNbr=length(tempSrcTriCoon);
|
|
tempSrcEdge=zeros(tempNbr*3,1);%src所有mesh.Edge的索引
|
|
tempDstEdge=zeros(tempNbr*3,1);
|
|
for n=1:tempNbr
|
|
if tempSrcTriCoon(n,2)==1 %123
|
|
tempSrcEdge((n-1)*3+1)=mesh.EdgeOfTet(tempSrcTriCoon(n,1),1);
|
|
tempSrcEdge((n-1)*3+2)=mesh.EdgeOfTet(tempSrcTriCoon(n,1),2);
|
|
tempSrcEdge((n-1)*3+3)=mesh.EdgeOfTet(tempSrcTriCoon(n,1),4);
|
|
elseif tempSrcTriCoon(n,2)==2
|
|
tempSrcEdge((n-1)*3+1)=mesh.EdgeOfTet(tempSrcTriCoon(n,1),1);
|
|
tempSrcEdge((n-1)*3+2)=mesh.EdgeOfTet(tempSrcTriCoon(n,1),3);
|
|
tempSrcEdge((n-1)*3+3)=mesh.EdgeOfTet(tempSrcTriCoon(n,1),5);
|
|
elseif tempSrcTriCoon(n,2)==3
|
|
tempSrcEdge((n-1)*3+1)=mesh.EdgeOfTet(tempSrcTriCoon(n,1),2);
|
|
tempSrcEdge((n-1)*3+2)=mesh.EdgeOfTet(tempSrcTriCoon(n,1),3);
|
|
tempSrcEdge((n-1)*3+3)=mesh.EdgeOfTet(tempSrcTriCoon(n,1),6);
|
|
elseif tempSrcTriCoon(n,2)==4
|
|
tempSrcEdge((n-1)*3+1)=mesh.EdgeOfTet(tempSrcTriCoon(n,1),4);
|
|
tempSrcEdge((n-1)*3+2)=mesh.EdgeOfTet(tempSrcTriCoon(n,1),5);
|
|
tempSrcEdge((n-1)*3+3)=mesh.EdgeOfTet(tempSrcTriCoon(n,1),6);
|
|
end
|
|
|
|
if tempDstTriCoon(n,2)==1 %123
|
|
tempDstEdge((n-1)*3+1)=mesh.EdgeOfTet(tempDstTriCoon(n,1),1);
|
|
tempDstEdge((n-1)*3+2)=mesh.EdgeOfTet(tempDstTriCoon(n,1),2);
|
|
tempDstEdge((n-1)*3+3)=mesh.EdgeOfTet(tempDstTriCoon(n,1),4);
|
|
elseif tempDstTriCoon(n,2)==2
|
|
tempDstEdge((n-1)*3+1)=mesh.EdgeOfTet(tempDstTriCoon(n,1),1);
|
|
tempDstEdge((n-1)*3+2)=mesh.EdgeOfTet(tempDstTriCoon(n,1),3);
|
|
tempDstEdge((n-1)*3+3)=mesh.EdgeOfTet(tempDstTriCoon(n,1),5);
|
|
elseif tempDstTriCoon(n,2)==3
|
|
tempDstEdge((n-1)*3+1)=mesh.EdgeOfTet(tempDstTriCoon(n,1),2);
|
|
tempDstEdge((n-1)*3+2)=mesh.EdgeOfTet(tempDstTriCoon(n,1),3);
|
|
tempDstEdge((n-1)*3+3)=mesh.EdgeOfTet(tempDstTriCoon(n,1),6);
|
|
elseif tempDstTriCoon(n,2)==4
|
|
tempDstEdge((n-1)*3+1)=mesh.EdgeOfTet(tempDstTriCoon(n,1),4);
|
|
tempDstEdge((n-1)*3+2)=mesh.EdgeOfTet(tempDstTriCoon(n,1),5);
|
|
tempDstEdge((n-1)*3+3)=mesh.EdgeOfTet(tempDstTriCoon(n,1),6);
|
|
end
|
|
end
|
|
%去重
|
|
[SrcEdge,~,~]=unique(tempSrcEdge);%src边mesh.edge索引
|
|
[DstEdge,~,~]=unique(tempDstEdge);
|
|
|
|
%查找edge对应
|
|
nbrPBC=length(SrcEdge);
|
|
PBCIndex=zeros(nbrPBC,3);
|
|
PBCIndex(:,1)=SrcEdge;
|
|
%双循环 对比边的距离
|
|
dl=norm(dis);%目标距离差
|
|
err=dl*0.00005;
|
|
for i=1:nbrPBC
|
|
for j=1:nbrPBC
|
|
%边的顶点坐标
|
|
vertex1=mesh.Vertex(mesh.Edge(SrcEdge(i),1),:);
|
|
vertex2=mesh.Vertex(mesh.Edge(SrcEdge(i),2),:);
|
|
vertex3=mesh.Vertex(mesh.Edge(DstEdge(j),1),:);
|
|
vertex4=mesh.Vertex(mesh.Edge(DstEdge(j),2),:);
|
|
%边的距离差
|
|
l1=abs(norm(vertex1-vertex3)-dl);
|
|
l2=abs(norm(vertex2-vertex4)-dl);
|
|
l3=abs(norm(vertex1-vertex4)-dl);
|
|
l4=abs(norm(vertex2-vertex3)-dl);
|
|
|
|
if (l1+l2)<err
|
|
PBCIndex(i,2)=DstEdge(j);
|
|
PBCIndex(i,3)=1;
|
|
break;
|
|
elseif (l3+l4)<err
|
|
PBCIndex(i,2)=DstEdge(j);
|
|
PBCIndex(i,3)=-1;
|
|
break;
|
|
else
|
|
continue;
|
|
end
|
|
end
|
|
end
|
|
|
|
stop=0;
|
|
|
|
end |