weixin_43274035的博客

空间直线段最短距离计算公式： 点到直线段最短距离公式： %求空间中任意两条直线之间的最短距离，p1p2是直线段p的两个端点坐标，q1q2是直线段q的两个端点坐标 function [d]=distance(p1,p2,q1,q2) s1=p2-p1;%方向向量 s2=q2-q1; res1=((s1*s2')*((p1-q1)*s2')-(s2*s2')*((p1-q1)*s1'))/((s1*s...