chore(simple_planning_simulator): publish control mode before the self-position is given (autowarefoundation#7008)

tkimura4 · vividf · commit 6b3fb9b80864 · 2024-05-16T12:11:36.000+09:00
Signed-off-by: tomoya.kimura &lt;tomoya.kimura@tier4.jp&gt;
Signed-off-by: vividf &lt;yihsiang.fang@tier4.jp&gt;
diff --git a/simulator/simple_planning_simulator/src/simple_planning_simulator/simple_planning_simulator_core.cpp b/simulator/simple_planning_simulator/src/simple_planning_simulator/simple_planning_simulator_core.cpp
@@ -358,6 +358,7 @@ double SimplePlanningSimulator::calculate_ego_pitch() const
 void SimplePlanningSimulator::on_timer()
 {
   if (!is_initialized_) {
+    publish_control_mode_report();
     RCLCPP_INFO_THROTTLE(get_logger(), *get_clock(), 5000, "waiting initialization...");
     return;
   }

Original file line number	Diff line number	Diff line change
`@@ -358,6 +358,7 @@ double SimplePlanningSimulator::calculate_ego_pitch() const`
`358`	`358`	`void SimplePlanningSimulator::on_timer()`
`359`	`359`	`{`
`360`	`360`	`if (!is_initialized_) {`
	`361`	`+ publish_control_mode_report();`
`361`	`362`	`RCLCPP_INFO_THROTTLE(get_logger(), *get_clock(), 5000, "waiting initialization...");`
`362`	`363`	`return;`
`363`	`364`	`}`