Skip to content

Commit f7c65c8

Browse files
committed
Fix tests
Signed-off-by: redvinaa <redvinaa@gmail.com>
1 parent 4cb5ae2 commit f7c65c8

File tree

1 file changed

+13
-12
lines changed

1 file changed

+13
-12
lines changed

nav2_behavior_tree/test/plugins/control/test_pause_resume_controller.cpp

Lines changed: 13 additions & 12 deletions
Original file line numberDiff line numberDiff line change
@@ -94,7 +94,7 @@ TEST_F(PauseResumeControllerTestFixture, test_incorrect_num_children)
9494
</root>)";
9595
EXPECT_THROW(
9696
auto tree = factory_->createTreeFromText(xml_txt, config_->blackboard),
97-
std::runtime_error);
97+
BT::RuntimeError);
9898
}
9999

100100
TEST_F(PauseResumeControllerTestFixture, test_unused_children)
@@ -136,11 +136,11 @@ TEST_F(PauseResumeControllerTestFixture, test_unused_children)
136136
EXPECT_EQ(future.get()->success, true);
137137
};
138138

139-
// Call pause service, expect RUNNING and ON_PAUSE
139+
// Call pause service, expect RUNNING and PAUSED
140140
auto future = pause_client_->async_send_request(
141141
std::make_shared<std_srvs::srv::Trigger::Request>());
142142
EXPECT_EQ(tree_->rootNode()->executeTick(), BT::NodeStatus::RUNNING);
143-
EXPECT_EQ(pause_bt_node->getState(), state_t::ON_PAUSE);
143+
EXPECT_EQ(pause_bt_node->getState(), state_t::PAUSED);
144144
check_request_succeeded(future);
145145

146146
// Tick again, expect RUNNING and PAUSED
@@ -151,7 +151,7 @@ TEST_F(PauseResumeControllerTestFixture, test_unused_children)
151151
future = resume_client_->async_send_request(
152152
std::make_shared<std_srvs::srv::Trigger::Request>());
153153
EXPECT_EQ(tree_->rootNode()->executeTick(), BT::NodeStatus::RUNNING);
154-
EXPECT_EQ(pause_bt_node->getState(), state_t::ON_RESUME);
154+
EXPECT_EQ(pause_bt_node->getState(), state_t::RESUMED);
155155
check_request_succeeded(future);
156156

157157
// Tick again, expect RUNNING and RESUMED
@@ -206,20 +206,21 @@ TEST_F(PauseResumeControllerTestFixture, test_behavior)
206206
EXPECT_EQ(tree_->rootNode()->executeTick(), BT::NodeStatus::RUNNING);
207207
EXPECT_EQ(pause_bt_node->getState(), state_t::RESUMED);
208208

209-
const auto & check_request_succeeded = [](
210-
rclcpp::Client<std_srvs::srv::Trigger>::FutureAndRequestId & future)
209+
const auto & check_future_result = [](
210+
rclcpp::Client<std_srvs::srv::Trigger>::FutureAndRequestId & future, bool success = true)
211+
-> void
211212
{
212213
executor_->spin_until_future_complete(future, std::chrono::seconds(1));
213214
ASSERT_EQ(future.wait_for(std::chrono::seconds(0)), std::future_status::ready);
214-
EXPECT_EQ(future.get()->success, true);
215+
EXPECT_EQ(future.get()->success, success);
215216
};
216217

217218
// Call pause service, set ON_PAUSE child to RUNNING, expect RUNNING and ON_PAUSE
218219
auto future = pause_client_->async_send_request(
219220
std::make_shared<std_srvs::srv::Trigger::Request>());
220221
EXPECT_EQ(tree_->rootNode()->executeTick(), BT::NodeStatus::RUNNING);
221222
EXPECT_EQ(pause_bt_node->getState(), state_t::ON_PAUSE);
222-
check_request_succeeded(future);
223+
check_future_result(future);
223224

224225
// Change ON_PAUSE child to SUCCESS, expect RUNNING and PAUSED
225226
on_pause_child->changeStatus(BT::NodeStatus::SUCCESS);
@@ -242,14 +243,14 @@ TEST_F(PauseResumeControllerTestFixture, test_behavior)
242243
std::make_shared<std_srvs::srv::Trigger::Request>());
243244
EXPECT_EQ(tree_->rootNode()->executeTick(), BT::NodeStatus::RUNNING);
244245
EXPECT_EQ(pause_bt_node->getState(), state_t::PAUSED);
245-
check_request_succeeded(future);
246+
check_future_result(future, false);
246247

247248
// Call resume service, change ON_RESUME child to FAILURE, expect FAILURE
248249
future = resume_client_->async_send_request(
249250
std::make_shared<std_srvs::srv::Trigger::Request>());
250251
on_resume_child->changeStatus(BT::NodeStatus::FAILURE);
251252
EXPECT_EQ(tree_->rootNode()->executeTick(), BT::NodeStatus::FAILURE);
252-
check_request_succeeded(future);
253+
check_future_result(future);
253254

254255
// Halt the tree, expect RUNNING and RESUMED
255256
tree_->haltTree();
@@ -264,9 +265,9 @@ TEST_F(PauseResumeControllerTestFixture, test_behavior)
264265
// Call resume service again, expect RUNNING and RESUMED
265266
future = resume_client_->async_send_request(
266267
std::make_shared<std_srvs::srv::Trigger::Request>());
267-
EXPECT_EQ(tree_->rootNode()->executeTick(), BT::NodeStatus::RUNNING);
268+
EXPECT_EQ(tree_->rootNode()->executeTick(), BT::NodeStatus::SUCCESS);
268269
EXPECT_EQ(pause_bt_node->getState(), state_t::RESUMED);
269-
check_request_succeeded(future);
270+
check_future_result(future, false);
270271
}
271272

272273
int main(int argc, char ** argv)

0 commit comments

Comments
 (0)