spacetime_physics 0.1.1

Physics engine for SpacetimeDB
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

use crate::RigidBodyData;

use super::CollisionPoint;

pub fn test_collision(
    body_a: &RigidBodyData,
    body_b: &RigidBodyData,
    prediction: f32,
) -> Option<CollisionPoint> {
    let iso_a = body_a.into();
    let iso_b = body_b.into();

    let result = body_a
        .shape()
        .contact(&iso_a, body_b.shape(), &iso_b, prediction);

    result.map(|contact| {
        let world_a = contact.point1.into();
        let world_b = contact.point2.into();
        let local_a = body_a
            .rotation()
            .inverse()
            .rotate(world_a - body_a.position());
        let local_b = body_b
            .rotation()
            .inverse()
            .rotate(world_b - body_b.position());
        CollisionPoint {
            world_a,
            world_b,
            local_a,
            local_b,
            normal: contact.normal1.into(),
            distance: contact.dist,
        }
    })
}