求空间中任意两个直线段的最短距离,matlab实现
空间直线段最短距离计算公式:点到直线段最短距离公式:%求空间中任意两条直线之间的最短距离,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...
原创
2020-03-10 17:12:38 ·
5613 阅读 ·
1 评论