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
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
use super::curve::*;
use super::section::*;
use super::super::line::*;
use super::super::consts::*;
use super::super::coordinate::*;
pub fn overlapping_region<P: Coordinate+Coordinate2D, C1: BezierCurve<Point=P>, C2: BezierCurve<Point=P>>(curve1: &C1, curve2: &C2) -> Option<((f64, f64), (f64, f64))> {
let mut c2_t1 = 0.0;
let mut c2_t2 = 1.0;
let c2_start = curve2.start_point();
let c2_end = curve2.end_point();
let c1_t1 = if let Some(t) = curve1.t_for_point(&c2_start) {
t
} else if let Some(t) = curve2.t_for_point(&curve1.start_point()) {
c2_t1 = t;
0.0
} else {
return None;
};
let c1_t2 = if let Some(t) = curve1.t_for_point(&c2_end) {
t
} else if let Some(t) = curve2.t_for_point(&curve1.end_point()) {
c2_t2 = t;
1.0
} else {
return None;
};
if (c1_t1-c1_t2).abs() < SMALL_T_DISTANCE || (c2_t1-c2_t2).abs() < SMALL_T_DISTANCE {
return None;
}
#[inline]
fn is_collinear<P: Coordinate2D>(p: &P, &(a, b, c): &(f64, f64, f64)) -> bool {
(a*p.x() + b*p.y() + c).abs() < SMALL_DISTANCE
}
let coeff = (curve1.start_point(), curve1.end_point()).coefficients();
let (c1_cp1, c1_cp2) = curve1.control_points();
if is_collinear(&c1_cp1, &coeff) && is_collinear(&c1_cp2, &coeff)
&& is_collinear(&curve2.start_point(), &coeff) && is_collinear(&curve2.end_point(), &coeff) {
let (c2_cp1, c2_cp2) = curve2.control_points();
if is_collinear(&c2_cp1, &coeff) && is_collinear(&c2_cp2, &coeff) {
return Some(((c1_t1, c1_t2), (c2_t1, c2_t2)));
}
}
#[inline]
fn close_enough<P: Coordinate>(p1: &P, p2: &P) -> bool {
p1.is_near_to(&p2, SMALL_DISTANCE)
}
#[inline]
fn control_points<P: Coordinate+Coordinate2D, C: BezierCurve<Point=P>>(curve: &C, t1: f64, t2: f64) -> (P, P) {
if t2 < t1 {
let (cp2, cp1) = curve.section(t2, t1).control_points();
(cp1, cp2)
} else {
curve.section(t1, t2).control_points()
}
}
let (c2_cp1, c2_cp2) = if c2_t1 != 0.0 || c2_t2 != 1.0 {
control_points(curve2, c2_t1, c2_t2)
} else {
curve2.control_points()
};
let (c1_cp1, c1_cp2) = control_points(curve1, c1_t1, c1_t2);
if close_enough(&c1_cp1, &c2_cp1) && close_enough(&c1_cp2, &c2_cp2) {
Some(((c1_t1, c1_t2), (c2_t1, c2_t2)))
} else {
None
}
}