Skip to content

Commit 658e2a6

Browse files
committed
docs(obstacle_stop_planner): update documentation
Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>
1 parent 429a06c commit 658e2a6

File tree

4 files changed

+22
-272
lines changed

4 files changed

+22
-272
lines changed

planning/obstacle_stop_planner/README.md

+10-3
Original file line numberDiff line numberDiff line change
@@ -11,13 +11,20 @@
1111
- Adaptive Cruise Controller (ACC)
1212
- embeds target velocity in trajectory when there is a dynamic point cloud on the trajectory.
1313

14-
When the stop point that has 0 velocity is inserted, the point is inserted in front of the target point cloud by the distance of `baselink to front` + `stop margin`. The `baselink to front` means the distance between `base_link`(center of rear-wheel axis) and front of the car. `stop margin` is determined by the parameters described below.
14+
In order to stop with a `stop margin` from the obstacle exists, the stop point (`v=0`) is inserted at a distance of `baselink to front` + `stop margin` from the obstacle. The `baselink to front` means the distance between `base_link`(center of rear-wheel axis) and front of the car.
1515

16-
![insert_stop_velocity](./docs/insert_velocity.drawio.svg)
16+
If a stop point has already been inserted by other nodes between the obstacle and a position which is `stop margin` meters away from the obstacle, the stop point is inserted at a distance of `baselink to front` + `min behavior stop margin` from the obstacle.
17+
18+
<div align="center">
19+
<img src="./docs/insert_velocity1.drawio.svg" width=45%>
20+
<img src="./docs/insert_velocity2.drawio.svg" width=45%>
21+
</div>
1722

1823
When the deceleration section is inserted, the start point of the section is inserted in front of the target point cloud by the distance of `baselink to front` + `slow down forward margin`. the end point of the section is inserted behind the target point cloud by the distance of `slow down backward margin` + `baselink to rear`. The `baselink to rear` means the distance between `base_link` and rear of the car. The velocities of points in the deceleration section are modified to the deceleration velocity. `slow down backward margin` and `slow down forward margin` are determined by the parameters described below.
1924

20-
![insert_stop_velocity](./docs/insert_decel_velocity.drawio.svg)
25+
<div align="center">
26+
<img src="./docs/insert_decel_velocity.drawio.svg" width=45%>
27+
</div>
2128

2229
## Input topics
2330

0 commit comments

Comments
 (0)