判断同一平面内任意两线段是否相交的方法

本文给出一种判断同一平面内两线段相交的判定方法。如下图：

如果两线段相交，则两线段必然相互跨立对方。
若P1P2跨立Q1Q2 ，则矢量(P1-Q1)和( P2 - Q1)位于矢量(Q2 - Q1)的两侧，
即((P1-Q1)×(Q2-Q1))*((P2-Q1)×(Q2 -Q1))< 0。
上式可改写成((P1-Q1)×(Q2-Q1))*(( Q2 -Q1)×(P2-Q1 )) > 0。
当(P1-Q1)×(Q2 - Q1)= 0 时，说明 (P1 - Q1 ) 和(Q2 - Q1)共线， 但是因为已经通过快速排斥试验，所以P1一定在线段 Q1Q2上；
同理，(Q2-Q1)×(P2-Q1)=0说明P2一定在线段Q1Q2上。
所以判断P1P2跨立Q1Q2的依据是：
((P1- Q1)×(Q2 - Q1))**((Q2 -Q1)×(P2-Q1))>=0。
同理判断Q1Q2跨立P1P2的依据是：
(Q1-P1 )×(P2-P1)*(P2 -P1)×(Q2 - P1) >= 0。

代码实现：

#include <iostream> #include <math.h> using namespace std; #define ABS_FLOAT_0 0.0001 struct pointf { float x; float y; }; struct Vectorf3D { float x; float y; float z; }; bool IsIntersectLine( const pointf p1, // 线段1起点 const pointf p2, // 线段1终点 const pointf q1, // 线段2起点 const pointf q2 // 线段2终点 ) { Vectorf3D v1, v2, v3, v4; v1.x = (p1.x - q1.x); v1.y = (p1.y - q1.y); v1.z = 0.0; v2.x = (q2.x - q1.x); v2.y = (q2.y - q1.y); v2.z = 0.0; //计算v1,v2的叉乘 v3.x = v1.y * v2.z - v1.z * v2.y; v3.y = v1.z * v2.x - v1.x * v2.z; v3.z = v1.x * v2.y - v1.y * v2.x; v1.x = (p2.x - q1.x); v1.y = (p2.y - q1.y); v1.z = 0.0; //计算v2,v1的叉乘 v4.x = v2.y * v1.z - v2.z * v1.y; v4.y = v2.z * v1.x - v2.x * v1.z; v4.z = v2.x * v1.y - v2.y * v1.x; // 计算v3,v4的点积 float fTemp1 = v3.x * v4.x + v3.y * v4.y + v3.z * v4.z; v1.x = (q1.x - p1.x); v1.y = (q1.y - p1.y); v1.z = 0.0; v2.x = (p2.x - p1.x); v2.y = (p2.y - p1.y); v2.z = 0.0; //计算v1,v2的叉乘 v3.x = v1.y * v2.z - v1.z * v2.y; v3.y = v1.z * v2.x - v1.x * v2.z; v3.z = v1.x * v2.y - v1.y * v2.x; v1.x = (q2.x - p1.x); v1.y = (q2.y - p1.y); v1.z = 0.0; //计算v2,v1的叉乘 v4.x = v2.y * v1.z - v2.z * v1.y; v4.y = v2.z * v1.x - v2.x * v1.z; v4.z = v2.x * v1.y - v2.y * v1.x; // 计算v3,v4的点积 float fTemp2 = v3.x * v4.x + v3.y * v4.y + v3.z * v4.z; if ((fTemp1 >= ABS_FLOAT_0) && (fTemp2 >= ABS_FLOAT_0)) { return true; } else { return false; } } void main(void) { pointf p1, p2, q1, q2; p1.x = 0.0; p1.y = 0.0; p2.x = 30.0; p2.y = 30.0; q1.x = 0.0; q1.y = 20.0; q2.x = 20.0; q2.y = 0.0; if (IsIntersectLine(p1, p2, q1, q2)) { cout<<"线段相交!"<<endl; } else { cout<<"线段不相交!"<<endl; } }