Skip to content

Commit b0ea676

Browse files
committed
docs(intersection): add upstream feature explanation
Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp>
1 parent b2cd2aa commit b0ea676

6 files changed

+2474
-691
lines changed

planning/behavior_velocity_intersection_module/README.md

+7
Original file line numberDiff line numberDiff line change
@@ -217,6 +217,13 @@ ros2 run behavior_velocity_intersection_module ttc.py --lane_id <lane_id>
217217

218218
![ego ttc profile](./docs/ttc.gif)
219219

220+
### about use_upstream_velocity flag
221+
222+
There are some use cases where ego should check collision before entering the intersection considering the temporal stop by walkway/crosswalk module around the exit of the intersection, because their stop position can be inside the intersection and it could bother upcoming vehicles. By setting the flag `collision_detection.velocity_profile.use_upstream` to true and running the walkway/crosswalk module prior to this module, ego velocity profile is calculated considering their velocity and stop positions.
223+
224+
As illustrated in below figure if upstream module inserted a stopline, ego position profile will remain there for the infinite time, thus it leads to the judgement that ego cannot exit the intersection during the interval [$t$ - `collision_detection.collision_start_margin_time`, $t$ + `collision_detection.collision_end_margin_time`]. In this way this feature considers possible collision for the infinite time if stoplines exist ahead of ego position (practically the prediction horizon is limited so the collision check horizon is bounded).
225+
![upstream_velocity](./docs/upstream-velocity.drawio.svg)
226+
220227
## Occlusion detection
221228

222229
If the flag `occlusion.enable` is true this module checks if there is sufficient field of view (FOV) on the attention area up to `occlusion.occlusion_attention_area_length`. If FOV is not clear enough ego first makes a brief stop at default_stopline for `occlusion.temporal_stop_time_before_peeking`, and then slowly creeps toward occlusion_peeking_stopline. If `occlusion.creep_during_peeking.enable` is true `occlusion.creep_during_peeking.creep_velocity` is inserted up to occlusion_peeking_stopline. Otherwise only stop line is inserted.

planning/behavior_velocity_intersection_module/docs/intersection-attention-ll-rr.drawio.svg

+27-1
Loading

0 commit comments

Comments
 (0)