bvh_anim_parser 1.0.1

A .bvh file parser
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

use crate::types::Quaternion;


/// reorder vector based on euler angles order string
pub(crate) fn __reorder_vector(e1: f64, e2: f64, e3: f64, order: &str) -> (f64, f64, f64) {
    match order {
        "ZXY" => (e2, e3, e1),
        "ZYX" => (e3, e2, e1),
        "YXZ" => (e2, e1, e3),
        "YZX" => (e3, e1, e2),
        "XZY" => (e1, e3, e2),
        "XYZ" => (e1, e2, e3),
        _ => panic!("Invalid euler angles order!"),
    }
}

/// Convert euler angles in DEGREES to quaternion
pub(crate) fn __from_euler_to_quat(x: f64, y: f64, z: f64, order: &str) -> Quaternion {
    let x = x.to_radians();
    let y = y.to_radians();
    let z = z.to_radians();

    let c1 = (x / 2.0).cos();
    let c2 = (y / 2.0).cos();
    let c3 = (z / 2.0).cos();

    let s1 = (x / 2.0).sin();
    let s2 = (y / 2.0).sin();
    let s3 = (z / 2.0).sin();

    let quaternion = match order {
        "XYZ" => Quaternion::new(
            c1 * c2 * c3 - s1 * s2 * s3,
            s1 * c2 * c3 + c1 * s2 * s3,
            c1 * c2 * s3 + s1 * s2 * c3,
            c1 * c2 * s3 + s1 * s2 * c3,
        ),
        "YXZ" => Quaternion::new(
            c1 * c2 * c3 + s1 * s2 * s3,
            s1 * c2 * c3 + c1 * s2 * s3,
            c1 * s2 * c3 - s1 * c2 * s3,
            c1 * c2 * s3 - s1 * s2 * c3,
        ),
        "ZXY" => Quaternion::new(
            c1 * c2 * c3 - s1 * s2 * s3,
            s1 * c2 * c3 - c1 * s2 * s3,
            c1 * s2 * c3 + s1 * c2 * s3,
            c1 * c2 * s3 + s1 * s2 * c3,
        ),
        "ZYX" => Quaternion::new(
            s1 * c2 * c3 - c1 * s2 * s3,
            c1 * s2 * c3 + s1 * c2 * s3,
            c1 * c2 * s3 - s1 * c2 * c3,
            c1 * c2 * c3 + s1 * s2 * s3,
        ),
        "YZX" => Quaternion::new(
            s1 * c2 * c3 + c1 * s2 * s3,
            c1 * s2 * c3 + s1 * c2 * s3,
            c1 * c2 * s3 - s1 * s2 * c3,
            c1 * c2 * c3 - s1 * s2 * s3,
        ),
        "XZY" => Quaternion::new(
            s1 * c2 * c3 - c1 * s2 * s3,
            c1 * s2 * c3 - s1 * c2 * s3,
            c1 * c2 * s3 + s1 * s2 * c3,
            c1 * c2 * c3 + s1 * s2 * s3,
        ),
        _ => panic!("Invalid euler angles order!"),
    };

    return quaternion;
}