numberlab 0.1.9

A collection of numerical algorithms
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

use crate::structure::matrix::matrix_trait::MatrixDataTrait;

/// Manhattan distance heuristic for A*
pub fn manhattan_heuristic<W: MatrixDataTrait + From<i32>>(
    node: (usize, usize),
    goal: (usize, usize),
) -> W {
    let ((x1, y1), (x2, y2)) = get_points(node, goal);
    W::from((x1 - x2).abs() + (y1 - y2).abs())
}

/// Euclidean distance heuristic for A*
pub fn euclidean_heuristic<W: MatrixDataTrait + From<i32>>(
    node: (usize, usize),
    goal: (usize, usize),
) -> W {
    let ((x1, y1), (x2, y2)) = get_points(node, goal);
    W::from(((x1 as f64 - x2 as f64).powi(2) + (y1 as f64 - y2 as f64).powi(2)).sqrt() as i32)
}

/// Chebyshev distance heuristic for A*
pub fn chebyshev_heuristic<W: MatrixDataTrait + From<i32>>(
    node: (usize, usize),
    goal: (usize, usize),
) -> W {
    let ((x1, y1), (x2, y2)) = get_points(node, goal);
    W::from((x1 - x2).abs().max((y1 - y2).abs()))
}

/// Octile distance heuristic for A*
pub fn octile_heuristic<W: MatrixDataTrait + From<i32>>(
    node: (usize, usize),
    goal: (usize, usize),
) -> W {
    let ((x1, y1), (x2, y2)) = get_points(node, goal);
    let (dx, dy) = ((x1 - x2).abs(), (y1 - y2).abs());
    W::from((dx + dy) + ((2 - 2_i32.isqrt()) * dx.min(dy)))
}

/// Dijkstra's Heuristic
pub fn dijkstra_heuristic<W: MatrixDataTrait>(_: (usize, usize), _: (usize, usize)) -> W {
    W::zero()
}

fn get_points(node: (usize, usize), goal: (usize, usize)) -> ((i32, i32), (i32, i32)) {
    (
        (node.0 as i32, node.1 as i32),
        (goal.0 as i32, goal.1 as i32),
    )
}