rmf_site_format 0.0.2

File format parsing for rmf_site_editor
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

use super::{PortingError, Result, rbmf::*};
use crate::{Distance, Measurement as SiteMeasurement};
use serde::{Deserialize, Serialize};
use std::collections::HashMap;

#[derive(Deserialize, Serialize, Clone, Default)]
pub struct MeasurementProperties {
    // TODO: For new cartesian format, there should be no need for this value since the
    // metric distance is always equal to the distance between start and end.
    pub distance: RbmfFloat,
}

#[derive(Deserialize, Serialize, Clone, Default)]
pub struct Measurement(pub usize, pub usize, pub MeasurementProperties);

impl Measurement {
    pub fn to_site(
        &self,
        vertex_to_anchor_id: &HashMap<usize, u32>,
    ) -> Result<SiteMeasurement<u32>> {
        let left_anchor = vertex_to_anchor_id
            .get(&self.0)
            .ok_or(PortingError::InvalidVertex(self.0))?;
        let right_anchor = vertex_to_anchor_id
            .get(&self.1)
            .ok_or(PortingError::InvalidVertex(self.1))?;

        Ok(SiteMeasurement {
            anchors: [*left_anchor, *right_anchor].into(),
            distance: Distance(Some(self.2.distance.1 as f32)),
            marker: Default::default(),
        })
    }
}