rocketsim 0.2.0

Simulate Rocket League games at maximum efficiency
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
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
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131

use glam::{Vec3A, Vec4};

use super::Aabb;

/// Four-wide ray packet + union AABB for the SIMD raycast path.
///
/// You normally don't build this directly — use [`crate::Arena::cast_rays`]
/// with `[`crate::RaycastQuery`; N]` arrays.
pub struct QuadRayInfo<'a> {
    pub ray_sources: &'a [Vec3A; 4],
    pub ray_targets: &'a [Vec3A; 4],
    pub lambda_max: Vec4,
    pub aabb: Aabb,
}

impl<'a> QuadRayInfo<'a> {
    #[must_use]
    pub fn new(ray_sources: &'a [Vec3A; 4], ray_targets: &'a [Vec3A; 4]) -> Self {
        // Union AABB of the 4 segments for quick root rejection.
        let mut aabb = Aabb::new(
            ray_sources[0].min(ray_targets[0]),
            ray_sources[0].max(ray_targets[0]),
        );
        for i in 1..4 {
            aabb += Aabb::new(
                ray_sources[i].min(ray_targets[i]),
                ray_sources[i].max(ray_targets[i]),
            );
        }

        Self {
            ray_sources,
            ray_targets,
            lambda_max: Vec4::ONE,
            aabb,
        }
    }

    #[must_use]
    pub fn calc_pos_dir(&self) -> ([Vec4; 3], [Vec4; 3]) {
        let sources = [
            Vec4::from_array([
                self.ray_sources[0].x,
                self.ray_sources[1].x,
                self.ray_sources[2].x,
                self.ray_sources[3].x,
            ]),
            Vec4::from_array([
                self.ray_sources[0].y,
                self.ray_sources[1].y,
                self.ray_sources[2].y,
                self.ray_sources[3].y,
            ]),
            Vec4::from_array([
                self.ray_sources[0].z,
                self.ray_sources[1].z,
                self.ray_sources[2].z,
                self.ray_sources[3].z,
            ]),
        ];

        let targets = [
            Vec4::from_array([
                self.ray_targets[0].x,
                self.ray_targets[1].x,
                self.ray_targets[2].x,
                self.ray_targets[3].x,
            ]),
            Vec4::from_array([
                self.ray_targets[0].y,
                self.ray_targets[1].y,
                self.ray_targets[2].y,
                self.ray_targets[3].y,
            ]),
            Vec4::from_array([
                self.ray_targets[0].z,
                self.ray_targets[1].z,
                self.ray_targets[2].z,
                self.ray_targets[3].z,
            ]),
        ];

        let mut inv_dirs = [
            Vec4::ONE / (targets[0] - sources[0]),
            Vec4::ONE / (targets[1] - sources[1]),
            Vec4::ONE / (targets[2] - sources[2]),
        ];

        for inv_dir in &mut inv_dirs {
            *inv_dir = Vec4::select(inv_dir.is_finite_mask(), *inv_dir, Vec4::MAX);
        }

        (sources, inv_dirs)
    }

    #[must_use]
    /// Packet slab test for 4 rays using Vec4 lanes.
    ///
    /// Returns a bitmask (bit `i` set if ray `i` overlaps the AABB).
    /// Only the lowest 4 bits are set.
    pub fn intersect_quad_ray_aabb(
        origins: &[Vec4; 3],
        inv_dir: &[Vec4; 3],
        bounds: &Aabb,
        lambda_max: Vec4,
    ) -> u8 {
        let t0x = (bounds.min.x - origins[0]) * inv_dir[0];
        let t1x = (bounds.max.x - origins[0]) * inv_dir[0];
        let tminx = t0x.min(t1x);
        let tmaxx = t0x.max(t1x);

        let t0y = (bounds.min.y - origins[1]) * inv_dir[1];
        let t1y = (bounds.max.y - origins[1]) * inv_dir[1];
        let tminy = t0y.min(t1y);
        let tmaxy = t0y.max(t1y);

        let t0z = (bounds.min.z - origins[2]) * inv_dir[2];
        let t1z = (bounds.max.z - origins[2]) * inv_dir[2];
        let tminz = t0z.min(t1z);
        let tmaxz = t0z.max(t1z);

        let t_enter = tminx.max(tminy).max(tminz);
        let t_exit = tmaxx.min(tmaxy).min(tmaxz);

        let cond1 = t_enter.cmple(t_exit);
        let cond2 = t_exit.cmpge(Vec4::ZERO);
        let cond3 = t_enter.cmple(lambda_max);

        (cond1 & cond2 & cond3).bitmask() as u8
    }
}