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
use super::{Matrix, Dot};
use higher_order_functions::Init;
use core::ops::{
Mul,
Index, IndexMut,
};
use num_traits::{MulAdd, Zero};
pub type Vector<T, const M: usize> = Matrix<T, M, 1>;
impl<T, const M: usize> Vector<T, M> {
pub fn vector(contents: [T; M]) -> Self {
Self::cols([contents])
}
}
impl<T, const M: usize> Init<T, usize> for Vector<T, M> {
fn init_with<F: FnMut(usize) -> T>(_: (), mut elem: F) -> Self {
Self::init(|[row, _]: [usize; 2]| elem(row))
}
}
impl<T, const M: usize> Index<usize> for Vector<T, M> {
type Output = T;
fn index(&self, index: usize) -> &T {
&self[[index, 0]]
}
}
impl<T, const M: usize> IndexMut<usize> for Vector<T, M> {
fn index_mut(&mut self, index: usize) -> &mut T {
&mut self[[0, index]]
}
}
impl<TLhs: Copy, TRhs: Copy, TOutput, const M: usize> Dot<Vector<TRhs, M>> for Vector<TLhs, M> where
TLhs: Mul<TRhs, Output = TOutput> + MulAdd<TRhs, TOutput, Output = TOutput>,
TOutput: Zero,
{
type Output = TOutput;
fn dot(self, rhs: Vector<TRhs, M>) -> Self::Output {
let mut result = Self::Output::zero();
for k in 0..M {
result = self[k].mul_add(rhs[k], result);
}
result
}
}