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
use prelude::v1::*;
use shim::*;
use base::*;

/// Perform checks whether the C FreeRTOS shim and Rust agree on the sizes of used types.
pub fn shim_sanity_check() -> Result<(), usize> {

    let checks = [(0, mem::size_of::<FreeRtosVoidPtr>()),
                  (1, mem::size_of::<FreeRtosCharPtr>()),
                  (2, mem::size_of::<FreeRtosChar>()),

                  (10, mem::size_of::<FreeRtosBaseType>()),
                  (11, mem::size_of::<FreeRtosUBaseType>()),
                  (12, mem::size_of::<FreeRtosTickType>()),

                  (20, mem::size_of::<FreeRtosTaskHandle>()),
                  (21, mem::size_of::<FreeRtosQueueHandle>()),
                  (22, mem::size_of::<FreeRtosSemaphoreHandle>()),
                  (23, mem::size_of::<FreeRtosTaskFunction>())];

    for check in &checks {
        let c_size = unsafe { freertos_rs_sizeof(check.0) };

        if c_size != check.1 as u8 {
            return Err(check.0 as usize);
        }
    }

    Ok(())
}

pub unsafe fn str_from_c_string(str: *const u8) -> Result<String, FreeRtosError> {
    let mut buf = Vec::new();

    let mut p = str;
    loop {
        if *p == 0 {
            break;
        }
        buf.push(*p);
        p = p.offset(1);
    }

    match String::from_utf8(buf) {
        Ok(s) => Ok(s),
        Err(_) => Err(FreeRtosError::StringConversionError),
    }
}