-
Notifications
You must be signed in to change notification settings - Fork 2
Expand file tree
/
Copy pathstring_publisher.cpp
More file actions
58 lines (45 loc) · 1.94 KB
/
string_publisher.cpp
File metadata and controls
58 lines (45 loc) · 1.94 KB
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
/* -----------------------------------------------------------------------------
Copyright 2024 Nipun Dhananjaya Weerakkodi
Licensed under the Apache License, Version 2.0 (the "License");
you may not use this file except in compliance with the License.
You may obtain a copy of the License at
http://www.apache.org/licenses/LICENSE-2.0
Unless required by applicable law or agreed to in writing, software
distributed under the License is distributed on an "AS IS" BASIS,
WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
See the License for the specific language governing permissions and
limitations under the License.
-----------------------------------------------------------------------------*/
#include <memory>
#include "dynrclcpp/node_base.hpp"
class StringPublisher{
public:
StringPublisher(const std::string& name, int argc, char** argv){
// initialize the node
node_ = std::make_shared<dynrclcpp::NODE>(name);
// node_->set_debug_severity(RCUTILS_LOG_SEVERITY_DEBUG);
node_->init(argc, argv);
// initialize the publisher
publisher_ = node_->create_publisher("topic", "std_msgs/msg/String", QOS_DEFAULT);
// bind the publisher to a timer
if(publisher_ != nullptr)
publisher_->timer = node_->create_timer("timer1", std::bind(&StringPublisher::timer_callback, this), std::chrono::seconds(1));
}
void timer_callback(){
YAML::Node msg;
std::string data = "Hello world: " + std::to_string(count++);
msg["data"] = data;
RCUTILS_LOG_INFO_NAMED(node_->node_name.c_str(), "publishing: %s", data.c_str());
publisher_->publish(msg);
}
private:
std::shared_ptr<dynrclcpp::NODE> node_;
std::shared_ptr<dynrclcpp::Publisher> publisher_;
int count = 0;
};
int main(int argc, char** argv)
{
StringPublisher node("string_publisher", argc, argv);
dynrclcpp::spin();
return 0;
}