File tree 2 files changed +6
-6
lines changed
planning/behavior_path_start_planner_module
include/behavior_path_start_planner_module
2 files changed +6
-6
lines changed Original file line number Diff line number Diff line change @@ -71,7 +71,7 @@ struct PullOutStatus
71
71
std::shared_ptr<PathWithLaneId> prev_stop_path_after_approval{nullptr };
72
72
std::optional<Pose> stop_pose{std::nullopt};
73
73
// ! record the first time when the state changed from !isActivated() to isActivated()
74
- std::optional<rclcpp::Time> first_approved_time {std::nullopt};
74
+ std::optional<rclcpp::Time> first_engaged_time {std::nullopt};
75
75
76
76
PullOutStatus () {}
77
77
};
Original file line number Diff line number Diff line change @@ -178,8 +178,8 @@ void StartPlannerModule::updateData()
178
178
179
179
if (
180
180
planner_data_->operation_mode ->mode == OperationModeState::AUTONOMOUS &&
181
- !status_.first_approved_time && isActivated () ) {
182
- status_.first_approved_time = clock_->now ();
181
+ !status_.first_engaged_time ) {
182
+ status_.first_engaged_time = clock_->now ();
183
183
}
184
184
185
185
if (hasFinishedBackwardDriving ()) {
@@ -1086,11 +1086,11 @@ bool StartPlannerModule::hasFinishedPullOut() const
1086
1086
1087
1087
bool StartPlannerModule::needToPrepareBlinkerBeforeStart () const
1088
1088
{
1089
- if (!status_.first_approved_time ) {
1089
+ if (!status_.first_engaged_time ) {
1090
1090
return true ;
1091
1091
}
1092
- const auto first_approved_time = status_.first_approved_time .value ();
1093
- const double elapsed = rclcpp::Duration (clock_->now () - first_approved_time ).seconds ();
1092
+ const auto first_engaged_time = status_.first_engaged_time .value ();
1093
+ const double elapsed = rclcpp::Duration (clock_->now () - first_engaged_time ).seconds ();
1094
1094
return elapsed < parameters_->prepare_time_before_start ;
1095
1095
}
1096
1096
You can’t perform that action at this time.
0 commit comments