nabled-model 0.0.11

URDF and DH robot models with chain conversion for nabled Physical AI
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
63
64
65
66
67
68
69
70
71
72
73
74

//! Robot model representation.

#![allow(clippy::missing_errors_doc, let_underscore_drop, clippy::missing_panics_doc)]

use nabled_core::errors::{IntoNabledError, NabledError, ShapeError};

pub mod dh;
pub mod fixture;
pub mod joint;
pub mod link;
pub mod origin;
pub mod robot;
pub mod tree_model;
pub mod urdf;

#[derive(Debug, Clone, PartialEq)]
pub enum ModelError {
    EmptyModel,
    DimensionMismatch,
    InvalidInput(String),
    ParseError(String),
}

impl std::fmt::Display for ModelError {
    fn fmt(&self, f: &mut std::fmt::Formatter<'_>) -> std::fmt::Result {
        match self {
            ModelError::EmptyModel => write!(f, "robot model cannot be empty"),
            ModelError::DimensionMismatch => write!(f, "input dimensions are incompatible"),
            ModelError::InvalidInput(message) => write!(f, "invalid input: {message}"),
            ModelError::ParseError(message) => write!(f, "parse error: {message}"),
        }
    }
}

impl std::error::Error for ModelError {}

impl IntoNabledError for ModelError {
    fn into_nabled_error(self) -> NabledError {
        match self {
            ModelError::EmptyModel => NabledError::Shape(ShapeError::EmptyInput),
            ModelError::DimensionMismatch => NabledError::Shape(ShapeError::DimensionMismatch),
            ModelError::InvalidInput(message) | ModelError::ParseError(message) => {
                NabledError::InvalidInput(message)
            }
        }
    }
}

#[cfg(test)]
mod error_mapping {
    use nabled_core::errors::{IntoNabledError, NabledError, ShapeError};

    use crate::ModelError;

    #[test]
    fn into_nabled_error_covers_all_variants() {
        assert!(matches!(
            ModelError::EmptyModel.into_nabled_error(),
            NabledError::Shape(ShapeError::EmptyInput)
        ));
        assert!(matches!(
            ModelError::DimensionMismatch.into_nabled_error(),
            NabledError::Shape(ShapeError::DimensionMismatch)
        ));
        assert!(matches!(
            ModelError::InvalidInput("bad".into()).into_nabled_error(),
            NabledError::InvalidInput(message) if message == "bad"
        ));
        assert!(matches!(
            ModelError::ParseError("xml".into()).into_nabled_error(),
            NabledError::InvalidInput(message) if message == "xml"
        ));
    }
}