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
use oxygengine_core::{ecs::Entity, Scalar};
use oxygengine_ha_renderer::math::{Rect, Vec2};
use rstar::{
    primitives::{GeomWithData, Rectangle},
    RTree, AABB,
};
use std::collections::{HashMap, HashSet};

#[derive(Debug, Default)]
pub struct SpatialQueries {
    rtree: RTree<GeomWithData<Rectangle<[Scalar; 2]>, Entity>>,
    collisions: HashMap<Entity, HashSet<Entity>>,
}

impl SpatialQueries {
    pub fn clear(&mut self) {
        self.rtree = Default::default();
        self.collisions.clear();
    }

    pub fn add(&mut self, entity: Entity, rect: Rect) {
        self.rtree.insert(GeomWithData::new(
            Rectangle::from_corners([rect.x, rect.y], [rect.x + rect.w, rect.y + rect.h]),
            entity,
        ));
        for geom in self
            .rtree
            .locate_in_envelope_intersecting(&AABB::from_corners(
                [rect.x, rect.y],
                [rect.x + rect.w, rect.y + rect.h],
            ))
        {
            if geom.data != entity {
                self.collisions.entry(entity).or_default().insert(geom.data);
                self.collisions.entry(geom.data).or_default().insert(entity);
            }
        }
    }

    pub fn nearest(&self, point: Vec2) -> impl Iterator<Item = (Entity, Rect, Scalar)> + '_ {
        self.rtree
            .nearest_neighbor_iter_with_distance_2(&[point.x, point.y])
            .map(|(item, distance2)| {
                let lower = item.geom().lower();
                let upper = item.geom().upper();
                (
                    item.data,
                    Rect::new(lower[0], lower[1], upper[0] - lower[0], upper[1] - lower[1]),
                    distance2,
                )
            })
    }

    pub fn contains(&self, point: Vec2) -> impl Iterator<Item = (Entity, Rect)> + '_ {
        self.rtree
            .locate_all_at_point(&[point.x, point.y])
            .map(|item| {
                let lower = item.geom().lower();
                let upper = item.geom().upper();
                (
                    item.data,
                    Rect::new(lower[0], lower[1], upper[0] - lower[0], upper[1] - lower[1]),
                )
            })
    }

    pub fn overlaps(&self, rect: Rect) -> impl Iterator<Item = (Entity, Rect)> + '_ {
        self.rtree
            .locate_in_envelope_intersecting(&AABB::from_corners(
                [rect.x, rect.y],
                [rect.x + rect.w, rect.y + rect.h],
            ))
            .map(|item| {
                let lower = item.geom().lower();
                let upper = item.geom().upper();
                (
                    item.data,
                    Rect::new(lower[0], lower[1], upper[0] - lower[0], upper[1] - lower[1]),
                )
            })
    }

    pub fn collides(&self, entity: Entity) -> Option<impl Iterator<Item = Entity> + '_> {
        Some(self.collisions.get(&entity)?.iter().copied())
    }

    pub fn collides_with(&self, entity: Entity, other: Entity) -> bool {
        self.collisions
            .get(&entity)
            .map(|entities| entities.contains(&other))
            .unwrap_or_default()
    }
}