num_opt/hermite/
matrix.rs

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
use crate::my_float::MyFloat;

pub fn matrix_raw<T: crate::my_float::MyFloat>() -> Vec<[T; 8]> {
    vec![
        [
            T::from_f(20.0),
            T::from_f(10.0),
            T::from_f(2.0),
            T::from_f_fraction(1.0, 6.0),
            T::from_f(-20.0),
            T::from_f(10.0),
            T::from_f(-2.0),
            T::from_f_fraction(1.0, 6.0),
        ],
        [
            T::from_f(-70.0),
            T::from_f(-36.0),
            T::from_f_fraction(-15.0, 2.0),
            T::from_f_fraction(-2.0, 3.0),
            T::from_f(70.0),
            T::from_f(-34.0),
            T::from_f_fraction(13.0, 2.0),
            T::from_f_fraction(-1.0, 2.0),
        ],
        [
            T::from_f(84.0),
            T::from_f(45.0),
            T::from_f(10.0),
            T::from_f(1.0),
            T::from_f(-84.0),
            T::from_f(39.0),
            T::from_f(-7.0),
            T::from_f_fraction(1.0, 2.0),
        ],
        [
            T::from_f(-35.0),
            T::from_f(-20.0),
            T::from_f(-5.0),
            T::from_f_fraction(-2.0, 3.0),
            T::from_f(35.0),
            T::from_f(-15.0),
            T::from_f_fraction(5.0, 2.0),
            T::from_f_fraction(-1.0, 6.0),
        ],
        [
            T::from_f(0.0),
            T::from_f(0.0),
            T::from_f(0.0),
            T::from_f_fraction(1.0, 6.0),
            T::from_f(0.0),
            T::from_f(0.0),
            T::from_f(0.0),
            T::from_f(0.0),
        ],
        [
            T::from_f(0.0),
            T::from_f(0.0),
            T::from_f_fraction(1.0, 2.0),
            T::from_f(0.0),
            T::from_f(0.0),
            T::from_f(0.0),
            T::from_f(0.0),
            T::from_f(0.0),
        ],
        [
            T::from_f(0.0),
            T::from_f(1.0),
            T::from_f(0.0),
            T::from_f(0.0),
            T::from_f(0.0),
            T::from_f(0.0),
            T::from_f(0.0),
            T::from_f(0.0),
        ],
        [
            T::from_f(1.0),
            T::from_f(0.0),
            T::from_f(0.0),
            T::from_f(0.0),
            T::from_f(0.0),
            T::from_f(0.0),
            T::from_f(0.0),
            T::from_f(0.0),
        ],
    ]
}

/// [a b c]   [x]   [ax + by + cz]
/// [d e f] x [y] = [dx + ey + fz]
/// [g h i]   [z]   [gx + hy + iz]
pub fn multiply_matrix_vector<T: MyFloat>(m: &[[T; 8]], v: &[T]) -> Vec<T> {
    let mut out = vec![];
    for row in m {
        let mut x = T::zero();
        for i in 0..8 {
            x = x + row[i].clone() * v[i].clone();
        }
        out.push(x);
    }
    out
}