agentic-robotics-core 0.1.2

High-performance agentic robotics framework with ROS2 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
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112

//! Message definitions and traits

use serde::{Deserialize, Serialize};
use rkyv::{Archive, Deserialize as RkyvDeserialize, Serialize as RkyvSerialize};

/// Message trait for ROS3 messages
pub trait Message: Serialize + for<'de> Deserialize<'de> + Send + Sync + 'static {
    /// Message type name
    fn type_name() -> &'static str;

    /// Message version
    fn version() -> &'static str {
        "1.0"
    }
}

/// Robot state message
#[derive(Debug, Clone, Serialize, Deserialize, Archive, RkyvSerialize, RkyvDeserialize)]
pub struct RobotState {
    pub position: [f64; 3],
    pub velocity: [f64; 3],
    pub timestamp: i64,
}

impl Message for RobotState {
    fn type_name() -> &'static str {
        "ros3_msgs/RobotState"
    }
}

impl Default for RobotState {
    fn default() -> Self {
        Self {
            position: [0.0; 3],
            velocity: [0.0; 3],
            timestamp: 0,
        }
    }
}

/// 3D Point
#[derive(Debug, Clone, Copy, Serialize, Deserialize, Archive, RkyvSerialize, RkyvDeserialize)]
pub struct Point3D {
    pub x: f32,
    pub y: f32,
    pub z: f32,
}

/// Point cloud message
#[derive(Debug, Clone, Serialize, Deserialize, Archive, RkyvSerialize, RkyvDeserialize)]
pub struct PointCloud {
    pub points: Vec<Point3D>,
    pub intensities: Vec<f32>,
    pub timestamp: i64,
}

impl Message for PointCloud {
    fn type_name() -> &'static str {
        "ros3_msgs/PointCloud"
    }
}

impl Default for PointCloud {
    fn default() -> Self {
        Self {
            points: Vec::new(),
            intensities: Vec::new(),
            timestamp: 0,
        }
    }
}

/// Pose message
#[derive(Debug, Clone, Serialize, Deserialize, Archive, RkyvSerialize, RkyvDeserialize)]
pub struct Pose {
    pub position: [f64; 3],
    pub orientation: [f64; 4], // Quaternion [x, y, z, w]
}

impl Message for Pose {
    fn type_name() -> &'static str {
        "ros3_msgs/Pose"
    }
}

impl Default for Pose {
    fn default() -> Self {
        Self {
            position: [0.0; 3],
            orientation: [0.0, 0.0, 0.0, 1.0], // Identity quaternion
        }
    }
}

#[cfg(test)]
mod tests {
    use super::*;

    #[test]
    fn test_robot_state() {
        let state = RobotState::default();
        assert_eq!(state.position, [0.0; 3]);
        assert_eq!(RobotState::type_name(), "ros3_msgs/RobotState");
    }

    #[test]
    fn test_point_cloud() {
        let cloud = PointCloud::default();
        assert_eq!(cloud.points.len(), 0);
        assert_eq!(PointCloud::type_name(), "ros3_msgs/PointCloud");
    }
}