@@ -272,7 +272,8 @@ void MrmHandler::handlePostFailureRequest()
272
272
}
273
273
274
274
bool MrmHandler::requestMrmBehavior (
275
- const autoware_adapi_v1_msgs::msg::MrmState::_behavior_type & mrm_behavior, RequestType request_type) const
275
+ const autoware_adapi_v1_msgs::msg::MrmState::_behavior_type & mrm_behavior,
276
+ RequestType request_type) const
276
277
{
277
278
using autoware_adapi_v1_msgs::msg::MrmState;
278
279
@@ -285,7 +286,8 @@ bool MrmHandler::requestMrmBehavior(
285
286
RCLCPP_ERROR (this ->get_logger (), " invalid request type: %d" , request_type);
286
287
return false ;
287
288
}
288
- const auto duration = std::chrono::duration<double , std::ratio<1 >>(request->operate ? param_.timeout_call_mrm_behavior : param_.timeout_cancel_mrm_behavior );
289
+ const auto duration = std::chrono::duration<double , std::ratio<1 >>(
290
+ request->operate ? param_.timeout_call_mrm_behavior : param_.timeout_cancel_mrm_behavior );
289
291
std::shared_future<std::shared_ptr<tier4_system_msgs::srv::OperateMrm::Response>> future;
290
292
291
293
const auto behavior2string = [](const int behavior) {
@@ -329,14 +331,20 @@ bool MrmHandler::requestMrmBehavior(
329
331
if (future.wait_for (duration) == std::future_status::ready) {
330
332
const auto result = future.get ();
331
333
if (result->response .success == true ) {
332
- RCLCPP_WARN (this ->get_logger (), request->operate ? " %s is operated." : " %s is canceled." , behavior2string (mrm_behavior));
334
+ RCLCPP_WARN (
335
+ this ->get_logger (), request->operate ? " %s is operated." : " %s is canceled." ,
336
+ behavior2string (mrm_behavior));
333
337
return true ;
334
338
} else {
335
- RCLCPP_ERROR (this ->get_logger (), request->operate ? " %s failed to operate." : " %s failed to cancel." , behavior2string (mrm_behavior));
339
+ RCLCPP_ERROR (
340
+ this ->get_logger (), request->operate ? " %s failed to operate." : " %s failed to cancel." ,
341
+ behavior2string (mrm_behavior));
336
342
return false ;
337
343
}
338
344
} else {
339
- RCLCPP_ERROR (this ->get_logger (), request->operate ? " %s call timed out." : " %s cancel timed out." , behavior2string (mrm_behavior));
345
+ RCLCPP_ERROR (
346
+ this ->get_logger (), request->operate ? " %s call timed out." : " %s cancel timed out." ,
347
+ behavior2string (mrm_behavior));
340
348
return false ;
341
349
}
342
350
}
0 commit comments