Change UUID type in action msgs (#338)

* Make use of unique_identifier_msgs/uuid in rcl_action

* Update to use goal_id.uuid

* Remove unnecessary find_package of unique_identifier_msgs
This commit is contained in:
Alexis Pojomovsky 2018-12-04 16:05:20 -03:00 committed by Shane Loretz
parent c1dfda97e1
commit b1c4d95abe
6 changed files with 44 additions and 43 deletions

View file

@ -734,7 +734,7 @@ rcl_action_process_cancel_request(
// Request data // Request data
const rcl_action_goal_info_t * request_goal_info = &cancel_request->goal_info; const rcl_action_goal_info_t * request_goal_info = &cancel_request->goal_info;
const uint8_t * request_uuid = request_goal_info->uuid; const uint8_t * request_uuid = request_goal_info->goal_id.uuid;
int64_t request_nanosec = _goal_info_stamp_to_nanosec(request_goal_info); int64_t request_nanosec = _goal_info_stamp_to_nanosec(request_goal_info);
rcl_ret_t ret_final = RCL_RET_OK; rcl_ret_t ret_final = RCL_RET_OK;
@ -751,7 +751,7 @@ rcl_action_process_cancel_request(
continue; continue;
} }
if (uuidcmp(request_uuid, goal_info.uuid)) { if (uuidcmp(request_uuid, goal_info.goal_id.uuid)) {
if (rcl_action_goal_handle_is_cancelable(goal_handle)) { if (rcl_action_goal_handle_is_cancelable(goal_handle)) {
goal_handles_to_cancel[num_goals_to_cancel++] = goal_handle; goal_handles_to_cancel[num_goals_to_cancel++] = goal_handle;
} }
@ -779,7 +779,7 @@ rcl_action_process_cancel_request(
const int64_t goal_nanosec = _goal_info_stamp_to_nanosec(&goal_info); const int64_t goal_nanosec = _goal_info_stamp_to_nanosec(&goal_info);
if (rcl_action_goal_handle_is_cancelable(goal_handle) && if (rcl_action_goal_handle_is_cancelable(goal_handle) &&
((goal_nanosec <= request_nanosec) || uuidcmp(request_uuid, goal_info.uuid))) ((goal_nanosec <= request_nanosec) || uuidcmp(request_uuid, goal_info.goal_id.uuid)))
{ {
goal_handles_to_cancel[num_goals_to_cancel++] = goal_handle; goal_handles_to_cancel[num_goals_to_cancel++] = goal_handle;
} }
@ -880,7 +880,7 @@ rcl_action_server_goal_exists(
return false; return false;
} }
// Compare UUIDs // Compare UUIDs
if (uuidcmp(gh_goal_info.uuid, goal_info->uuid)) { if (uuidcmp(gh_goal_info.goal_id.uuid, goal_info->goal_id.uuid)) {
return true; return true;
} }
} }

View file

@ -23,7 +23,7 @@ extern "C"
rcl_action_goal_info_t rcl_action_goal_info_t
rcl_action_get_zero_initialized_goal_info(void) rcl_action_get_zero_initialized_goal_info(void)
{ {
static rcl_action_goal_info_t goal_info = {{0}, {0, 0}}; static rcl_action_goal_info_t goal_info = {{{0}}, {0, 0}};
return goal_info; return goal_info;
} }
@ -37,7 +37,7 @@ rcl_action_get_zero_initialized_goal_status_array(void)
rcl_action_cancel_request_t rcl_action_cancel_request_t
rcl_action_get_zero_initialized_cancel_request(void) rcl_action_get_zero_initialized_cancel_request(void)
{ {
static rcl_action_cancel_request_t request = {{{0}, {0, 0}}}; static rcl_action_cancel_request_t request = {{{{0}}, {0, 0}}};
return request; return request;
} }

View file

@ -284,7 +284,7 @@ TEST_F(CLASSNAME(TestActionCommunication, RMW_IMPLEMENTATION), test_valid_cancel
action_msgs__srv__CancelGoal_Response__init(&incoming_cancel_response); action_msgs__srv__CancelGoal_Response__init(&incoming_cancel_response);
// Initialize cancel request // Initialize cancel request
init_test_uuid0(outgoing_cancel_request.goal_info.uuid); init_test_uuid0(outgoing_cancel_request.goal_info.goal_id.uuid);
outgoing_cancel_request.goal_info.stamp.sec = 321; outgoing_cancel_request.goal_info.stamp.sec = 321;
outgoing_cancel_request.goal_info.stamp.nanosec = 987654u; outgoing_cancel_request.goal_info.stamp.nanosec = 987654u;
@ -326,8 +326,8 @@ TEST_F(CLASSNAME(TestActionCommunication, RMW_IMPLEMENTATION), test_valid_cancel
// Check that the cancel request was received correctly // Check that the cancel request was received correctly
EXPECT_TRUE(uuidcmp( EXPECT_TRUE(uuidcmp(
outgoing_cancel_request.goal_info.uuid, outgoing_cancel_request.goal_info.goal_id.uuid,
incoming_cancel_request.goal_info.uuid)); incoming_cancel_request.goal_info.goal_id.uuid));
EXPECT_EQ( EXPECT_EQ(
outgoing_cancel_request.goal_info.stamp.sec, outgoing_cancel_request.goal_info.stamp.sec,
incoming_cancel_request.goal_info.stamp.sec); incoming_cancel_request.goal_info.stamp.sec);
@ -338,10 +338,10 @@ TEST_F(CLASSNAME(TestActionCommunication, RMW_IMPLEMENTATION), test_valid_cancel
// Initialize cancel request // Initialize cancel request
ASSERT_TRUE(action_msgs__msg__GoalInfo__Sequence__init( ASSERT_TRUE(action_msgs__msg__GoalInfo__Sequence__init(
&outgoing_cancel_response.goals_canceling, 2)); &outgoing_cancel_response.goals_canceling, 2));
init_test_uuid0(outgoing_cancel_response.goals_canceling.data[0].uuid); init_test_uuid0(outgoing_cancel_response.goals_canceling.data[0].goal_id.uuid);
outgoing_cancel_response.goals_canceling.data[0].stamp.sec = 102; outgoing_cancel_response.goals_canceling.data[0].stamp.sec = 102;
outgoing_cancel_response.goals_canceling.data[0].stamp.nanosec = 9468u; outgoing_cancel_response.goals_canceling.data[0].stamp.nanosec = 9468u;
init_test_uuid1(outgoing_cancel_response.goals_canceling.data[1].uuid); init_test_uuid1(outgoing_cancel_response.goals_canceling.data[1].goal_id.uuid);
outgoing_cancel_response.goals_canceling.data[1].stamp.sec = 867; outgoing_cancel_response.goals_canceling.data[1].stamp.sec = 867;
outgoing_cancel_response.goals_canceling.data[1].stamp.nanosec = 6845u; outgoing_cancel_response.goals_canceling.data[1].stamp.nanosec = 6845u;
@ -395,7 +395,7 @@ TEST_F(CLASSNAME(TestActionCommunication, RMW_IMPLEMENTATION), test_valid_cancel
&outgoing_cancel_response.goals_canceling.data[i]; &outgoing_cancel_response.goals_canceling.data[i];
const action_msgs__msg__GoalInfo * incoming_goal_info = const action_msgs__msg__GoalInfo * incoming_goal_info =
&incoming_cancel_response.goals_canceling.data[i]; &incoming_cancel_response.goals_canceling.data[i];
EXPECT_TRUE(uuidcmp(outgoing_goal_info->uuid, incoming_goal_info->uuid)); EXPECT_TRUE(uuidcmp(outgoing_goal_info->goal_id.uuid, incoming_goal_info->goal_id.uuid));
EXPECT_EQ(outgoing_goal_info->stamp.sec, incoming_goal_info->stamp.sec); EXPECT_EQ(outgoing_goal_info->stamp.sec, incoming_goal_info->stamp.sec);
EXPECT_EQ(outgoing_goal_info->stamp.nanosec, incoming_goal_info->stamp.nanosec); EXPECT_EQ(outgoing_goal_info->stamp.nanosec, incoming_goal_info->stamp.nanosec);
} }
@ -592,7 +592,8 @@ TEST_F(CLASSNAME(TestActionCommunication, RMW_IMPLEMENTATION), test_valid_status
&status_array.msg.status_list.data[i]; &status_array.msg.status_list.data[i];
const action_msgs__msg__GoalStatus * incoming_status = const action_msgs__msg__GoalStatus * incoming_status =
&incoming_status_array.status_list.data[i]; &incoming_status_array.status_list.data[i];
EXPECT_TRUE(uuidcmp(outgoing_status->goal_info.uuid, incoming_status->goal_info.uuid)); EXPECT_TRUE(
uuidcmp(outgoing_status->goal_info.goal_id.uuid, incoming_status->goal_info.goal_id.uuid));
EXPECT_EQ(outgoing_status->goal_info.stamp.sec, incoming_status->goal_info.stamp.sec); EXPECT_EQ(outgoing_status->goal_info.stamp.sec, incoming_status->goal_info.stamp.sec);
EXPECT_EQ(outgoing_status->goal_info.stamp.nanosec, incoming_status->goal_info.stamp.nanosec); EXPECT_EQ(outgoing_status->goal_info.stamp.nanosec, incoming_status->goal_info.stamp.nanosec);
EXPECT_EQ(outgoing_status->status, incoming_status->status); EXPECT_EQ(outgoing_status->status, incoming_status->status);
@ -794,7 +795,7 @@ TEST_F(CLASSNAME(TestActionCommunication, RMW_IMPLEMENTATION), test_invalid_canc
action_msgs__srv__CancelGoal_Request__init(&incoming_cancel_request); action_msgs__srv__CancelGoal_Request__init(&incoming_cancel_request);
// Initialize cancel request // Initialize cancel request
init_test_uuid0(outgoing_cancel_request.goal_info.uuid); init_test_uuid0(outgoing_cancel_request.goal_info.goal_id.uuid);
outgoing_cancel_request.goal_info.stamp.sec = 321; outgoing_cancel_request.goal_info.stamp.sec = 321;
outgoing_cancel_request.goal_info.stamp.nanosec = 987654u; outgoing_cancel_request.goal_info.stamp.nanosec = 987654u;
@ -855,10 +856,10 @@ TEST_F(CLASSNAME(TestActionCommunication, RMW_IMPLEMENTATION), test_invalid_canc
// Initialize cancel request // Initialize cancel request
ASSERT_TRUE(action_msgs__msg__GoalInfo__Sequence__init( ASSERT_TRUE(action_msgs__msg__GoalInfo__Sequence__init(
&outgoing_cancel_response.goals_canceling, 2)); &outgoing_cancel_response.goals_canceling, 2));
init_test_uuid0(outgoing_cancel_response.goals_canceling.data[0].uuid); init_test_uuid0(outgoing_cancel_response.goals_canceling.data[0].goal_id.uuid);
outgoing_cancel_response.goals_canceling.data[0].stamp.sec = 102; outgoing_cancel_response.goals_canceling.data[0].stamp.sec = 102;
outgoing_cancel_response.goals_canceling.data[0].stamp.nanosec = 9468u; outgoing_cancel_response.goals_canceling.data[0].stamp.nanosec = 9468u;
init_test_uuid1(outgoing_cancel_response.goals_canceling.data[1].uuid); init_test_uuid1(outgoing_cancel_response.goals_canceling.data[1].goal_id.uuid);
outgoing_cancel_response.goals_canceling.data[1].stamp.sec = 867; outgoing_cancel_response.goals_canceling.data[1].stamp.sec = 867;
outgoing_cancel_response.goals_canceling.data[1].stamp.nanosec = 6845u; outgoing_cancel_response.goals_canceling.data[1].stamp.nanosec = 6845u;

View file

@ -227,7 +227,7 @@ TEST_F(TestActionServer, test_action_accept_new_goal)
{ {
// Initialize a goal info // Initialize a goal info
rcl_action_goal_info_t goal_info_in = rcl_action_get_zero_initialized_goal_info(); rcl_action_goal_info_t goal_info_in = rcl_action_get_zero_initialized_goal_info();
init_test_uuid0(goal_info_in.uuid); init_test_uuid0(goal_info_in.goal_id.uuid);
// Accept goal with a null action server // Accept goal with a null action server
rcl_action_goal_handle_t * goal_handle = rcl_action_accept_new_goal(nullptr, &goal_info_in); rcl_action_goal_handle_t * goal_handle = rcl_action_accept_new_goal(nullptr, &goal_info_in);
@ -254,7 +254,7 @@ TEST_F(TestActionServer, test_action_accept_new_goal)
rcl_action_goal_info_t goal_info_out = rcl_action_get_zero_initialized_goal_info(); rcl_action_goal_info_t goal_info_out = rcl_action_get_zero_initialized_goal_info();
rcl_ret_t ret = rcl_action_goal_handle_get_info(goal_handle, &goal_info_out); rcl_ret_t ret = rcl_action_goal_handle_get_info(goal_handle, &goal_info_out);
ASSERT_EQ(ret, RCL_RET_OK) << rcl_get_error_string().str; ASSERT_EQ(ret, RCL_RET_OK) << rcl_get_error_string().str;
EXPECT_TRUE(uuidcmp(goal_info_out.uuid, goal_info_in.uuid)); EXPECT_TRUE(uuidcmp(goal_info_out.goal_id.uuid, goal_info_in.goal_id.uuid));
size_t num_goals = 0u; size_t num_goals = 0u;
rcl_action_goal_handle_t ** goal_handle_array = {nullptr}; rcl_action_goal_handle_t ** goal_handle_array = {nullptr};
ret = rcl_action_server_get_goal_handles(&this->action_server, &goal_handle_array, &num_goals); ret = rcl_action_server_get_goal_handles(&this->action_server, &goal_handle_array, &num_goals);
@ -270,13 +270,13 @@ TEST_F(TestActionServer, test_action_accept_new_goal)
// Accept a different goal // Accept a different goal
goal_info_in = rcl_action_get_zero_initialized_goal_info(); goal_info_in = rcl_action_get_zero_initialized_goal_info();
init_test_uuid1(goal_info_in.uuid); init_test_uuid1(goal_info_in.goal_id.uuid);
goal_handle = rcl_action_accept_new_goal(&this->action_server, &goal_info_in); goal_handle = rcl_action_accept_new_goal(&this->action_server, &goal_info_in);
EXPECT_NE(goal_handle, nullptr) << rcl_get_error_string().str; EXPECT_NE(goal_handle, nullptr) << rcl_get_error_string().str;
handles.push_back(*goal_handle); handles.push_back(*goal_handle);
ret = rcl_action_goal_handle_get_info(goal_handle, &goal_info_out); ret = rcl_action_goal_handle_get_info(goal_handle, &goal_info_out);
ASSERT_EQ(ret, RCL_RET_OK) << rcl_get_error_string().str; ASSERT_EQ(ret, RCL_RET_OK) << rcl_get_error_string().str;
EXPECT_TRUE(uuidcmp(goal_info_out.uuid, goal_info_in.uuid)); EXPECT_TRUE(uuidcmp(goal_info_out.goal_id.uuid, goal_info_in.goal_id.uuid));
ret = rcl_action_server_get_goal_handles(&this->action_server, &goal_handle_array, &num_goals); ret = rcl_action_server_get_goal_handles(&this->action_server, &goal_handle_array, &num_goals);
ASSERT_EQ(ret, RCL_RET_OK); ASSERT_EQ(ret, RCL_RET_OK);
EXPECT_EQ(num_goals, 2u); EXPECT_EQ(num_goals, 2u);
@ -322,7 +322,7 @@ TEST_F(TestActionServer, test_action_clear_expired_goals)
ASSERT_EQ(RCL_RET_OK, rcl_set_ros_time_override(&this->clock, RCUTILS_S_TO_NS(1))); ASSERT_EQ(RCL_RET_OK, rcl_set_ros_time_override(&this->clock, RCUTILS_S_TO_NS(1)));
// Accept a goal to create a new handle // Accept a goal to create a new handle
rcl_action_goal_info_t goal_info_in = rcl_action_get_zero_initialized_goal_info(); rcl_action_goal_info_t goal_info_in = rcl_action_get_zero_initialized_goal_info();
init_test_uuid1(goal_info_in.uuid); init_test_uuid1(goal_info_in.goal_id.uuid);
rcl_action_goal_handle_t * goal_handle = rcl_action_goal_handle_t * goal_handle =
rcl_action_accept_new_goal(&this->action_server, &goal_info_in); rcl_action_accept_new_goal(&this->action_server, &goal_info_in);
ASSERT_NE(goal_handle, nullptr) << rcl_get_error_string().str; ASSERT_NE(goal_handle, nullptr) << rcl_get_error_string().str;
@ -336,7 +336,7 @@ TEST_F(TestActionServer, test_action_clear_expired_goals)
ret = rcl_action_expire_goals(&this->action_server, expired_goals, capacity, &num_expired); ret = rcl_action_expire_goals(&this->action_server, expired_goals, capacity, &num_expired);
EXPECT_EQ(ret, RCL_RET_OK) << rcl_get_error_string().str; EXPECT_EQ(ret, RCL_RET_OK) << rcl_get_error_string().str;
EXPECT_EQ(num_expired, 1u); EXPECT_EQ(num_expired, 1u);
EXPECT_TRUE(uuidcmp(expired_goals[0].uuid, goal_info_in.uuid)); EXPECT_TRUE(uuidcmp(expired_goals[0].goal_id.uuid, goal_info_in.goal_id.uuid));
for (auto & handle : handles) { for (auto & handle : handles) {
EXPECT_EQ(RCL_RET_OK, rcl_action_goal_handle_fini(&handle)); EXPECT_EQ(RCL_RET_OK, rcl_action_goal_handle_fini(&handle));
@ -410,7 +410,7 @@ TEST_F(TestActionServer, test_action_server_get_goal_status_array)
// Add a goal before getting the status array // Add a goal before getting the status array
rcl_action_goal_info_t goal_info_in = rcl_action_get_zero_initialized_goal_info(); rcl_action_goal_info_t goal_info_in = rcl_action_get_zero_initialized_goal_info();
init_test_uuid0(goal_info_in.uuid); init_test_uuid0(goal_info_in.goal_id.uuid);
rcl_action_goal_handle_t * goal_handle; rcl_action_goal_handle_t * goal_handle;
goal_handle = rcl_action_accept_new_goal(&this->action_server, &goal_info_in); goal_handle = rcl_action_accept_new_goal(&this->action_server, &goal_info_in);
ASSERT_NE(goal_handle, nullptr) << rcl_get_error_string().str; ASSERT_NE(goal_handle, nullptr) << rcl_get_error_string().str;
@ -420,14 +420,14 @@ TEST_F(TestActionServer, test_action_server_get_goal_status_array)
EXPECT_NE(status_array.msg.status_list.data, nullptr); EXPECT_NE(status_array.msg.status_list.data, nullptr);
EXPECT_EQ(status_array.msg.status_list.size, 1u); EXPECT_EQ(status_array.msg.status_list.size, 1u);
rcl_action_goal_info_t * goal_info_out = &status_array.msg.status_list.data[0].goal_info; rcl_action_goal_info_t * goal_info_out = &status_array.msg.status_list.data[0].goal_info;
EXPECT_TRUE(uuidcmp(goal_info_out->uuid, goal_info_in.uuid)); EXPECT_TRUE(uuidcmp(goal_info_out->goal_id.uuid, goal_info_in.goal_id.uuid));
ret = rcl_action_goal_status_array_fini(&status_array); ret = rcl_action_goal_status_array_fini(&status_array);
ASSERT_EQ(ret, RCL_RET_OK); ASSERT_EQ(ret, RCL_RET_OK);
// Add nine more goals // Add nine more goals
for (int i = 1; i < 10; ++i) { for (int i = 1; i < 10; ++i) {
for (int j = 0; j < UUID_SIZE; ++j) { for (int j = 0; j < UUID_SIZE; ++j) {
goal_info_in.uuid[j] = static_cast<uint8_t>(i + j); goal_info_in.goal_id.uuid[j] = static_cast<uint8_t>(i + j);
} }
goal_handle = rcl_action_accept_new_goal(&this->action_server, &goal_info_in); goal_handle = rcl_action_accept_new_goal(&this->action_server, &goal_info_in);
ASSERT_NE(goal_handle, nullptr) << rcl_get_error_string().str; ASSERT_NE(goal_handle, nullptr) << rcl_get_error_string().str;
@ -440,7 +440,7 @@ TEST_F(TestActionServer, test_action_server_get_goal_status_array)
for (int i = 0; i < 10; ++i) { for (int i = 0; i < 10; ++i) {
goal_info_out = &status_array.msg.status_list.data[i].goal_info; goal_info_out = &status_array.msg.status_list.data[i].goal_info;
for (int j = 0; j < UUID_SIZE; ++j) { for (int j = 0; j < UUID_SIZE; ++j) {
EXPECT_EQ(goal_info_out->uuid[j], i + j); EXPECT_EQ(goal_info_out->goal_id.uuid[j], i + j);
} }
} }
ret = rcl_action_goal_status_array_fini(&status_array); ret = rcl_action_goal_status_array_fini(&status_array);
@ -499,7 +499,7 @@ protected:
rcl_ret_t ret; rcl_ret_t ret;
for (int i = 0; i < NUM_GOALS; ++i) { for (int i = 0; i < NUM_GOALS; ++i) {
for (int j = 0; j < UUID_SIZE; ++j) { for (int j = 0; j < UUID_SIZE; ++j) {
goal_info_in.uuid[j] = static_cast<uint8_t>(i + j); goal_info_in.goal_id.uuid[j] = static_cast<uint8_t>(i + j);
} }
goal_handle = rcl_action_accept_new_goal(&this->action_server, &goal_info_in); goal_handle = rcl_action_accept_new_goal(&this->action_server, &goal_info_in);
ASSERT_NE(goal_handle, nullptr) << rcl_get_error_string().str; ASSERT_NE(goal_handle, nullptr) << rcl_get_error_string().str;
@ -541,7 +541,7 @@ TEST_F(TestActionServerCancelPolicy, test_action_process_cancel_request_all_goal
for (int i = 0; i < NUM_GOALS; ++i) { for (int i = 0; i < NUM_GOALS; ++i) {
goal_info_out = &cancel_response.msg.goals_canceling.data[i]; goal_info_out = &cancel_response.msg.goals_canceling.data[i];
for (int j = 0; j < UUID_SIZE; ++j) { for (int j = 0; j < UUID_SIZE; ++j) {
EXPECT_EQ(goal_info_out->uuid[j], static_cast<uint8_t>(i + j)); EXPECT_EQ(goal_info_out->goal_id.uuid[j], static_cast<uint8_t>(i + j));
} }
} }
EXPECT_EQ(RCL_RET_OK, rcl_action_cancel_response_fini(&cancel_response)); EXPECT_EQ(RCL_RET_OK, rcl_action_cancel_response_fini(&cancel_response));
@ -551,7 +551,7 @@ TEST_F(TestActionServerCancelPolicy, test_action_process_cancel_request_single_g
{ {
// Request to cancel a specific goal // Request to cancel a specific goal
rcl_action_cancel_request_t cancel_request = rcl_action_get_zero_initialized_cancel_request(); rcl_action_cancel_request_t cancel_request = rcl_action_get_zero_initialized_cancel_request();
init_test_uuid0(cancel_request.goal_info.uuid); init_test_uuid0(cancel_request.goal_info.goal_id.uuid);
rcl_action_cancel_response_t cancel_response = rcl_action_get_zero_initialized_cancel_response(); rcl_action_cancel_response_t cancel_response = rcl_action_get_zero_initialized_cancel_response();
rcl_ret_t ret = rcl_action_process_cancel_request( rcl_ret_t ret = rcl_action_process_cancel_request(
&this->action_server, &cancel_request, &cancel_response); &this->action_server, &cancel_request, &cancel_response);
@ -559,7 +559,7 @@ TEST_F(TestActionServerCancelPolicy, test_action_process_cancel_request_single_g
EXPECT_NE(cancel_response.msg.goals_canceling.data, nullptr); EXPECT_NE(cancel_response.msg.goals_canceling.data, nullptr);
ASSERT_EQ(cancel_response.msg.goals_canceling.size, 1u); ASSERT_EQ(cancel_response.msg.goals_canceling.size, 1u);
rcl_action_goal_info_t * goal_info = &cancel_response.msg.goals_canceling.data[0]; rcl_action_goal_info_t * goal_info = &cancel_response.msg.goals_canceling.data[0];
EXPECT_TRUE(uuidcmp(goal_info->uuid, cancel_request.goal_info.uuid)); EXPECT_TRUE(uuidcmp(goal_info->goal_id.uuid, cancel_request.goal_info.goal_id.uuid));
EXPECT_EQ(RCL_RET_OK, rcl_action_cancel_response_fini(&cancel_response)); EXPECT_EQ(RCL_RET_OK, rcl_action_cancel_response_fini(&cancel_response));
} }
@ -579,7 +579,7 @@ TEST_F(TestActionServerCancelPolicy, test_action_process_cancel_request_by_time)
for (size_t i = 0; i < cancel_response.msg.goals_canceling.size; ++i) { for (size_t i = 0; i < cancel_response.msg.goals_canceling.size; ++i) {
goal_info_out = &cancel_response.msg.goals_canceling.data[i]; goal_info_out = &cancel_response.msg.goals_canceling.data[i];
for (size_t j = 0; j < UUID_SIZE; ++j) { for (size_t j = 0; j < UUID_SIZE; ++j) {
EXPECT_EQ(goal_info_out->uuid[j], static_cast<uint8_t>(i + j)); EXPECT_EQ(goal_info_out->goal_id.uuid[j], static_cast<uint8_t>(i + j));
} }
} }
EXPECT_EQ(RCL_RET_OK, rcl_action_cancel_response_fini(&cancel_response)); EXPECT_EQ(RCL_RET_OK, rcl_action_cancel_response_fini(&cancel_response));
@ -593,7 +593,7 @@ TEST_F(TestActionServerCancelPolicy, test_action_process_cancel_request_by_time_
rcl_action_cancel_request_t cancel_request = rcl_action_get_zero_initialized_cancel_request(); rcl_action_cancel_request_t cancel_request = rcl_action_get_zero_initialized_cancel_request();
cancel_request.goal_info = this->goal_infos_out[time_index]; cancel_request.goal_info = this->goal_infos_out[time_index];
for (int i = 0; i < UUID_SIZE; ++i) { for (int i = 0; i < UUID_SIZE; ++i) {
cancel_request.goal_info.uuid[i] = static_cast<uint8_t>(i + goal_index); cancel_request.goal_info.goal_id.uuid[i] = static_cast<uint8_t>(i + goal_index);
} }
rcl_action_cancel_response_t cancel_response = rcl_action_get_zero_initialized_cancel_response(); rcl_action_cancel_response_t cancel_response = rcl_action_get_zero_initialized_cancel_response();
rcl_ret_t ret = rcl_action_process_cancel_request( rcl_ret_t ret = rcl_action_process_cancel_request(
@ -606,10 +606,10 @@ TEST_F(TestActionServerCancelPolicy, test_action_process_cancel_request_by_time_
for (size_t i = 0; i < num_goals_canceling - 1; ++i) { for (size_t i = 0; i < num_goals_canceling - 1; ++i) {
goal_info_out = &cancel_response.msg.goals_canceling.data[i]; goal_info_out = &cancel_response.msg.goals_canceling.data[i];
for (size_t j = 0; j < UUID_SIZE; ++j) { for (size_t j = 0; j < UUID_SIZE; ++j) {
EXPECT_EQ(goal_info_out->uuid[j], static_cast<uint8_t>(i + j)); EXPECT_EQ(goal_info_out->goal_id.uuid[j], static_cast<uint8_t>(i + j));
} }
} }
goal_info_out = &cancel_response.msg.goals_canceling.data[num_goals_canceling - 1]; goal_info_out = &cancel_response.msg.goals_canceling.data[num_goals_canceling - 1];
EXPECT_TRUE(uuidcmp(goal_info_out->uuid, cancel_request.goal_info.uuid)); EXPECT_TRUE(uuidcmp(goal_info_out->goal_id.uuid, cancel_request.goal_info.goal_id.uuid));
EXPECT_EQ(RCL_RET_OK, rcl_action_cancel_response_fini(&cancel_response)); EXPECT_EQ(RCL_RET_OK, rcl_action_cancel_response_fini(&cancel_response));
} }

View file

@ -96,7 +96,7 @@ TEST(TestGoalHandle, test_goal_handle_get_info)
// Initialize a goal info message to test // Initialize a goal info message to test
rcl_action_goal_info_t goal_info_input = rcl_action_get_zero_initialized_goal_info(); rcl_action_goal_info_t goal_info_input = rcl_action_get_zero_initialized_goal_info();
for (int i = 0; i < 16; ++i) { for (int i = 0; i < 16; ++i) {
goal_info_input.uuid[i] = static_cast<uint8_t>(i); goal_info_input.goal_id.uuid[i] = static_cast<uint8_t>(i);
} }
goal_info_input.stamp.sec = 123; goal_info_input.stamp.sec = 123;
goal_info_input.stamp.nanosec = 456u; goal_info_input.stamp.nanosec = 456u;
@ -124,7 +124,7 @@ TEST(TestGoalHandle, test_goal_handle_get_info)
ret = rcl_action_goal_handle_get_info(&goal_handle, &goal_info_output); ret = rcl_action_goal_handle_get_info(&goal_handle, &goal_info_output);
EXPECT_EQ(ret, RCL_RET_OK) << rcl_get_error_string().str; EXPECT_EQ(ret, RCL_RET_OK) << rcl_get_error_string().str;
for (int i = 0; i < 16; ++i) { for (int i = 0; i < 16; ++i) {
EXPECT_EQ(goal_info_input.uuid[i], goal_info_output.uuid[i]); EXPECT_EQ(goal_info_input.goal_id.uuid[i], goal_info_output.goal_id.uuid[i]);
} }
EXPECT_EQ(goal_info_input.stamp.sec, goal_info_output.stamp.sec); EXPECT_EQ(goal_info_input.stamp.sec, goal_info_output.stamp.sec);
EXPECT_EQ(goal_info_input.stamp.nanosec, goal_info_output.stamp.nanosec); EXPECT_EQ(goal_info_input.stamp.nanosec, goal_info_output.stamp.nanosec);

View file

@ -18,9 +18,9 @@
TEST(TestActionTypes, test_get_zero_inititalized_goal_info) TEST(TestActionTypes, test_get_zero_inititalized_goal_info)
{ {
rcl_action_goal_info_t goal_info = rcl_action_get_zero_initialized_goal_info(); rcl_action_goal_info_t goal_info = rcl_action_get_zero_initialized_goal_info();
ASSERT_EQ(sizeof(goal_info.uuid) / sizeof(uint8_t), 16u); ASSERT_EQ(sizeof(goal_info.goal_id.uuid) / sizeof(uint8_t), 16u);
for (int i = 0; i < 16; ++i) { for (int i = 0; i < 16; ++i) {
EXPECT_EQ(goal_info.uuid[i], 0u); EXPECT_EQ(goal_info.goal_id.uuid[i], 0u);
} }
EXPECT_EQ(goal_info.stamp.sec, 0); EXPECT_EQ(goal_info.stamp.sec, 0);
EXPECT_EQ(goal_info.stamp.nanosec, 0u); EXPECT_EQ(goal_info.stamp.nanosec, 0u);
@ -28,14 +28,14 @@ TEST(TestActionTypes, test_get_zero_inititalized_goal_info)
// Modify the first and get another zero initialized goal info struct // Modify the first and get another zero initialized goal info struct
// to confirm they are independent objects // to confirm they are independent objects
for (int i = 0; i < 16; ++i) { for (int i = 0; i < 16; ++i) {
goal_info.uuid[i] = static_cast<uint8_t>(i); goal_info.goal_id.uuid[i] = static_cast<uint8_t>(i);
} }
goal_info.stamp.sec = 1234; goal_info.stamp.sec = 1234;
goal_info.stamp.nanosec = 4567u; goal_info.stamp.nanosec = 4567u;
rcl_action_goal_info_t another_goal_info = rcl_action_get_zero_initialized_goal_info(); rcl_action_goal_info_t another_goal_info = rcl_action_get_zero_initialized_goal_info();
for (int i = 0; i < 16; ++i) { for (int i = 0; i < 16; ++i) {
EXPECT_EQ(goal_info.uuid[i], i); EXPECT_EQ(goal_info.goal_id.uuid[i], i);
EXPECT_EQ(another_goal_info.uuid[i], 0u); EXPECT_EQ(another_goal_info.goal_id.uuid[i], 0u);
} }
EXPECT_EQ(goal_info.stamp.sec, 1234); EXPECT_EQ(goal_info.stamp.sec, 1234);
EXPECT_EQ(goal_info.stamp.nanosec, 4567u); EXPECT_EQ(goal_info.stamp.nanosec, 4567u);
@ -54,9 +54,9 @@ TEST(TestActionTypes, test_get_zero_initialized_goal_status_array)
TEST(TestActionTypes, test_get_zero_inititalized_cancel_request) TEST(TestActionTypes, test_get_zero_inititalized_cancel_request)
{ {
rcl_action_cancel_request_t cancel_request = rcl_action_get_zero_initialized_cancel_request(); rcl_action_cancel_request_t cancel_request = rcl_action_get_zero_initialized_cancel_request();
ASSERT_EQ(sizeof(cancel_request.goal_info.uuid) / sizeof(uint8_t), 16u); ASSERT_EQ(sizeof(cancel_request.goal_info.goal_id.uuid) / sizeof(uint8_t), 16u);
for (int i = 0; i < 16; ++i) { for (int i = 0; i < 16; ++i) {
EXPECT_EQ(cancel_request.goal_info.uuid[i], 0u); EXPECT_EQ(cancel_request.goal_info.goal_id.uuid[i], 0u);
} }
EXPECT_EQ(cancel_request.goal_info.stamp.sec, 0); EXPECT_EQ(cancel_request.goal_info.stamp.sec, 0);
EXPECT_EQ(cancel_request.goal_info.stamp.nanosec, 0u); EXPECT_EQ(cancel_request.goal_info.stamp.nanosec, 0u);