diff --git a/rclrs/dynamic_pub_sub/Cargo.toml b/rclrs/dynamic_pub_sub/Cargo.toml new file mode 100644 index 0000000..6e7fc65 --- /dev/null +++ b/rclrs/dynamic_pub_sub/Cargo.toml @@ -0,0 +1,18 @@ +[package] +name = "examples_rclrs_dynamic_pub_sub" +version = "0.4.1" +authors = ["Luca Della Vedova "] +edition = "2021" + +[[bin]] +name = "dynamic_subscriber" +path = "src/dynamic_subscriber.rs" + +[[bin]] +name = "dynamic_publisher" +path = "src/dynamic_publisher.rs" + +[dependencies] +# TODO(luca) change this to the correct version once dynamic message support is released on crates.io +rclrs = { git = "https://github.com/luca-della-vedova/ros2_rust", branch = "dynamic_messages" } +anyhow = {version = "1", features = ["backtrace"]} diff --git a/rclrs/dynamic_pub_sub/package.xml b/rclrs/dynamic_pub_sub/package.xml new file mode 100644 index 0000000..195e373 --- /dev/null +++ b/rclrs/dynamic_pub_sub/package.xml @@ -0,0 +1,22 @@ + + + + examples_rclrs_dynamic_pub_sub + 0.4.1 + Package containing an example of dynamic messages publishers and subscribtions in rclrs. + Luca Della Vedova + Apache License 2.0 + + rclrs + + + example_interfaces + rclrs + + + ament_cargo + + + diff --git a/rclrs/dynamic_pub_sub/src/dynamic_publisher.rs b/rclrs/dynamic_pub_sub/src/dynamic_publisher.rs new file mode 100644 index 0000000..6deffc2 --- /dev/null +++ b/rclrs/dynamic_pub_sub/src/dynamic_publisher.rs @@ -0,0 +1,38 @@ +use anyhow::{Error, Result}; +use rclrs::*; + +fn main() -> Result<(), Error> { + let context = Context::default_from_env()?; + let executor = context.create_basic_executor(); + + let node = executor.create_node("minimal_publisher")?; + + let message_type = MessageTypeName { + package_name: "example_interfaces".to_owned(), + type_name: "String".to_owned(), + }; + + let publisher = node.create_dynamic_publisher(message_type.clone(), "topic")?; + + let message_metadata = DynamicMessageMetadata::new(message_type)?; + + let mut publish_count: u32 = 1; + + while context.ok() { + let mut message = message_metadata.create()?; + + let Some(ValueMut::Simple(data)) = message.get_mut("data") else { + panic!("Unexpected value type, expected Simple value"); + }; + + let SimpleValueMut::String(data) = data else { + panic!("Unexpected value type, expected String"); + }; + *data = format!("Hello, world! {}", publish_count).into(); + println!("Publishing: [{}]", data); + publisher.publish(message)?; + publish_count += 1; + std::thread::sleep(std::time::Duration::from_millis(500)); + } + Ok(()) +} diff --git a/rclrs/dynamic_pub_sub/src/dynamic_subscriber.rs b/rclrs/dynamic_pub_sub/src/dynamic_subscriber.rs new file mode 100644 index 0000000..ed4782e --- /dev/null +++ b/rclrs/dynamic_pub_sub/src/dynamic_subscriber.rs @@ -0,0 +1,23 @@ +use anyhow::{Error, Result}; +use rclrs::*; + +fn main() -> Result<(), Error> { + let context = Context::default_from_env()?; + let mut executor = context.create_basic_executor(); + + let node = executor.create_node("dynamic_subscriber")?; + + let worker = node.create_worker::(0); + let _subscription = worker.create_dynamic_subscription( + "example_interfaces/msg/String".try_into()?, + "topic", + move |num_messages: &mut usize, msg, _msg_info| { + *num_messages += 1; + println!("#{} | I heard: '{:#?}'", *num_messages, msg.structure()); + }, + )?; + + println!("Waiting for messages..."); + executor.spin(SpinOptions::default()).first_error()?; + Ok(()) +}