判断两条线段是否相交（三种算法）



1. ///----------alg 1------------  
2. struct Point  
3. {   
4.     double x, y;  
5. };   
6.   
7. bool between(double a, double X0, double X1)  
8. {  
9.     double temp1= a-X0;  
10.     double temp2= a-X1;  
11.     if ( ( temp1<1e-8 && temp2>-1e-8 ) || ( temp2<1e-6 && temp1>-1e-8 ) )  
12.     {  
13.         return true;  
14.     }  
15.     else  
16.     {  
17.         return false;  
18.     }  
19. }  
20.   
21.   
22. // 判断两条直线段是否有交点，有则计算交点的坐标  
23. // p1,p2是直线一的端点坐标  
24. // p3,p4是直线二的端点坐标  
25. bool detectIntersect(Point p1, Point p2, Point p3, Point p4)  
26. {  
27.     double line_x,line_y; //交点  
28.     if ( (fabs(p1.x-p2.x)<1e-6) && (fabs(p3.x-p4.x)<1e-6) )  
29.     {  
30.         return false;  
31.     }  
32.     else if ( (fabs(p1.x-p2.x)<1e-6) ) //如果直线段p1p2垂直与y轴  
33.     {  
34.         if (between(p1.x,p3.x,p4.x))  
35.         {  
36.             double k = (p4.y-p3.y)/(p4.x-p3.x);  
37.             line_x = p1.x;  
38.             line_y = k*(line_x-p3.x)+p3.y;  
39.   
40.             if (between(line_y,p1.y,p2.y))  
41.             {  
42.                 return true;  
43.             }  
44.             else  
45.             {  
46.                 return false;  
47.             }  
48.         }  
49.         else   
50.         {  
51.             return false;  
52.         }  
53.     }  
54.     else if ( (fabs(p3.x-p4.x)<1e-6) ) //如果直线段p3p4垂直与y轴  
55.     {  
56.         if (between(p3.x,p1.x,p2.x))  
57.         {  
58.             double k = (p2.y-p1.y)/(p2.x-p1.x);  
59.             line_x = p3.x;  
60.             line_y = k*(line_x-p2.x)+p2.y;  
61.   
62.             if (between(line_y,p3.y,p4.y))  
63.             {  
64.                 return true;  
65.             }  
66.             else  
67.             {  
68.                 return false;  
69.             }  
70.         }  
71.         else   
72.         {  
73.             return false;  
74.         }  
75.     }  
76.     else  
77.     {  
78.         double k1 = (p2.y-p1.y)/(p2.x-p1.x);   
79.         double k2 = (p4.y-p3.y)/(p4.x-p3.x);  
80.   
81.         if (fabs(k1-k2)<1e-6)  
82.         {  
83.             return false;  
84.         }  
85.         else   
86.         {  
87.             line_x = ((p3.y - p1.y) - (k2*p3.x - k1*p1.x)) / (k1-k2);  
88.             line_y = k1*(line_x-p1.x)+p1.y;  
89.         }  
90.   
91.         if (between(line_x,p1.x,p2.x)&&between(line_x,p3.x,p4.x))  
92.         {  
93.             return true;  
94.         }  
95.         else   
96.         {  
97.             return false;  
98.         }  
99.     }  
100. }  
101. ///------------alg 1------------  
102. 

///----------alg 1------------ struct Point { double x, y; }; bool between(double a, double X0, double X1) { double temp1= a-X0; double temp2= a-X1; if ( ( temp1<1e-8 && temp2>-1e-8 ) || ( temp2<1e-6 && temp1>-1e-8 ) ) { return true; } else { return false; } } // 判断两条直线段是否有交点，有则计算交点的坐标 // p1,p2是直线一的端点坐标 // p3,p4是直线二的端点坐标 bool detectIntersect(Point p1, Point p2, Point p3, Point p4) { double line_x,line_y; //交点 if ( (fabs(p1.x-p2.x)<1e-6) && (fabs(p3.x-p4.x)<1e-6) ) { return false; } else if ( (fabs(p1.x-p2.x)<1e-6) ) //如果直线段p1p2垂直与y轴 { if (between(p1.x,p3.x,p4.x)) { double k = (p4.y-p3.y)/(p4.x-p3.x); line_x = p1.x; line_y = k*(line_x-p3.x)+p3.y; if (between(line_y,p1.y,p2.y)) { return true; } else { return false; } } else { return false; } } else if ( (fabs(p3.x-p4.x)<1e-6) ) //如果直线段p3p4垂直与y轴 { if (between(p3.x,p1.x,p2.x)) { double k = (p2.y-p1.y)/(p2.x-p1.x); line_x = p3.x; line_y = k*(line_x-p2.x)+p2.y; if (between(line_y,p3.y,p4.y)) { return true; } else { return false; } } else { return false; } } else { double k1 = (p2.y-p1.y)/(p2.x-p1.x); double k2 = (p4.y-p3.y)/(p4.x-p3.x); if (fabs(k1-k2)<1e-6) { return false; } else { line_x = ((p3.y - p1.y) - (k2*p3.x - k1*p1.x)) / (k1-k2); line_y = k1*(line_x-p1.x)+p1.y; } if (between(line_x,p1.x,p2.x)&&between(line_x,p3.x,p4.x)) { return true; } else { return false; } } } ///------------alg 1------------

 

 

算法2：

[cpp] view plain copy print ?

1. ///------------alg 2------------  
2. //叉积  
3. double mult(Point a, Point b, Point c)  
4. {  
5.     return (a.x-c.x)*(b.y-c.y)-(b.x-c.x)*(a.y-c.y);  
6. }  
7.   
8. //aa, bb为一条线段两端点 cc, dd为另一条线段的两端点 相交返回true, 不相交返回false  
9. bool intersect(Point aa, Point bb, Point cc, Point dd)  
10. {  
11.     if ( max(aa.x, bb.x)<min(cc.x, dd.x) )  
12.     {  
13.         return false;  
14.     }  
15.     if ( max(aa.y, bb.y)<min(cc.y, dd.y) )  
16.     {  
17.         return false;  
18.     }  
19.     if ( max(cc.x, dd.x)<min(aa.x, bb.x) )  
20.     {  
21.         return false;  
22.     }  
23.     if ( max(cc.y, dd.y)<min(aa.y, bb.y) )  
24.     {  
25.         return false;  
26.     }  
27.     if ( mult(cc, bb, aa)*mult(bb, dd, aa)<0 )  
28.     {  
29.         return false;  
30.     }  
31.     if ( mult(aa, dd, cc)*mult(dd, bb, cc)<0 )  
32.     {  
33.         return false;  
34.     }  
35.     return true;  
36. }  
37. ///------------alg 2------------  

///------------alg 2------------ //叉积 double mult(Point a, Point b, Point c) { return (a.x-c.x)*(b.y-c.y)-(b.x-c.x)*(a.y-c.y); } //aa, bb为一条线段两端点 cc, dd为另一条线段的两端点 相交返回true, 不相交返回false bool intersect(Point aa, Point bb, Point cc, Point dd) { if ( max(aa.x, bb.x)<min(cc.x, dd.x) ) { return false; } if ( max(aa.y, bb.y)<min(cc.y, dd.y) ) { return false; } if ( max(cc.x, dd.x)<min(aa.x, bb.x) ) { return false; } if ( max(cc.y, dd.y)<min(aa.y, bb.y) ) { return false; } if ( mult(cc, bb, aa)*mult(bb, dd, aa)<0 ) { return false; } if ( mult(aa, dd, cc)*mult(dd, bb, cc)<0 ) { return false; } return true; } ///------------alg 2------------  

 

 

算法3：http://dec3.jlu.edu.cn/webcourse/t000096/graphics/chapter5/01_1.

html

[c-sharp] view plain copy print ?

1. ///------------alg 3------------  
2. double determinant(double v1, double v2, double v3, double v4)  // 行列式  
3. {  
4.     return (v1*v3-v2*v4);  
5. }  
6.   
7. bool intersect3(Point aa, Point bb, Point cc, Point dd)  
8. {  
9.     double delta = determinant(bb.x-aa.x, cc.x-dd.x, bb.y-aa.y, cc.y-dd.y);  
10.     if ( delta<=(1e-6) && delta>=-(1e-6) )  // delta=0，表示两线段重合或平行  
11.     {  
12.         return false;  
13.     }  
14.     double namenda = determinant(cc.x-aa.x, cc.x-dd.x, cc.y-aa.y, cc.y-dd.y) / delta;  
15.     if ( namenda>1 || namenda<0 )  
16.     {  
17.         return false;  
18.     }  
19.     double miu = determinant(bb.x-aa.x, cc.x-aa.x, bb.y-aa.y, cc.y-aa.y) / delta;  
20.     if ( miu>1 || miu<0 )  
21.     {  
22.         return false;  
23.     }  
24.     return true;  
25. }  
26. ///------------alg 3------------  

///------------alg 3------------ double determinant(double v1, double v2, double v3, double v4) // 行列式 { return (v1*v3-v2*v4); } bool intersect3(Point aa, Point bb, Point cc, Point dd) { double delta = determinant(bb.x-aa.x, cc.x-dd.x, bb.y-aa.y, cc.y-dd.y); if ( delta<=(1e-6) && delta>=-(1e-6) ) // delta=0，表示两线段重合或平行 { return false; } double namenda = determinant(cc.x-aa.x, cc.x-dd.x, cc.y-aa.y, cc.y-dd.y) / delta; if ( namenda>1 || namenda<0 ) { return false; } double miu = determinant(bb.x-aa.x, cc.x-aa.x, bb.y-aa.y, cc.y-aa.y) / delta; if ( miu>1 || miu<0 ) { return false; } return true; } ///------------alg 3------------

 

main函数测试：

 

[cpp] view plain copy print ?

1. int main()  
2. {  
3.     Point p1, p2, p3, p4;  
4.     p1.x = 1;  
5.     p1.y = 4;  
6.     p2.x = 3;  
7.     p2.y = 0;  
8.     p3.x = 0;  
9.     p3.y = 1;  
10.     p4.x = 4;  
11.     p4.y = 3;  
12.   
13.   
14.     int i=0, j=0;  
15.     bool flag = false;  
16.     flag = intersect3(p1, p2, p3, p4);  
17.   
18.     // alg 2  
19.     time_t seconds1 = time (NULL);  
20.     for ( ; i!=20000; ++i )  
21.     {  
22.         for ( j=0; j!=60000; ++j )  
23.         {  
24.             flag = detectIntersect(p1, p2, p3, p4);  
25.         }  
26.     }  
27.     time_t seconds2 = time (NULL);  
28.   
29.     cout << "Time used in alg 1:" << seconds2-seconds1 << " seconds." << endl;  
30.   
31.     // alg 2  
32.     time_t seconds3 = time (NULL);  
33.     i=0;  
34.     j=0;  
35.     for ( ; i!=20000; ++i )  
36.     {  
37.         for ( j=0; j!=60000; ++j )  
38.         {  
39.             flag = intersect(p1, p2, p3, p4);  
40.         }  
41.     }  
42.     time_t seconds4 = time (NULL);  
43.     cout << "Time used in alg 2:" << seconds4-seconds3 << " seconds." << endl;  
44.   
45.     // alg 3  
46.     time_t seconds5 = time (NULL);  
47.     i=0;  
48.     j=0;  
49.     for ( ; i!=20000; ++i )  
50.     {  
51.         for ( j=0; j!=60000; ++j )  
52.         {  
53.             flag = intersect3(p1, p2, p3, p4);  
54.         }  
55.     }  
56.     time_t seconds6 = time (NULL);  
57.     cout << "Time used in alg 3:" << seconds6-seconds5 << " seconds." << endl;  
58.     return 0;  
59. }  

int main() { Point p1, p2, p3, p4; p1.x = 1; p1.y = 4; p2.x = 3; p2.y = 0; p3.x = 0; p3.y = 1; p4.x = 4; p4.y = 3; int i=0, j=0; bool flag = false; flag = intersect3(p1, p2, p3, p4); // alg 2 time_t seconds1 = time (NULL); for ( ; i!=20000; ++i ) { for ( j=0; j!=60000; ++j ) { flag = detectIntersect(p1, p2, p3, p4); } } time_t seconds2 = time (NULL); cout << "Time used in alg 1:" << seconds2-seconds1 << " seconds." << endl; // alg 2 time_t seconds3 = time (NULL); i=0; j=0; for ( ; i!=20000; ++i ) { for ( j=0; j!=60000; ++j ) { flag = intersect(p1, p2, p3, p4); } } time_t seconds4 = time (NULL); cout << "Time used in alg 2:" << seconds4-seconds3 << " seconds." << endl; // alg 3 time_t seconds5 = time (NULL); i=0; j=0; for ( ; i!=20000; ++i ) { for ( j=0; j!=60000; ++j ) { flag = intersect3(p1, p2, p3, p4); } } time_t seconds6 = time (NULL); cout << "Time used in alg 3:" << seconds6-seconds5 << " seconds." << endl; return 0; }  

 VS2008编译器环境下测试结果：

Debug模式下： 

alg 1: 315 seconds;

alg 2: 832 seconds;

alg 3: 195 seconds;

 

Release模式下： 

alg 1: 157 seconds;

alg 2: 169 seconds;

alg 3: 122 seconds;

 

 

结论： 使用算法3，时间复杂度最低。