tf2_rs 0.1.0

ROS 2 TF2 bindings for Rust using cxx and rclrs
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24

use crate::transform_stamped::TransformStamped;
use ros_env::geometry_msgs;

impl From<&geometry_msgs::msg::TransformStamped> for TransformStamped {
    fn from(t: &geometry_msgs::msg::TransformStamped) -> Self {
        TransformStamped {
            stamp_sec: t.header.stamp.sec,
            stamp_nanosec: t.header.stamp.nanosec,
            parent_frame: t.header.frame_id.clone(),
            child_frame: t.child_frame_id.clone(),
            translation: [
                t.transform.translation.x,
                t.transform.translation.y,
                t.transform.translation.z,
            ],
            rotation: [
                t.transform.rotation.x,
                t.transform.rotation.y,
                t.transform.rotation.z,
                t.transform.rotation.w,
            ],
        }
    }
}