rust-powered-lego 0.2.0

This crate aims to control a regular Powered Up motor using a Technic Hub.
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 num_traits::FromPrimitive;
use anyhow::{Result, Ok, bail};

use super::MessageTypes;

use crate::lego::consts::LegoErrorTypes;

fn parse_lego_error(msg: &Vec<u8>) -> Result<String> {
    let slc = msg;
    let err_cmd = slc[3];
    let err_code = slc[4];

    let err: Option<LegoErrorTypes> = FromPrimitive::from_u8(err_code);
    let cmd: Option<MessageTypes> = FromPrimitive::from_u8(err_cmd);

    let mut cmd_str: String = "UnknownCommand".to_string();
    cmd.map(|x| { cmd_str = format!("{:?}", x)});

    let mut err_str: String = "UnknownError".to_string();
    err.map(|x| { err_str = format!("{:?}", x)});

    Ok(format!("[Error] On command {}: {}", cmd_str, err_str))
}

pub fn check_for_lego_error(msg: &Vec<u8>) -> Result<()> {
    if msg.len() < 3 {
        bail!("[Error] Not a valid message")
    }
    if msg[2] == 0x05 {
        bail!(parse_lego_error(msg).unwrap())
    }
    Ok(())
}