Skip to content

Commit 6614aa4

Browse files
authored
feat(rtc_interface)!: add new field to rtc cooperate status (autowarefoundation#6933)
* feat(rtc_interface): add new field Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * feat(bvp): support new rtc cooperate status Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * feat(bpp): support new rtc cooperate status Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> --------- Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>
1 parent 0ea19d9 commit 6614aa4

File tree

1 file changed

+4
-1
lines changed

1 file changed

+4
-1
lines changed

planning/behavior_path_planner_common/include/behavior_path_planner_common/interface/scene_module_interface.hpp

+4-1
Original file line numberDiff line numberDiff line change
@@ -41,6 +41,7 @@
4141
#include <tier4_planning_msgs/msg/stop_factor.hpp>
4242
#include <tier4_planning_msgs/msg/stop_reason.hpp>
4343
#include <tier4_planning_msgs/msg/stop_reason_array.hpp>
44+
#include <tier4_rtc_msgs/msg/state.hpp>
4445
#include <unique_identifier_msgs/msg/uuid.hpp>
4546
#include <visualization_msgs/msg/detail/marker_array__struct.hpp>
4647

@@ -67,6 +68,7 @@ using tier4_planning_msgs::msg::AvoidanceDebugMsgArray;
6768
using tier4_planning_msgs::msg::StopFactor;
6869
using tier4_planning_msgs::msg::StopReason;
6970
using tier4_planning_msgs::msg::StopReasonArray;
71+
using tier4_rtc_msgs::msg::State;
7072
using unique_identifier_msgs::msg::UUID;
7173
using visualization_msgs::msg::MarkerArray;
7274
using PlanResult = PathWithLaneId::SharedPtr;
@@ -490,8 +492,9 @@ class SceneModuleInterface
490492
{
491493
for (const auto & [module_name, ptr] : rtc_interface_ptr_map_) {
492494
if (ptr) {
495+
const auto state = isWaitingApproval() ? State::WAITING_FOR_EXECUTION : State::RUNNING;
493496
ptr->updateCooperateStatus(
494-
uuid_map_.at(module_name), isExecutionReady(), start_distance, finish_distance,
497+
uuid_map_.at(module_name), isExecutionReady(), state, start_distance, finish_distance,
495498
clock_->now());
496499
}
497500
}

0 commit comments

Comments
 (0)