平面内两条线段的位置关系(相交)判定与交点求解

http://www.cnblogs.com/devymex/archive/2010/08/19/1803885.html

概念

平面内两条线段位置关系的判定在很多领域都有着广泛的应用，比如游戏、CAD、图形处理等，而两线段交点的求解又是该算法中重要的一环。本文将尽可能用通俗的语言详细的描述一种主流且性能较高的判定算法。

外积，又称叉积，是向量代数（解析几何）中的一个概念。两个二维向量v₁(x₁, y₁)和v₂(x₂, y₂)的外积v₁×v₂=x₁y₂-y₁x₂。如果由v₁到v₂是顺时针转动，外积为负，反之为正，为0表示二者方向相同（平行）。此外，文中涉及行例式和方程组的概念，请参阅线性代数的相关内容。

为方便计算，对坐标点的大小比较作如下定义：x坐标较大的点为大，x坐标相等但y坐标较大的为大，x与y都相等的点相等。一条线段中较小的一端为起点，较大的一端为终点。

 

问题

给定两条线段的端点坐标，求其位置关系，并求出交点（如果存在）。

 

分析

两条线段的位置关系大体上可以分为三类：有重合部分、无重合部分但有交点（相交）、无交点。为避免精度问题，首先要将所有存在重合的情况排除。

重合可分为：完全重合、一端重合、部分重合三种情况。显然，两条线段的起止点都相同即为完全重合；只有起点相同或只有终点相同的为一端重合（注意：坐标较小的一条线段的终点与坐标较大的一条线段的起点相同时应判定为相交）。要判断是否部分重合，必须先判断是否平行。设线段L₁(p₁->p₂)和L₂(p₃->p₄)，其中p1(x₁, y₁)为第一条线段的起点，p₂(x₂, y₂)为第一条线段的终点，p₃(x₃, y₃)为第二条线段的起点，p₄(x₄, y₄)为第二段线段的终点，由此可构造两个向量：

• v₁(x₂-x₁, y₂-y₁)，v₂(x₄-x₃, y₄-y₃)

若v₁与v₂的外积v₁×v₂为0，则两条线段平行，有可能存在部分重合。再判断两条平行线段是否共线，方法是用L1的一端和L2的一端构成向量v_s并与v₂作外积，如果v_s与v₂也平行则两线段共线（三点共线）。在共线的前提下，若起点较小的线段终点大于起点较大的线段起点，则判定为部分重合。

没有重合，就要判定两条线是否相交，主要的算法还是依靠外积。然而外积的计算开销比较大，如果不相交的情况比较多，可先做快速排斥实验：将两条线段视为两个矩形的对角线，并构造出这两个矩形。如果这两个矩形没有重叠部分（x坐标相离或y坐标相离）即可判定为不相交。

然后执行跨立试验。两条相交的线段必然相互跨立，简单的讲就是p₁和p₂两点位于L₂的两侧且p₃和p₄两点位于L₁的两侧，这样就可利用外积做出判断了。分别构造向量s₁(p₃, p₁), s₂(p₃, p₂)，如果s₁×v₂与s₂×v₂异号(s₁->v₂与s₂->v₂转动的方向相反），则说明p₁和p₂位于L₂的两侧。同理可判定p₃和p₄是否跨立L₁。如果上述四个叉积中任何一个等于0，则说明一条线段的端点在另一条线上。

当判定两条线段相交后，就可以进行交点的求解了。当然，求交点可以用平面几何方法，列点斜式方程来完成。但这样作会难以处理斜率为0的特殊情况，且运算中会出现多次除法，很难保证精度。这里将使用向量法求解。

设交点为(x₀, y₀)，则下列方程组必然成立：

1. x₀-x₁=k₁(x₂-x₁)
2. y₀-y₁=k₁(y₂-y₁)
3. x₀-x₃=k₂(x₄-x₃)
4. y₀-y₃=k₂(y₄-y₃)

其中k₁和k₂为任意不为0的常数（若为0，则说明有重合的端点，这种情况在上面已经被排除了）。1式与2式联系，3式与4式联立，消去k₁和k₂可得：

1. x₀(y₂-y₁)-x₁(y₂-y₁)=y₀(x₂-x₁)-y₁(x₂-x₁)
2. x₀(y₄-y₃)-x₃(y₄-y₃)=y₀(x₄-x₃)-y₃(x₄-x₃)

将含有未知数x₀和y₀的项移到左边，常数项移动到右边，得：

1. (y₂-y₁)x₀+(x₁-x₂)y₀=(y₂-y₁)x₁+(x₁-x₂)y₁
2. (y₄-y₃)x₀+(x₃-x₄)y₀=(y₄-y₃)x₃+(x₃-x₄)y₃

设两个常数项分别为b₁和b₂：

• b₁=(y₂-y₁)x₁+(x₁-x₂)y₁
• b₂₌(y₄-y₃)x₃+(x₃-x₄)y₃

系数行列式为D，用b₁和b₂替换x₀的系数所得系数行列式为D₁，替换y₀的系数所得系数行列式为D₂，则有：

• |D|=(x₂-x₁)(y₄-y₃)-(x₄-x₃)(y₂-y₁)
• |D₁|=b₂(x₂-x₁)-b₁(x₄-x₃)
• |D₂|=b₂(y₂-y₁)-b₁(y₄-y₃)

由此，可求得交点坐标为：

• x₀=|D₁|/|D|, y₀=|D₂|/|D|

解毕。

判断两线段相交
经典方法，就是跨立试验了，即如果一条线段跨过另一条线段，则线段的两个端点分别在另一条线段的两侧。但是，还需要检测边界情况，即两条线段中可能某条线段的某个端点正好落在另一条线段上。这也是算法导论中介绍的算法。
程序模拟如下：

1. int direction(point* pi, point* pj, point* pk){
2.      point p1, p2;
3.     
4.      p1.x = pk->x - pi->x;
5.      p1.y = pk->y - pi->y;
6.     
7.      p2.x = pj->x - pi->x;
8.      p2.y = pj->y - pi->y;
9.     
10.     return crossProduct(&p1, &p2);
11. }
13. int onSegment(point* pi, point* pj, point* pk){
14.     int minx, miny, maxx, maxy;
15.     if (pi->x > pj->x){
16.          minx = pj->x;
17.          maxx = pi->x;   
18.      }
19.     else{
20.          minx = pi->x;
21.          maxx = pj->x;
22.      }
23.     
24.     if (pi->y > pj->y){
25.          miny = pj->y;
26.          maxy = pi->y;   
27.      }
28.     else{
29.          miny = pi->y;
30.          maxy = pj->y;
31.      }
32.     
33.     if (minx <= pk->x && pk->x <= maxx && miny <= pk->y && pk->y <= maxy)
34.         return 1;
35.     else
36.         return 0;
37. }
39. int segmentIntersect(point* p1, point* p2, point* p3, point* p4){
40.     int d1 = direction(p3, p4, p1);
41.     int d2 = direction(p3, p4, p2);
42.     int d3 = direction(p1, p2, p3);
43.     int d4 = direction(p1, p2, p4);
44.     if (d1 * d2 < 0 && d3 * d4 < 0)
45.         return 1;
46.     else if (!d1 && onSegment(p3, p4, p1))
47.         return 1;
48.     else if (!d2 && onSegment(p3, p4, p2))
49.         return 1;
50.     else if (!d3 && onSegment(p1, p2, p3))
51.         return 1;
52.     else if (!d4 && onSegment(p1, p2, p4))
53.         return 1;
54.     else
55.         return 0;
56. }