Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

Sign up for GitHub

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

refactor(route_handler): remove unused functions in route_handler #7012

Merged
merged 2 commits into from
May 16, 2024
Merged

refactor(route_handler): remove unused functions in route_handler #7012

Show file tree
Hide file tree
Changes from all commits
Commits
Show all changes
2 commits
Select commit Hold shift + click to select a range
107ffe5
remove unused functions in route_handler
mkquda May 14, 2024
c18ac36
Merge branch 'awf-latest' into RT1-6296-remove-unused-functions-in-ro…
mkquda May 14, 2024
File filter

Filter by extension

Filter by extension
Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
77 changes: 0 additions & 77 deletions planning/route_handler/include/route_handler/route_handler.hpp
View file
Open in desktop
Original file line number Diff line number Diff line change
Expand Up @@ -205,54 +205,6 @@ class RouteHandler
const lanelet::ConstLanelet & lanelet, const bool enable_same_root = false,
const bool get_shoulder_lane = false) const;

/**
* @brief Searches the furthest linestring to the right side of the lanelet
* Only lanelet with same direction is considered
* @param the lanelet of interest
* @return right most linestring of the lane with same direction
*/
lanelet::ConstLineString3d getRightMostSameDirectionLinestring(
const lanelet::ConstLanelet & lanelet, const bool enable_same_root = false) const noexcept;

/**
* @brief Searches the furthest linestring to the right side of the lanelet
* Used to search for road shoulders. Lane direction is ignored
* @param the lanelet of interest
* @return right most linestring
*/
lanelet::ConstLineString3d getRightMostLinestring(
const lanelet::ConstLanelet & lanelet, const bool enable_same_root = false) const noexcept;

/**
* @brief Searches the furthest linestring to the left side of the lanelet
* Only lanelet with same direction is considered
* @param the lanelet of interest
* @return left most linestring of the lane with same direction
*/
lanelet::ConstLineString3d getLeftMostSameDirectionLinestring(
const lanelet::ConstLanelet & lanelet, const bool enable_same_root = false) const noexcept;

/**
* @brief Searches the furthest linestring to the left side of the lanelet
* Used to search for road shoulders. Lane direction is ignored
* @param the lanelet of interest
* @return left most linestring
*/
lanelet::ConstLineString3d getLeftMostLinestring(
const lanelet::ConstLanelet & lanelet, const bool enable_same_root = false) const noexcept;

/**
* @brief Return furthest linestring on both side of the lanelet
* @param the lanelet of interest
* @param (optional) search furthest right side
* @param (optional) search furthest left side
* @param (optional) include opposite lane as well
* @return right and left linestrings
*/
lanelet::ConstLineStrings3d getFurthestLinestring(
const lanelet::ConstLanelet & lanelet, bool is_right = true, bool is_left = true,
bool is_opposite = true, bool enable_same_root = false) const noexcept;

/**
* Retrieves a sequence of lanelets before the given lanelet.
* The total length of retrieved lanelet sequence at least given length. Returned lanelet sequence
Expand All @@ -276,18 +228,6 @@ class RouteHandler
int getNumLaneToPreferredLane(
const lanelet::ConstLanelet & lanelet, const Direction direction = Direction::NONE) const;

/**
* Query input lanelet to see whether it exist in the preferred lane. If it doesn't exist, return
* the distance to the preferred lane from the give lane.
* The total distance is computed from the front point of the centerline of the given lane to
* the front point of the preferred lane.
* @param lanelet lanelet to query
* @param direction change direction
* @return number of lanes from input to the preferred lane
*/
double getTotalLateralDistanceToPreferredLane(
const lanelet::ConstLanelet & lanelet, const Direction direction = Direction::NONE) const;

/**
* Query input lanelet to see whether it exist in the preferred lane. If it doesn't exist, return
* the distance to the preferred lane from the give lane.
Expand Down Expand Up @@ -321,11 +261,6 @@ class RouteHandler
const lanelet::ConstLanelet & lanelet, const Pose & pose,
const double backward_distance = std::numeric_limits<double>::max(),
const double forward_distance = std::numeric_limits<double>::max()) const;
lanelet::ConstLanelets getCheckTargetLanesFromPath(
const PathWithLaneId & path, const lanelet::ConstLanelets & target_lanes,
const double check_length) const;
lanelet::routing::RelationType getRelation(
const lanelet::ConstLanelet & prev_lane, const lanelet::ConstLanelet & next_lane) const;
bool isShoulderLanelet(const lanelet::ConstLanelet & lanelet) const;
bool isRouteLanelet(const lanelet::ConstLanelet & lanelet) const;
bool isRoadLanelet(const lanelet::ConstLanelet & lanelet) const;
Expand All @@ -339,22 +274,16 @@ class RouteHandler
const lanelet::ConstLanelets & lanelets, const Direction direction = Direction::NONE) const;
std::optional<lanelet::ConstLanelet> getLaneChangeTargetExceptPreferredLane(
const lanelet::ConstLanelets & lanelets, const Direction direction) const;
bool getRightLaneChangeTargetExceptPreferredLane(
const lanelet::ConstLanelets & lanelets, lanelet::ConstLanelet * target_lanelet) const;
bool getLeftLaneChangeTargetExceptPreferredLane(
const lanelet::ConstLanelets & lanelets, lanelet::ConstLanelet * target_lanelet) const;
std::optional<lanelet::ConstLanelet> getPullOverTarget(const Pose & goal_pose) const;
std::optional<lanelet::ConstLanelet> getPullOutStartLane(
const Pose & pose, const double vehicle_width) const;
double getLaneChangeableDistance(const Pose & current_pose, const Direction & direction) const;
lanelet::ConstLanelets getRoadLaneletsAtPose(const Pose & pose) const;
std::optional<lanelet::ConstLanelet> getLeftShoulderLanelet(
const lanelet::ConstLanelet & lanelet) const;
std::optional<lanelet::ConstLanelet> getRightShoulderLanelet(
const lanelet::ConstLanelet & lanelet) const;
lanelet::ConstLanelets getShoulderLaneletsAtPose(const Pose & pose) const;
lanelet::ConstPolygon3d getIntersectionAreaById(const lanelet::Id id) const;
bool isPreferredLane(const lanelet::ConstLanelet & lanelet) const;

private:
// MUST
Expand Down Expand Up @@ -385,8 +314,6 @@ class RouteHandler
lanelet::ConstLanelets getMainLanelets(const lanelet::ConstLanelets & path_lanelets) const;

// for lanelet
bool isInTargetLane(const PoseStamped & pose, const lanelet::ConstLanelets & target) const;
bool isInPreferredLane(const PoseStamped & pose) const;
bool isBijectiveConnection(
const lanelet::ConstLanelets & lanelet_section1,
const lanelet::ConstLanelets & lanelet_section2) const;
Expand Down Expand Up @@ -419,17 +346,13 @@ class RouteHandler
const double min_length = std::numeric_limits<double>::max()) const;
lanelet::ConstLanelets getPreviousLaneletSequence(
const lanelet::ConstLanelets & lanelet_sequence) const;
lanelet::ConstLanelets getLaneChangeTargetLanes(const Pose & pose) const;
lanelet::ConstLanelets getLaneSequenceUpTo(const lanelet::ConstLanelet & lanelet) const;
lanelet::ConstLanelets getLaneSequenceAfter(const lanelet::ConstLanelet & lanelet) const;
lanelet::ConstLanelets getLaneSequence(const lanelet::ConstLanelet & lanelet) const;
lanelet::ConstLanelets getNeighborsWithinRoute(const lanelet::ConstLanelet & lanelet) const;
std::vector<lanelet::ConstLanelets> getLaneSection(const lanelet::ConstLanelet & lanelet) const;
lanelet::ConstLanelets getNextLaneSequence(const lanelet::ConstLanelets & lane_sequence) const;

// for path

PathWithLaneId updatePathTwist(const PathWithLaneId & path) const;
/**
* @brief Checks if a path has a no_drivable_lane or not
* @param path lanelet path
Expand Down
Loading
Loading