f3l_core 0.3.0

3D Point Cloud Library
Documentation 
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19

use crate::{BasicFloat, SimpleSliceMath};

/// Compute distance of a project on b
#[inline]
pub fn project_len<T: BasicFloat, const D: usize>(a: &[T; D], b: &[T; D]) -> T {
    (*a).dot(b) / b.len().powi(2)
}

/// Compute `scaled` vector of a project on b <br>
/// - Length:       length of vector
/// - Direction: normalize of vector
pub fn project_vector<T: BasicFloat, const D: usize>(a: &[T; D], b: &[T; D]) -> [T; D] {
    let mut out = *b;
    let factor = project_len(a, b);
    for v in out.iter_mut() {
        *v *= factor;
    }
    out
}