cu-ros-payloads 0.13.0

ROS2 Payloads that can be constructed from/to Copper Payloads for compatibility
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

use compact_str::CompactString;
use cu_sensor_payloads::PointCloudSoa;
use serde::{Deserialize, Serialize};

use crate::{RosMsgAdapter, builtin::Header};

// sensor_msgs/PointField
#[derive(Clone, Debug, Serialize, Deserialize)]
pub struct PointField {
    pub name: CompactString,
    pub offset: u32,
    pub datatype: u8,
    pub count: u32,
}

// sensor_msgs/PointCloud2 like struct
#[derive(Clone, Debug, Serialize, Deserialize)]
pub struct PointCloud2 {
    pub header: Header,
    pub height: u32, //
    pub width: u32,  // Length of the point cloud
    pub pointfields: Vec<PointField>,
    pub is_bigendian: bool,
    pub point_step: u32, // Length of a point in bytes
    pub row_step: u32,   // Length of a row in bytes
    pub data: Vec<u8>,   // size is (row_step*height)
    pub is_dense: bool,  // True if there are no invalid points
}

impl<const N: usize> RosMsgAdapter<'static> for PointCloudSoa<N> {
    type Output = PointCloud2;

    fn namespace() -> &'static str {
        "sensor_msgs"
    }

    fn type_name() -> &'static str {
        "PointCloud2"
    }

    fn type_hash() -> &'static str {
        "RIHS01_9198cabf7da3796ae6fe19c4cb3bdd3525492988c70522628af5daa124bae2b5"
    }
}

impl<const N: usize> From<&PointCloudSoa<N>> for PointCloud2 {
    #[allow(unreachable_code)]
    fn from(_: &PointCloudSoa<N>) -> Self {
        PointCloud2 {
            header: todo!(),
            height: 1,
            width: todo!(),
            pointfields: todo!(),
            is_bigendian: true,
            point_step: todo!(),
            row_step: todo!(),
            data: todo!(),
            is_dense: todo!(),
        }
    }
}