-
Notifications
You must be signed in to change notification settings - Fork 522
/
SegmentsIntersection.java
68 lines (61 loc) · 3.05 KB
/
SegmentsIntersection.java
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
package geometry;
import java.awt.geom.*;
import java.util.Random;
public class SegmentsIntersection {
public static boolean isCrossIntersect(long x1, long y1, long x2, long y2, long x3, long y3, long x4, long y4) {
long z1 = (x2 - x1) * (y3 - y1) - (y2 - y1) * (x3 - x1);
long z2 = (x2 - x1) * (y4 - y1) - (y2 - y1) * (x4 - x1);
long z3 = (x4 - x3) * (y1 - y3) - (y4 - y3) * (x1 - x3);
long z4 = (x4 - x3) * (y2 - y3) - (y4 - y3) * (x2 - x3);
return (z1 < 0 || z2 < 0) && (z1 > 0 || z2 > 0) && (z3 < 0 || z4 < 0) && (z3 > 0 || z4 > 0);
}
public static boolean isCrossOrTouchIntersect(
long x1, long y1, long x2, long y2, long x3, long y3, long x4, long y4) {
if (Math.max(x1, x2) < Math.min(x3, x4) || Math.max(x3, x4) < Math.min(x1, x2)
|| Math.max(y1, y2) < Math.min(y3, y4) || Math.max(y3, y4) < Math.min(y1, y2))
return false;
long z1 = (x2 - x1) * (y3 - y1) - (y2 - y1) * (x3 - x1);
long z2 = (x2 - x1) * (y4 - y1) - (y2 - y1) * (x4 - x1);
long z3 = (x4 - x3) * (y1 - y3) - (y4 - y3) * (x1 - x3);
long z4 = (x4 - x3) * (y2 - y3) - (y4 - y3) * (x2 - x3);
return (z1 <= 0 || z2 <= 0) && (z1 >= 0 || z2 >= 0) && (z3 <= 0 || z4 <= 0) && (z3 >= 0 || z4 >= 0);
}
public static Point2D.Double getLinesIntersection(
long x1, long y1, long x2, long y2, long x3, long y3, long x4, long y4) {
long a1 = y2 - y1;
long b1 = x1 - x2;
long c1 = -(x1 * y2 - x2 * y1);
long a2 = y4 - y3;
long b2 = x3 - x4;
long c2 = -(x3 * y4 - x4 * y3);
long det = a1 * b2 - a2 * b1;
if (det == 0)
return null;
double x = -(c1 * b2 - c2 * b1) / (double) det;
double y = -(a1 * c2 - a2 * c1) / (double) det;
return new Point2D.Double(x, y);
}
// random tests
public static void main(String[] args) {
Random rnd = new Random();
for (int step = 0; step < 1000_000; step++) {
int r = 10;
int x1 = rnd.nextInt(r) - r / 2;
int y1 = rnd.nextInt(r) - r / 2;
int x2 = rnd.nextInt(r) - r / 2;
int y2 = rnd.nextInt(r) - r / 2;
int x3 = rnd.nextInt(r) - r / 2;
int y3 = rnd.nextInt(r) - r / 2;
int x4 = rnd.nextInt(r) - r / 2;
int y4 = rnd.nextInt(r) - r / 2;
boolean crossIntersect = isCrossIntersect(x1, y1, x2, y2, x3, y3, x4, y4);
boolean crossOrTouchIntersect = isCrossOrTouchIntersect(x1, y1, x2, y2, x3, y3, x4, y4);
boolean crossOrTouchIntersect2 = Line2D.linesIntersect(x1, y1, x2, y2, x3, y3, x4, y4);
crossOrTouchIntersect2 &=
!(x1 == x2 && y1 == y2 && x3 == x4 && y3 == y4 && (x1 != x3 || y1 != y3)); // applying fix
if (crossOrTouchIntersect != crossOrTouchIntersect2 || crossIntersect && !crossOrTouchIntersect)
throw new RuntimeException();
}
System.out.println(getLinesIntersection(0, 0, 4, 2, 2, -1, 2, 5).equals(new Point2D.Double(2, 1)));
}
}