38
38
#include " geometry_msgs/msg/twist.hpp"
39
39
#include " rclcpp/rclcpp.hpp"
40
40
41
- #include " turtlesim /action/rotate_absolute.hpp"
42
- #include " turtlesim /msg/pose.hpp"
43
- #include " turtlesim /msg/color.hpp"
44
- #include " turtlesim /srv/set_pen.hpp"
45
- #include " turtlesim /srv/teleport_absolute.hpp"
46
- #include " turtlesim /srv/teleport_relative.hpp"
41
+ #include " turtlesim_msgs /action/rotate_absolute.hpp"
42
+ #include " turtlesim_msgs /msg/pose.hpp"
43
+ #include " turtlesim_msgs /msg/color.hpp"
44
+ #include " turtlesim_msgs /srv/set_pen.hpp"
45
+ #include " turtlesim_msgs /srv/teleport_absolute.hpp"
46
+ #include " turtlesim_msgs /srv/teleport_relative.hpp"
47
47
#include " turtlesim/qos.hpp"
48
48
49
49
#define DEFAULT_PEN_R 0xb3
@@ -78,37 +78,38 @@ Turtle::Turtle(
78
78
real_name + " /cmd_vel" , qos, std::bind (
79
79
&Turtle::velocityCallback, this ,
80
80
std::placeholders::_1));
81
- pose_pub_ = nh_->create_publisher <turtlesim ::msg::Pose>(real_name + " /pose" , qos);
82
- color_pub_ = nh_->create_publisher <turtlesim ::msg::Color>(real_name + " /color_sensor" , qos);
81
+ pose_pub_ = nh_->create_publisher <turtlesim_msgs ::msg::Pose>(real_name + " /pose" , qos);
82
+ color_pub_ = nh_->create_publisher <turtlesim_msgs ::msg::Color>(real_name + " /color_sensor" , qos);
83
83
set_pen_srv_ =
84
- nh_->create_service <turtlesim ::srv::SetPen>(
84
+ nh_->create_service <turtlesim_msgs ::srv::SetPen>(
85
85
real_name + " /set_pen" ,
86
86
std::bind (&Turtle::setPenCallback, this , std::placeholders::_1, std::placeholders::_2));
87
- teleport_relative_srv_ = nh_->create_service <turtlesim ::srv::TeleportRelative>(
87
+ teleport_relative_srv_ = nh_->create_service <turtlesim_msgs ::srv::TeleportRelative>(
88
88
real_name + " /teleport_relative" ,
89
89
std::bind (
90
90
&Turtle::teleportRelativeCallback, this , std::placeholders::_1,
91
91
std::placeholders::_2));
92
- teleport_absolute_srv_ = nh_->create_service <turtlesim ::srv::TeleportAbsolute>(
92
+ teleport_absolute_srv_ = nh_->create_service <turtlesim_msgs ::srv::TeleportAbsolute>(
93
93
real_name + " /teleport_absolute" ,
94
94
std::bind (
95
95
&Turtle::teleportAbsoluteCallback, this , std::placeholders::_1,
96
96
std::placeholders::_2));
97
- rotate_absolute_action_server_ = rclcpp_action::create_server<turtlesim::action::RotateAbsolute>(
98
- nh,
99
- real_name + " /rotate_absolute" ,
97
+ rotate_absolute_action_server_ =
98
+ rclcpp_action::create_server<turtlesim_msgs::action::RotateAbsolute>(
99
+ nh,
100
+ real_name + " /rotate_absolute" ,
100
101
[](const rclcpp_action::GoalUUID &,
101
- std::shared_ptr<const turtlesim ::action::RotateAbsolute::Goal>)
102
+ std::shared_ptr<const turtlesim_msgs ::action::RotateAbsolute::Goal>)
102
103
{
103
- // Accept all goals
104
+ // Accept all goals
104
105
return rclcpp_action::GoalResponse::ACCEPT_AND_EXECUTE;
105
- },
106
+ },
106
107
[](const std::shared_ptr<RotateAbsoluteGoalHandle>)
107
108
{
108
- // Accept all cancel requests
109
+ // Accept all cancel requests
109
110
return rclcpp_action::CancelResponse::ACCEPT;
110
- },
111
- std::bind (&Turtle::rotateAbsoluteAcceptCallback, this , std::placeholders::_1));
111
+ },
112
+ std::bind (&Turtle::rotateAbsoluteAcceptCallback, this , std::placeholders::_1));
112
113
113
114
last_command_time_ = nh_->now ();
114
115
@@ -137,8 +138,8 @@ void Turtle::velocityCallback(const geometry_msgs::msg::Twist::ConstSharedPtr ve
137
138
}
138
139
139
140
bool Turtle::setPenCallback (
140
- const turtlesim ::srv::SetPen::Request::SharedPtr req,
141
- turtlesim ::srv::SetPen::Response::SharedPtr)
141
+ const turtlesim_msgs ::srv::SetPen::Request::SharedPtr req,
142
+ turtlesim_msgs ::srv::SetPen::Response::SharedPtr)
142
143
{
143
144
pen_on_ = !req->off ;
144
145
if (req->off ) {
@@ -155,16 +156,16 @@ bool Turtle::setPenCallback(
155
156
}
156
157
157
158
bool Turtle::teleportRelativeCallback (
158
- const turtlesim ::srv::TeleportRelative::Request::SharedPtr req,
159
- turtlesim ::srv::TeleportRelative::Response::SharedPtr)
159
+ const turtlesim_msgs ::srv::TeleportRelative::Request::SharedPtr req,
160
+ turtlesim_msgs ::srv::TeleportRelative::Response::SharedPtr)
160
161
{
161
162
teleport_requests_.push_back (TeleportRequest (0 , 0 , req->angular , req->linear , true ));
162
163
return true ;
163
164
}
164
165
165
166
bool Turtle::teleportAbsoluteCallback (
166
- const turtlesim ::srv::TeleportAbsolute::Request::SharedPtr req,
167
- turtlesim ::srv::TeleportAbsolute::Response::SharedPtr)
167
+ const turtlesim_msgs ::srv::TeleportAbsolute::Request::SharedPtr req,
168
+ turtlesim_msgs ::srv::TeleportAbsolute::Response::SharedPtr)
168
169
{
169
170
teleport_requests_.push_back (TeleportRequest (req->x , req->y , req->theta , 0 , false ));
170
171
return true ;
@@ -181,8 +182,8 @@ void Turtle::rotateAbsoluteAcceptCallback(
181
182
rotate_absolute_goal_handle_->abort (rotate_absolute_result_);
182
183
}
183
184
rotate_absolute_goal_handle_ = goal_handle;
184
- rotate_absolute_feedback_.reset (new turtlesim ::action::RotateAbsolute::Feedback);
185
- rotate_absolute_result_.reset (new turtlesim ::action::RotateAbsolute::Result);
185
+ rotate_absolute_feedback_.reset (new turtlesim_msgs ::action::RotateAbsolute::Feedback);
186
+ rotate_absolute_result_.reset (new turtlesim_msgs ::action::RotateAbsolute::Result);
186
187
rotate_absolute_start_orient_ = orient_;
187
188
}
188
189
@@ -300,7 +301,7 @@ bool Turtle::update(
300
301
static_cast <double >(canvas_height)));
301
302
302
303
// Publish pose of the turtle
303
- auto p = std::make_unique<turtlesim ::msg::Pose>();
304
+ auto p = std::make_unique<turtlesim_msgs ::msg::Pose>();
304
305
p->x = pos_.x ();
305
306
p->y = canvas_height - pos_.y ();
306
307
p->theta = orient_;
@@ -310,7 +311,7 @@ bool Turtle::update(
310
311
311
312
// Figure out (and publish) the color underneath the turtle
312
313
{
313
- auto color = std::make_unique<turtlesim ::msg::Color>();
314
+ auto color = std::make_unique<turtlesim_msgs ::msg::Color>();
314
315
QRgb pixel = path_image.pixel ((pos_ * meter_).toPoint ());
315
316
color->r = qRed (pixel);
316
317
color->g = qGreen (pixel);
0 commit comments