Skip to content

Commit 4517a49

Browse files
delete departure check lanes
Signed-off-by: Daniel Sanchez <danielsanchezaran@gmail.com>
1 parent 2b161ba commit 4517a49

File tree

3 files changed

+0
-26
lines changed

3 files changed

+0
-26
lines changed

planning/behavior_path_start_planner_module/include/behavior_path_start_planner_module/shift_pull_out.hpp

-7
Original file line numberDiff line numberDiff line change
@@ -50,11 +50,6 @@ class ShiftPullOut : public PullOutPlannerBase
5050
ShiftedPath & shifted_path, const Pose & start_pose, const Pose & end_pose,
5151
const double longitudinal_acc, const double lateral_acc);
5252

53-
void setDepartureCheckLanes(const lanelet::ConstLanelets & departure_check_lanes)
54-
{
55-
departure_check_lanes_ = departure_check_lanes;
56-
}
57-
5853
std::shared_ptr<LaneDepartureChecker> lane_departure_checker_;
5954

6055
private:
@@ -63,8 +58,6 @@ class ShiftPullOut : public PullOutPlannerBase
6358
double calcPullOutLongitudinalDistance(
6459
const double lon_acc, const double shift_time, const double shift_length,
6560
const double max_curvature, const double min_distance) const;
66-
67-
lanelet::ConstLanelets departure_check_lanes_;
6861
};
6962
} // namespace behavior_path_planner
7063

planning/behavior_path_start_planner_module/include/behavior_path_start_planner_module/start_planner_module.hpp

-1
Original file line numberDiff line numberDiff line change
@@ -275,7 +275,6 @@ class StartPlannerModule : public SceneModuleInterface
275275
const std::vector<PoseWithVelocityStamped> & ego_predicted_path) const;
276276
bool isSafePath() const;
277277
void setDrivableAreaInfo(BehaviorModuleOutput & output) const;
278-
void updateDepartureCheckLanes();
279278
lanelet::ConstLanelets createDepartureCheckLanes() const;
280279

281280
// check if the goal is located behind the ego in the same route segment.

planning/behavior_path_start_planner_module/src/start_planner_module.cpp

-18
Original file line numberDiff line numberDiff line change
@@ -142,7 +142,6 @@ void StartPlannerModule::initVariables()
142142
info_marker_.markers.clear();
143143
initializeSafetyCheckParameters();
144144
initializeCollisionCheckDebugMap(debug_data_.collision_check);
145-
updateDepartureCheckLanes();
146145
}
147146

148147
void StartPlannerModule::updateEgoPredictedPathParams(
@@ -608,7 +607,6 @@ BehaviorModuleOutput StartPlannerModule::planWaitingApproval()
608607
void StartPlannerModule::resetStatus()
609608
{
610609
status_ = PullOutStatus{};
611-
updateDepartureCheckLanes();
612610
}
613611

614612
void StartPlannerModule::incrementPathIndex()
@@ -1409,22 +1407,6 @@ void StartPlannerModule::setDrivableAreaInfo(BehaviorModuleOutput & output) cons
14091407
}
14101408
}
14111409

1412-
void StartPlannerModule::updateDepartureCheckLanes()
1413-
{
1414-
const auto departure_check_lanes = createDepartureCheckLanes();
1415-
for (auto & planner : start_planners_) {
1416-
auto shift_pull_out = std::dynamic_pointer_cast<ShiftPullOut>(planner);
1417-
1418-
if (shift_pull_out) {
1419-
shift_pull_out->setDepartureCheckLanes(departure_check_lanes);
1420-
}
1421-
}
1422-
// debug
1423-
{
1424-
debug_data_.departure_check_lanes = departure_check_lanes;
1425-
}
1426-
}
1427-
14281410
lanelet::ConstLanelets StartPlannerModule::createDepartureCheckLanes() const
14291411
{
14301412
const double backward_path_length =

0 commit comments

Comments
 (0)