Advertisement
Guest User

Untitled

a guest
Apr 26th, 2017
61
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 2.15 KB | None | 0 0
  1. diff --git a/demo_nodes_cpp/src/topics/listener.cpp b/demo_nodes_cpp/src/topics/listener.cpp
  2. index 454f896..aa81a66 100644
  3. --- a/demo_nodes_cpp/src/topics/listener.cpp
  4. +++ b/demo_nodes_cpp/src/topics/listener.cpp
  5. @@ -14,6 +14,7 @@
  6.  
  7. #include <iostream>
  8. #include <memory>
  9. +#include <vector>
  10.  
  11. #include "rclcpp/rclcpp.hpp"
  12.  
  13. @@ -29,8 +30,13 @@ int main(int argc, char * argv[])
  14. rclcpp::init(argc, argv);
  15. auto node = rclcpp::Node::make_shared("listener");
  16.  
  17. - auto sub = node->create_subscription<std_msgs::msg::String>(
  18. - "chatter", chatterCallback, rmw_qos_profile_default);
  19. + std::vector<rclcpp::subscription::SubscriptionBase::SharedPtr> subs;
  20. +
  21. + for (size_t i = 0; i < 40; ++i) {
  22. + auto sub = node->create_subscription<std_msgs::msg::String>(
  23. + "chatter" + std::to_string(i), chatterCallback, rmw_qos_profile_default);
  24. + subs.push_back(sub);
  25. + }
  26.  
  27. rclcpp::spin(node);
  28.  
  29. diff --git a/demo_nodes_cpp/src/topics/talker.cpp b/demo_nodes_cpp/src/topics/talker.cpp
  30. index c1b73f0..fe19834 100644
  31. --- a/demo_nodes_cpp/src/topics/talker.cpp
  32. +++ b/demo_nodes_cpp/src/topics/talker.cpp
  33. @@ -14,6 +14,7 @@
  34.  
  35. #include <iostream>
  36. #include <memory>
  37. +#include <vector>
  38.  
  39. #include "rclcpp/rclcpp.hpp"
  40.  
  41. @@ -28,7 +29,14 @@ int main(int argc, char * argv[])
  42. rmw_qos_profile_t custom_qos_profile = rmw_qos_profile_default;
  43. custom_qos_profile.depth = 7;
  44.  
  45. - auto chatter_pub = node->create_publisher<std_msgs::msg::String>("chatter", custom_qos_profile);
  46. + std::vector<rclcpp::publisher::Publisher<std_msgs::msg::String>::SharedPtr> publishers;
  47. +
  48. + for (size_t i = 0; i < 40; ++i) {
  49. + auto chatter_pub = node->create_publisher<std_msgs::msg::String>(
  50. + "chatter" + std::to_string(i),
  51. + custom_qos_profile);
  52. + publishers.push_back(chatter_pub);
  53. + }
  54.  
  55. rclcpp::WallRate loop_rate(2);
  56.  
  57. @@ -38,7 +46,9 @@ int main(int argc, char * argv[])
  58. while (rclcpp::ok()) {
  59. msg->data = "Hello World: " + std::to_string(i++);
  60. std::cout << "Publishing: '" << msg->data << "'" << std::endl;
  61. - chatter_pub->publish(msg);
  62. + for (auto publisher : publishers) {
  63. + publisher->publish(msg);
  64. + }
  65. rclcpp::spin_some(node);
  66. loop_rate.sleep();
  67. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement