rcgal 0.2.2

Rust Computational Geometry Algorithms Library.
Documentation 
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

use crate::kernel::{number_type::NumberType, point_2::Point2, ray_2::Ray2};

use super::location_enum::Point2Ray2Location;

pub fn is_point_2_on_ray_2<T: NumberType>(p: &Point2<T>, r: &Ray2<T>) -> bool {
    if p.equals(&r.origin()) {
        return true;
    }
    let v = *p - r.origin();
    let cross = r.direction().cross(&v);
    let dot = r.direction().dot(&v);
    dot > T::zero() && cross.equals(T::zero())
}

pub fn locate_point_2_ray_2<T: NumberType>(p: &Point2<T>, r: &Ray2<T>) -> Point2Ray2Location {
    if is_point_2_on_ray_2(p, r) {
        return Point2Ray2Location::On;
    }
    let v = *p - r.origin();
    let cross = r.direction().cross(&v);
    if cross > T::default_eps() {
        return Point2Ray2Location::Left;
    } else if cross < -T::default_eps() {
        return Point2Ray2Location::Right;
    }
    return Point2Ray2Location::Collinear;
}

#[cfg(test)]
mod tests {
    use crate::kernel::vector_2::Vector2;

    use super::*;

    #[test]
    fn test_is_point_2_on_ray_2() {
        let r = Ray2::new(Point2::new(0.0, 0.0), Vector2::new(1.0, 0.0));
        let p = Point2::new(1.0, 0.0);
        assert_eq!(is_point_2_on_ray_2(&p, &r), true);

        let p = Point2::new(1.0, 1.0);
        assert_eq!(is_point_2_on_ray_2(&p, &r), false);

        let p = Point2::new(0.0, 0.0);
        assert_eq!(is_point_2_on_ray_2(&p, &r), true);

        let p = Point2::new(-1.0, 0.0);
        assert_eq!(is_point_2_on_ray_2(&p, &r), false);
    }

    #[test]
    fn test_locate_point_2_ray_2() {
        let r = Ray2::new(Point2::new(0.0, 0.0), Vector2::new(1.0, 0.0));
        let p = Point2::new(1.0, 0.0);
        assert_eq!(locate_point_2_ray_2(&p, &r), Point2Ray2Location::On);

        let p = Point2::new(1.0, 1.0);
        assert_eq!(locate_point_2_ray_2(&p, &r), Point2Ray2Location::Left);

        let p = Point2::new(0.0, 0.0);
        assert_eq!(locate_point_2_ray_2(&p, &r), Point2Ray2Location::On);

        let p = Point2::new(-1.0, 0.0);
        assert_eq!(locate_point_2_ray_2(&p, &r), Point2Ray2Location::Collinear);

        let p = Point2::new(1.0, -1.0);
        assert_eq!(locate_point_2_ray_2(&p, &r), Point2Ray2Location::Right);
    }
}