3838#include " geometry_msgs/msg/twist.hpp"
3939#include " rclcpp/rclcpp.hpp"
4040
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"
4747#include " turtlesim/qos.hpp"
4848
4949#define DEFAULT_PEN_R 0xb3
@@ -78,37 +78,38 @@ Turtle::Turtle(
7878 real_name + " /cmd_vel" , qos, std::bind (
7979 &Turtle::velocityCallback, this ,
8080 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);
8383 set_pen_srv_ =
84- nh_->create_service <turtlesim ::srv::SetPen>(
84+ nh_->create_service <turtlesim_msgs ::srv::SetPen>(
8585 real_name + " /set_pen" ,
8686 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>(
8888 real_name + " /teleport_relative" ,
8989 std::bind (
9090 &Turtle::teleportRelativeCallback, this , std::placeholders::_1,
9191 std::placeholders::_2));
92- teleport_absolute_srv_ = nh_->create_service <turtlesim ::srv::TeleportAbsolute>(
92+ teleport_absolute_srv_ = nh_->create_service <turtlesim_msgs ::srv::TeleportAbsolute>(
9393 real_name + " /teleport_absolute" ,
9494 std::bind (
9595 &Turtle::teleportAbsoluteCallback, this , std::placeholders::_1,
9696 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" ,
100101 [](const rclcpp_action::GoalUUID &,
101- std::shared_ptr<const turtlesim ::action::RotateAbsolute::Goal>)
102+ std::shared_ptr<const turtlesim_msgs ::action::RotateAbsolute::Goal>)
102103 {
103- // Accept all goals
104+ // Accept all goals
104105 return rclcpp_action::GoalResponse::ACCEPT_AND_EXECUTE;
105- },
106+ },
106107 [](const std::shared_ptr<RotateAbsoluteGoalHandle>)
107108 {
108- // Accept all cancel requests
109+ // Accept all cancel requests
109110 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));
112113
113114 last_command_time_ = nh_->now ();
114115
@@ -137,8 +138,8 @@ void Turtle::velocityCallback(const geometry_msgs::msg::Twist::ConstSharedPtr ve
137138}
138139
139140bool 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)
142143{
143144 pen_on_ = !req->off ;
144145 if (req->off ) {
@@ -155,16 +156,16 @@ bool Turtle::setPenCallback(
155156}
156157
157158bool 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)
160161{
161162 teleport_requests_.push_back (TeleportRequest (0 , 0 , req->angular , req->linear , true ));
162163 return true ;
163164}
164165
165166bool 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)
168169{
169170 teleport_requests_.push_back (TeleportRequest (req->x , req->y , req->theta , 0 , false ));
170171 return true ;
@@ -181,8 +182,8 @@ void Turtle::rotateAbsoluteAcceptCallback(
181182 rotate_absolute_goal_handle_->abort (rotate_absolute_result_);
182183 }
183184 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);
186187 rotate_absolute_start_orient_ = orient_;
187188}
188189
@@ -300,7 +301,7 @@ bool Turtle::update(
300301 static_cast <double >(canvas_height)));
301302
302303 // Publish pose of the turtle
303- auto p = std::make_unique<turtlesim ::msg::Pose>();
304+ auto p = std::make_unique<turtlesim_msgs ::msg::Pose>();
304305 p->x = pos_.x ();
305306 p->y = canvas_height - pos_.y ();
306307 p->theta = orient_;
@@ -310,7 +311,7 @@ bool Turtle::update(
310311
311312 // Figure out (and publish) the color underneath the turtle
312313 {
313- auto color = std::make_unique<turtlesim ::msg::Color>();
314+ auto color = std::make_unique<turtlesim_msgs ::msg::Color>();
314315 QRgb pixel = path_image.pixel ((pos_ * meter_).toPoint ());
315316 color->r = qRed (pixel);
316317 color->g = qGreen (pixel);
0 commit comments