-
Notifications
You must be signed in to change notification settings - Fork 668
Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
Signed-off-by: mitukou1109 <[email protected]>
- Loading branch information
1 parent
f712f34
commit 409a791
Showing
2 changed files
with
45 additions
and
0 deletions.
There are no files selected for viewing
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -0,0 +1,41 @@ | ||
# Path Generator | ||
|
||
The `path_generator` node receives a route from `mission_planner` and converts the centerline into a path. | ||
If the route has waypoints set, it generates a path passing through them. | ||
|
||
This package is a simple alternative of `behavior_path_generator`. | ||
|
||
## Path generation | ||
|
||
When input data is ready, it first searches for the lanelet closest to the vehicle. | ||
If found, it gets the lanelets within a distance of `backward_path_length` behind and `forward_path_length` in front. | ||
Their centerlines are concatenated to generate a path. | ||
|
||
If waypoints exist in the route, it replaces the overlapped segment of the centerline with them. | ||
The overlap interval is determined as shown in the following figure. | ||
|
||
![waypoint_group_overlap_interval_determination](./media/waypoint_group_overlap_interval_determination.drawio.svg) | ||
|
||
## Input topics | ||
|
||
| Name | Type | Description | | ||
| :------------------- | :------------------------------------------ | :------------------------------- | | ||
| `~/input/odometry` | `nav_msgs::msg::Odometry` | ego pose | | ||
| `~/input/vector_map` | `autoware_map_msgs::msg::LaneletMapBin` | vector map information | | ||
| `~/input/route` | `autoware_planning_msgs::msg::LaneletRoute` | current route from start to goal | | ||
|
||
## Output topics | ||
|
||
| Name | Type | Description | QoS Durability | | ||
| :-------------- | :----------------------------------------- | :------------- | :------------- | | ||
| `~/output/path` | `tier4_planning_msgs::msg::PathWithLaneId` | generated path | `volatile` | | ||
|
||
## Parameters | ||
|
||
| Name | Type | Description | | ||
| :------------------------------------- | :------- | :-------------------------------------------------------------------------------------------------------------------- | | ||
| `planning_hz` | double | planning frequency | | ||
| `backward_path_length` | double | length of the generated path behind vehicle | | ||
| `forward_path_length` | double | length of the generated path in front of vehicle | | ||
| `waypoint_group_separation_threshold` | double | maximum distance at which consecutive waypoints are considered to belong to the same group (see [here](#path-generation) for details) | | ||
| `waypoint_group_interval_margin_ratio` | double | ratio for determining length of switching section from centerline to waypoints (see [here](#path-generation) for details) | |
4 changes: 4 additions & 0 deletions
4
...e_path_generator/media/waypoint_group_overlap_interval_determination.drawio.svg
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.