nodo 0.18.5

A realtime framework for robotics
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

use std::ops::{Index, IndexMut};

/// Small helper type which allows insertion/lookup of elements with arbitrary indicies. This
/// heavily relies on indices being reasonably compact.
/// I wanted to use a slab, however that one does not allow me to insert at a custom index.
#[derive(Clone)]
pub struct OptVec<T>(Vec<Option<T>>);

impl<T> Default for OptVec<T> {
    fn default() -> Self {
        Self(Vec::new())
    }
}

impl<T> OptVec<T> {
    pub fn insert(&mut self, index: usize, value: T) {
        if index >= self.0.len() {
            let n = index + 1 - self.0.len();
            self.0.reserve(n);
            for _ in 0..n {
                self.0.push(None);
            }
        }
        self.0[index] = Some(value);
    }

    pub fn iter(&self) -> impl Iterator<Item = (usize, &T)> {
        self.0
            .iter()
            .enumerate()
            .filter_map(|(k, v)| v.as_ref().map(|v| (k, v)))
    }

    pub fn map<S, F>(&self, mut f: F) -> OptVec<S>
    where
        F: FnMut(&T) -> S,
    {
        OptVec(self.0.iter().map(|v| v.as_ref().map(|v| f(v))).collect())
    }

    pub fn get(&self, idx: usize) -> Option<&T> {
        self.0.get(idx).and_then(|v| v.as_ref())
    }

    pub fn get_mut(&mut self, idx: usize) -> Option<&mut T> {
        self.0.get_mut(idx).and_then(|v| v.as_mut())
    }
}

impl<T> Index<usize> for OptVec<T> {
    type Output = T;

    fn index(&self, idx: usize) -> &T {
        self.0[idx].as_ref().unwrap()
    }
}

impl<T> IndexMut<usize> for OptVec<T> {
    fn index_mut(&mut self, idx: usize) -> &mut T {
        self.0[idx].as_mut().unwrap()
    }
}