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

use serde::{de::DeserializeOwned, Serialize};

/// Trait to ensure Messages can be (de)serialized
pub trait Message: Serialize + DeserializeOwned {}

impl Message for () {}
impl Message for String {}

pub struct MessageTypeName {
  //TODO: String is UTF-8, but ROS2 uses just ASCII
  ros2_package_name: String, // or shoudl theis ne "namespace"?
  ros2_type_name: String,
}

impl MessageTypeName {
  pub fn new(package_name: &str, type_name: &str) -> Self {
    //TODO: Ensure parameters have no leading/trailing slashes
    MessageTypeName {
      ros2_package_name: package_name.to_owned(),
      ros2_type_name: type_name.to_owned(),
    }
  }

  pub fn dds_msg_type(&self) -> String {
    slash_to_colons(self.ros2_package_name.clone() + "/msg/dds_/" + &self.ros2_type_name + "_")
  }

  pub fn dds_request_type(&self) -> String {
    slash_to_colons(
      self.ros2_package_name.clone() + "/srv/dds_/" + &self.ros2_type_name + "_Request_",
    )
  }

  pub fn dds_response_type(&self) -> String {
    slash_to_colons(
      self.ros2_package_name.clone() + "/srv/dds_/" + &self.ros2_type_name + "_Response_",
    )
  }

  pub fn dds_action_type(&self) -> String {
    slash_to_colons(self.ros2_package_name.clone() + "/action/dds_/" + &self.ros2_type_name)
  }
}

fn slash_to_colons(s: String) -> String {
  s.replace('/', "::")
}