niklas/rclcpp
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions

adapt to action implicit changes (#602)

Browse source
This commit is contained in:
Shane Loretz 2018-12-06 16:42:25 -08:00 • committed by GitHub
parent fe09d937b7
commit ef2014ac4d
No known key found for this signature in database
GPG key ID: 4AEE18F83AFDEB23
5 changed files with 31 additions and 29 deletions
Download patch file Download diff file Expand all files Collapse all files

10
rclcpp_action/include/rclcpp_action/client.hpp
View file

@ -265,7 +265,7 @@ public:
// goal_request->goal_id = this->generate_goal_id();
// goal_request->goal = goal;
auto goal_request = std::make_shared<GoalRequest>(goal);
goal_request->uuid = this->generate_goal_id();
goal_request->action_goal_id.uuid = this->generate_goal_id();
this->send_goal_request(
std::static_pointer_cast<void>(goal_request),
[this, goal_request, callback, ignore_result, promise](
@ -279,7 +279,7 @@ public:
}
GoalInfo goal_info;
// goal_info.goal_id = goal_request->goal_id;
goal_info.goal_id.uuid = goal_request->uuid;
goal_info.goal_id.uuid = goal_request->action_goal_id.uuid;
goal_info.stamp = goal_response->stamp;
// Do not use std::make_shared as friendship cannot be forwarded.
std::shared_ptr<GoalHandle> goal_handle(new GoalHandle(goal_info, callback));
@ -419,7 +419,7 @@ private:
typename Feedback::SharedPtr feedback_message =
std::static_pointer_cast<Feedback>(message);
// const GoalID & goal_id = feedback_message->goal_id;
const GoalID & goal_id = feedback_message->uuid;
const GoalID & goal_id = feedback_message->action_goal_id.uuid;
if (goal_handles_.count(goal_id) == 0) {
RCLCPP_DEBUG(
this->get_logger(),
@ -475,7 +475,7 @@ private:
using GoalResultRequest = typename ActionT::GoalResultService::Request;
auto goal_result_request = std::make_shared<GoalResultRequest>();
// goal_result_request.goal_id = goal_handle->get_goal_id();
goal_result_request->uuid = goal_handle->get_goal_id();
goal_result_request->action_goal_id.uuid = goal_handle->get_goal_id();
this->send_result_request(
std::static_pointer_cast<void>(goal_result_request),
[goal_handle, this](std::shared_ptr<void> response) mutable
@ -485,7 +485,7 @@ private:
using GoalResultResponse = typename ActionT::GoalResultService::Response;
result.response = std::static_pointer_cast<GoalResultResponse>(response);
result.goal_id = goal_handle->get_goal_id();
result.code = static_cast<ResultCode>(result.response->status);
result.code = static_cast<ResultCode>(result.response->action_status);
goal_handle->set_result(result);
std::lock_guard<std::mutex> lock(goal_handles_mutex_);
goal_handles_.erase(goal_handle->get_goal_id());

8
rclcpp_action/include/rclcpp_action/server.hpp
View file

@ -434,7 +434,8 @@ protected:
GoalID
get_goal_id_from_goal_request(void * message) override
{
return static_cast<typename ActionT::GoalRequestService::Request *>(message)->uuid;
return
static_cast<typename ActionT::GoalRequestService::Request *>(message)->action_goal_id.uuid;
}
/// \internal
@ -448,7 +449,8 @@ protected:
GoalID
get_goal_id_from_result_request(void * message) override
{
return static_cast<typename ActionT::GoalResultService::Request *>(message)->uuid;
return
static_cast<typename ActionT::GoalResultService::Request *>(message)->action_goal_id.uuid;
}
/// \internal
@ -463,7 +465,7 @@ protected:
create_result_response(decltype(action_msgs::msg::GoalStatus::status) status) override
{
auto result = std::make_shared<typename ActionT::GoalResultService::Response>();
result->status = status;
result->action_status = status;
return std::static_pointer_cast<void>(result);
}

10
rclcpp_action/include/rclcpp_action/server_goal_handle.hpp
View file

@ -147,7 +147,7 @@ public:
void
publish_feedback(std::shared_ptr<typename ActionT::Feedback> feedback_msg)
{
feedback_msg->uuid = uuid_;
feedback_msg->action_goal_id.uuid = uuid_;
publish_feedback_(feedback_msg);
}
@ -165,7 +165,7 @@ public:
set_aborted(typename ActionT::Result::SharedPtr result_msg)
{
_set_aborted();
result_msg->status = action_msgs::msg::GoalStatus::STATUS_ABORTED;
result_msg->action_status = action_msgs::msg::GoalStatus::STATUS_ABORTED;
on_terminal_state_(uuid_, result_msg);
}
@ -182,7 +182,7 @@ public:
set_succeeded(typename ActionT::Result::SharedPtr result_msg)
{
_set_succeeded();
result_msg->status = action_msgs::msg::GoalStatus::STATUS_SUCCEEDED;
result_msg->action_status = action_msgs::msg::GoalStatus::STATUS_SUCCEEDED;
on_terminal_state_(uuid_, result_msg);
}
@ -199,7 +199,7 @@ public:
set_canceled(typename ActionT::Result::SharedPtr result_msg)
{
_set_canceled();
result_msg->status = action_msgs::msg::GoalStatus::STATUS_CANCELED;
result_msg->action_status = action_msgs::msg::GoalStatus::STATUS_CANCELED;
on_terminal_state_(uuid_, result_msg);
}
@ -234,7 +234,7 @@ public:
// Cancel goal if handle was allowed to destruct without reaching a terminal state
if (try_canceling()) {
auto null_result = std::make_shared<typename ActionT::Result>();
null_result->status = action_msgs::msg::GoalStatus::STATUS_CANCELED;
null_result->action_status = action_msgs::msg::GoalStatus::STATUS_CANCELED;
on_terminal_state_(uuid_, null_result);
}
}