[发明专利]一种三维场景自动寻找线段交点的方法

权利要求书

1.一种三维场景自动寻找线段交点的方法，其包括：

两条相交线段m和n，m的两个端点三维坐标分别为pA，pB，n的两个端点三维坐标分别为pC，pD；

将pB减pA得到矢量a，将pD减pC得矢量b，将pC减pA得矢量c；

叉乘矢量a和矢量b得到矢量c1，叉乘矢量c和矢量b得到矢量c2；

点乘矢量c1和矢量c2得到标量c3；

计算矢量c1的长度的平方得到标量c4，将标量c3除以标量c4得到标量c5；

将矢量a乘以标量c5得到矢量c6，将矢量c6加上坐标点pA得到交点坐标pI。

2.根据权利要求1所述的方法，其特征在于，对于两条未知是否相交的线段m和n，所述自动寻找线段交点的方法进一步包括：

将pA减pI得到得到矢量n1，将pB减pI得到矢量n2，算出n1的法线向量n3，算出n2的法线向量n4，计算n3和n4的点积d；

将pC减pI得到得到矢量m1，将pD减pI得到矢量m2，算出矢量m1的法线向量m3，算出矢量m2的法线向量m4，计算m3和m4的点积d1；和

如果d和d1都等于0则两个线段相交，交点坐标就是pI，否则两个线段不相交。