diff --git a/autoware_launch/config/planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/behavior_velocity_planner.param.yaml b/autoware_launch/config/planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/behavior_velocity_planner.param.yaml
index ebddd0c75c..f678a0794d 100644
--- a/autoware_launch/config/planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/behavior_velocity_planner.param.yaml
+++ b/autoware_launch/config/planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/behavior_velocity_planner.param.yaml
@@ -22,5 +22,5 @@
# behavior_velocity_planner::OcclusionSpotModulePlugin
- behavior_velocity_planner::RunOutModulePlugin
# behavior_velocity_planner::SpeedBumpModulePlugin
- - behavior_velocity_planner::OutOfLaneModulePlugin
+ # behavior_velocity_planner::OutOfLaneModulePlugin
# behavior_velocity_planner::NoDrivableLaneModulePlugin
diff --git a/autoware_launch/config/planning/scenario_planning/lane_driving/motion_planning/motion_velocity_planner/motion_velocity_planner.param.yaml b/autoware_launch/config/planning/scenario_planning/lane_driving/motion_planning/motion_velocity_planner/motion_velocity_planner.param.yaml
new file mode 100644
index 0000000000..5a7e20d107
--- /dev/null
+++ b/autoware_launch/config/planning/scenario_planning/lane_driving/motion_planning/motion_velocity_planner/motion_velocity_planner.param.yaml
@@ -0,0 +1,5 @@
+/**:
+ ros__parameters:
+ smooth_velocity_before_planning: true # [-] if true, smooth the velocity profile of the input trajectory before planning
+ launch_modules:
+ - autoware::motion_velocity_planner::OutOfLaneModule
diff --git a/autoware_launch/config/planning/scenario_planning/lane_driving/motion_planning/motion_velocity_planner/out_of_lane.param.yaml b/autoware_launch/config/planning/scenario_planning/lane_driving/motion_planning/motion_velocity_planner/out_of_lane.param.yaml
new file mode 100644
index 0000000000..b13df72409
--- /dev/null
+++ b/autoware_launch/config/planning/scenario_planning/lane_driving/motion_planning/motion_velocity_planner/out_of_lane.param.yaml
@@ -0,0 +1,44 @@
+/**:
+ ros__parameters:
+ out_of_lane: # module to stop or slowdown before overlapping another lane with other objects
+ mode: ttc # mode used to consider a conflict with an object. "threshold", "intervals", or "ttc"
+ skip_if_already_overlapping: false # do not run this module when ego already overlaps another lane
+ ignore_overlaps_over_lane_changeable_lanelets: true # if true, overlaps on lane changeable lanelets are ignored
+
+ threshold:
+ time_threshold: 5.0 # [s] consider objects that will reach an overlap within this time
+ intervals: # consider objects if their estimated time interval spent on the overlap intersect the estimated time interval of ego
+ ego_time_buffer: 0.5 # [s] extend the ego time interval by this buffer
+ objects_time_buffer: 0.5 # [s] extend the time intervals of objects by this buffer
+ ttc:
+ threshold: 3.0 # [s] consider objects with an estimated time to collision bellow this value while on the overlap
+
+ objects:
+ minimum_velocity: 0.5 # [m/s] objects lower than this velocity will be ignored
+ use_predicted_paths: true # if true, use the predicted paths to estimate future positions.
+ # if false, assume the object moves at constant velocity along *all* lanelets it currently is located in.
+ predicted_path_min_confidence : 0.1 # when using predicted paths, ignore the ones whose confidence is lower than this value.
+ distance_buffer: 1.0 # [m] distance buffer used to determine if a collision will occur in the other lane
+ cut_predicted_paths_beyond_red_lights: true # if true, predicted paths are cut beyond the stop line of red traffic lights
+
+ overlap:
+ minimum_distance: 0.0 # [m] minimum distance inside a lanelet for an overlap to be considered
+ extra_length: 0.0 # [m] extra arc length to add to the front and back of an overlap (used to calculate enter/exit times)
+
+ action: # action to insert in the path if an object causes a conflict at an overlap
+ skip_if_over_max_decel: true # if true, do not take an action that would cause more deceleration than the maximum allowed
+ precision: 0.1 # [m] precision when inserting a stop pose in the path
+ distance_buffer: 1.5 # [m] buffer distance to try to keep between the ego footprint and lane
+ min_duration: 1.0 # [s] minimum duration needed before a decision can be canceled
+ slowdown:
+ distance_threshold: 30.0 # [m] insert a slowdown when closer than this distance from an overlap
+ velocity: 2.0 # [m/s] slowdown velocity
+ stop:
+ distance_threshold: 15.0 # [m] insert a stop when closer than this distance from an overlap
+
+ ego:
+ min_assumed_velocity: 2.0 # [m/s] minimum velocity used to calculate the enter and exit times of ego
+ extra_front_offset: 0.0 # [m] extra front distance
+ extra_rear_offset: 0.0 # [m] extra rear distance
+ extra_right_offset: 0.0 # [m] extra right distance
+ extra_left_offset: 0.0 # [m] extra left distance
diff --git a/autoware_launch/launch/components/tier4_planning_component.launch.xml b/autoware_launch/launch/components/tier4_planning_component.launch.xml
index fad93e4c30..026a235222 100644
--- a/autoware_launch/launch/components/tier4_planning_component.launch.xml
+++ b/autoware_launch/launch/components/tier4_planning_component.launch.xml
@@ -82,6 +82,9 @@
+
+
+
diff --git a/autoware_launch/rviz/autoware.rviz b/autoware_launch/rviz/autoware.rviz
index b134c5cd47..2490517b51 100644
--- a/autoware_launch/rviz/autoware.rviz
+++ b/autoware_launch/rviz/autoware.rviz
@@ -2153,6 +2153,18 @@ Visualization Manager:
Reliability Policy: Reliable
Value: /planning/scenario_planning/motion_velocity_smoother/virtual_wall
Value: true
+ - Class: rviz_default_plugins/MarkerArray
+ Enabled: true
+ Name: VirtualWall (OutOfLane)
+ Namespaces:
+ {}
+ Topic:
+ Depth: 5
+ Durability Policy: Volatile
+ History Policy: Keep Last
+ Reliability Policy: Reliable
+ Value: /planning/scenario_planning/lane_driving/motion_planning/motion_velocity_planner/out_of_lane/virtual_walls
+ Value: true
Enabled: true
Name: VirtualWall
- Class: rviz_common/Group
@@ -2276,6 +2288,22 @@ Visualization Manager:
Reliability Policy: Reliable
Value: /planning/scenario_planning/lane_driving/motion_planning/obstacle_avoidance_planner/debug/marker
Value: false
+ - Class: rviz_common/Group
+ Displays:
+ - Class: rviz_default_plugins/MarkerArray
+ Enabled: true
+ Name: OutOfLane
+ Namespaces:
+ {}
+ Topic:
+ Depth: 5
+ Durability Policy: Volatile
+ History Policy: Keep Last
+ Reliability Policy: Reliable
+ Value: /planning/scenario_planning/lane_driving/motion_planning/motion_velocity_planner/out_of_lane/debug_markers
+ Value: true
+ Enabled: false
+ Name: MotionVelocityPlanner
Enabled: false
Name: DebugMarker
Enabled: true