Skip to content
Merged
Show file tree
Hide file tree
Changes from all commits
Commits
Show all changes
24 commits
Select commit Hold shift + click to select a range
3b2db5e
use temporary branch images to test new route planning
lreiher Aug 25, 2026
606c7a2
update all services related to lanelet2_route_planning@v2.0.0
lreiher Sep 4, 2026
c743476
tmp use branch image of route planning
jpbusch Sep 4, 2026
23ad125
use latest images for planning services
jpbusch Sep 15, 2026
6895e41
use latest image for route planning
jpbusch Sep 15, 2026
cd01ca2
update command of optimization
jpbusch Sep 15, 2026
e716c82
increase zenoh shm size to 16Gb because of issues in karl
jpbusch Sep 15, 2026
711a59e
Merge branch 'main' into upgrade/lanelet2-route-planning
jpbusch Sep 16, 2026
5ecdb36
use feature branch of prediction
jpbusch Oct 6, 2026
76f4f3f
update prediction to new branch
jpbusch Oct 9, 2026
5178923
update monitoring service
jpbusch Oct 22, 2026
fbf864b
update ll2 route planning service to v2.1.0
jpbusch Oct 22, 2026
5e357c0
update perception services
jpbusch Oct 22, 2026
c67fed1
update control service
jpbusch Oct 22, 2026
ba98102
update planning services
jpbusch Oct 23, 2026
1e93b40
small readme fix
jpbusch Oct 23, 2026
e1aa82a
bump lanelet2_map_server and point_cloud_fusion
cgeller Oct 23, 2026
0621f44
update demo parameters
cgeller Oct 23, 2026
04c490e
update compose rendering
cgeller Oct 23, 2026
614d1b3
Merge branch 'main' into upgrade/lanelet2-route-planning
cgeller Oct 23, 2026
3072e15
update demo rviz config
cgeller Oct 23, 2026
0aa2b86
update prediction service
jpbusch Oct 23, 2026
7870b69
update pcod
jpbusch Oct 23, 2026
d7d2827
update prediction service
jpbusch Oct 23, 2026
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
Original file line number Diff line number Diff line change
Expand Up @@ -2,7 +2,7 @@
# `../../utils/scripts/render_compose_sources.py`

include:
- oci://ghcr.io/openads-project/ackermann_trajectory_control:compose-v1.5.0
- oci://ghcr.io/openads-project/ackermann_trajectory_control/compose:v1.5.2

services:

Expand Down
12 changes: 6 additions & 6 deletions control/ackermann_trajectory_control/docker-compose.yml
Original file line number Diff line number Diff line change
@@ -1,16 +1,16 @@
# Auto-generated by `../../utils/scripts/render_compose_sources.py`
# based on `.docker-compose.oci-overrides.yml` with resolved includes
# include:
# # https://github.com/openads-project/ackermann_trajectory_control/blob/v1.5.0/deployment/compose/docker-compose.yml
# - oci://ghcr.io/openads-project/ackermann_trajectory_control:compose-v1.5.0
# # https://github.com/openads-project/ackermann_trajectory_control/blob/v1.5.2/deployment/compose/docker-compose.yml
# - oci://ghcr.io/openads-project/ackermann_trajectory_control/compose:v1.5.2

services:

control.ackermann-trajectory-control:
extends:
file: ../../utils/compose/docker-compose.template.yml
service: ros2-service
image: ghcr.io/openads-project/ackermann_trajectory_control:v1.5.0
image: ghcr.io/openads-project/ackermann_trajectory_control:v1.5.2
environment:
# --- name ------
# NAMESPACE: /
Expand All @@ -30,8 +30,8 @@ services:
# --- other -----
LOG_LEVEL: ${LOG_LEVEL:-info}
USE_SIM_TIME: ${USE_SIM_TIME:-false}
PARAMS: ${PARAMS:-/docker-ros/ws/install/ackermann_trajectory_control/share/ackermann_trajectory_control/config/params.yml}
TRACE: ${TRACE:-False}
PARAMS: /docker-ros/ws/install/ackermann_trajectory_control/share/ackermann_trajectory_control/config/params.yml
ROS_TRACING: ${ROS_TRACING:-False}
command:
- /bin/bash
- -ic
Expand All @@ -42,7 +42,7 @@ services:
log_level:=$${LOG_LEVEL} \
use_sim_time:=$${USE_SIM_TIME} \
params:=$${PARAMS} \
trace:=$${TRACE} \
ros_tracing:=$${ROS_TRACING} \
ego_data_topic:=$${EGO_DATA_TOPIC} \
trajectory_topic:=$${TRAJECTORY_TOPIC} \
lat_control_active_topic:=$${LAT_CONTROL_ACTIVE_TOPIC} \
Expand Down
13 changes: 12 additions & 1 deletion demo/lanelet2_object_list_prediction/params.yml
Original file line number Diff line number Diff line change
Expand Up @@ -5,4 +5,15 @@
lanelet_match_max_yaw_diff_rad: 1.57079632679
prediction_horizon_s: 8.0
prediction_sample_interval_s: 0.5
unmatched_object_prediction_mode: static
unmatched_object_prediction_mode: static
infeasible_prediction_probability: 0.0
max_longitudinal_acceleration_mps2: 1.0 # maximum acceleration for regaining the current speed after slowing down
max_longitudinal_deceleration_mps2: 3.0 # maximum deceleration for slowing down, e.g. before a curve or a yield line
participant_specific_matching:
enable: true # match and route pedestrians and two-wheelers with their own traffic rules, preferring bicycle lanes for two-wheelers
allow_opposite_direction: true # predict two-wheelers without a legal lanelet match against a lanelet's direction
motion_limits:
enable: true # reduce the predicted speed in curves to respect the acceleration limits
max_lateral_acceleration_mps2: 3.0 # maximum lateral acceleration of predicted objects in curves
yielding:
enable: true # stop objects at yield lines for conflicting priority traffic
12 changes: 10 additions & 2 deletions demo/lanelet2_route_planning/params.yml
Original file line number Diff line number Diff line change
@@ -1,25 +1,33 @@
/**/*:
ros__parameters:

ll2_map_server_name: /localization/lanelet2_map_server
publish_frequency: 20.0
action_feedback_frequency: 1.0
sampling_distance: 1.0
publish_frequency_global: 1.0
sampling_max_lateral_error_global: 0.5
project_destination_to_reference_line: true
destination_distance_threshold: 1.0
required_traveled_distance_proportion: 0.5
enrich_route_ahead_ego_distance: 100.0
enrich_route_behind_ego_distance: 10.0
enrich_route_ahead_ego_distance: 300.0
enrich_route_behind_ego_distance: 20.0
route_undershoot_distance: 10.0
route_overshoot_distance: 10.0
max_drivable_space_radius: 50.0
max_num_threads: 8
transform_timeout: 0.1

diagnostic_updater:
period: 0.1
use_fqn: true

# --- plan_route_action_client ---
# waypoints:
# - "<LATITUDE>, <LONGITUDE>"
# - "<LATITUDE>, <LONGITUDE>, <WAIT_TIME_S>"
# - "<LATITUDE>, <LONGITUDE>, -1" # intermediate destination
enable_random_destination: false
enable_continuous_planning: false
continuous_planning_replanning_proportion: 0.6
cancel_route: false
8 changes: 7 additions & 1 deletion demo/point_cloud_fusion/params.yml
Original file line number Diff line number Diff line change
Expand Up @@ -8,11 +8,17 @@
- "cloudini"
- "cloudini"

sync_queue_size: 3 # Queue depth for approximate time synchronization
sync_queue_size: 5 # Queue depth for approximate time synchronization
max_time_diff_sec: 0.05 # Maximum allowed timestamp difference (seconds) across inputs
output_queue_size: 10 # Queue depth for fused output publisher
age_penalty: 0.1 # Optional ApproximateTime tuning
use_cuda: true # Runtime-reconfigurable CPU/CUDA backend selection (requires CUDA build for true)
motion_compensation:
enable: true # Compensate sensor capture skew and motion during each rotating scan
fixed_frame: map # World-fixed TF frame connecting target_frame and every sensor frame
time_field: t # UINT32 offset from header.stamp for each point
# time_scale_sec: 1.0e-9 # default: nanoseconds; override only for a nonstandard time field
tf_timeout_sec: 0.1 # Per-lookup timeout; unavailable motion TF falls back to rigid fusion
fixed_points_per_input_cloud: 0 # 0=disabled
range_limits:
enable: false # Enable XYZ range filtering in target_frame
Expand Down
8 changes: 4 additions & 4 deletions demo/point_cloud_object_detection/params.yml
Original file line number Diff line number Diff line change
Expand Up @@ -2,7 +2,6 @@
ros__parameters:

# Core node configuration
prediction.server_url: "triton-server:8001"
prediction.model_repository: "point-cloud-object-detection"
prediction.model_version: "1"
preprocessing.backend: "cuda"
Expand All @@ -18,9 +17,10 @@
# Output filtering and object metadata
postprocessing.class_score_threshold: 0.0

# Object covariance defaults
# CONTINUOUS_STATE_COVARIANCE_UNKNOWN = -1.0
output.variances: [-1.0, -1.0, -1.0, -1.0, -1.0, -1.0, -1.0, -1.0, -1.0, -1.0, -1.0, -1.0]
# Object state covariances
# defaulting to CONTINUOUS_STATE_COVARIANCE_UNKNOWN=max(float64) for x, y, z, yaw, width, length, height as detected by detector
# defaulting to CONTINUOUS_STATE_COVARIANCE_INVALID=-1 for vel_lon, vel_lat, acc_lon, acc_lat as not detected by detector
output.variances: [1.7976931348623157e+308, 1.7976931348623157e+308, 1.7976931348623157e+308, -1.0, -1.0, -1.0, -1.0, 1.7976931348623157e+308, -1.0, 1.7976931348623157e+308, 1.7976931348623157e+308, 1.7976931348623157e+308]

# Model input feature selection
input.point_feature_field: "reflectivity"
Expand Down
19 changes: 11 additions & 8 deletions demo/simple_planner/params.yml
Original file line number Diff line number Diff line change
Expand Up @@ -14,30 +14,33 @@
n_states: 51 # number of states in published trajectory
interpolation_type: 1 # 0: linear, 1: cubic spline
v_ref: -1.0 # reference velocity (m/s). Set to '-1.0' to use velocity from route.
a_decel: -0.5 # desired deceleration for braking at stop lines or end of route (m/s^2) - must be < 0.0
a_max_decel: -1.0 # maximum deceleration for safe-stop trajectories (m/s^2) - must be < 0.0 and <= a_decel
a_decel: -1.0 # desired deceleration for braking at stop lines or end of route (m/s^2) - must be < 0.0
a_max_decel: -4.0 # maximum deceleration for safe-stop trajectories (m/s^2) - must be < 0.0 and <= a_decel
trigger_turn_signals: False # true: planner will request turn signal services; false: planner will not trigger turn signals

#### grid map parameters
consider_grid_map: False # true: planner will consider grid map; false: planner will ignore grid map
grid_map_timeout: 1.0 # time after which a received grid map is considered invalid (s) (use -1 for no timeout)
grid_occupied_threshold: 15 # minimum occupancy value that is considered blocked in the grid map
grid_occupied_threshold: 50 # minimum occupancy value that is considered blocked in the grid map
consider_out_of_grid: False # true: points outside the grid map are treated as occupied; false: free
grid_longitudinal_safety_distance: 1.5 # longitudinal ego-box margin; negative values shrink the box (m)
grid_lateral_safety_distance: 0.0 # lateral ego-box margin; negative values shrink the box (m)

#### traffic light parameters
#### regulatory element parameters
consider_traffic_lights: False # true: planner will consider traffic lights; false: planner will ignore traffic lights
offset_to_stop_line: 0.0 # additional distance to stop in front of a stop line (m) (default: 0.0 -> stops with front of vehicle at stop line)
consider_stop_signs: True # true: planner will consider stop signs; false: planner will ignore stop signs
consider_yield_signs: True # true: planner will consider yield signs; false: planner will ignore yield signs
offset_to_stop_line: 0.0 # additional distance to stop in front of a regulatory-element stop line (m) (default: 0.0 -> stops with front of vehicle at stop line)
ignore_stop_line_threshold: 0.5 # a stop line will be ignored if the front of the vehicle has already passed the stop line by more than this threshold (m)
consider_future_states: False # true: trajectory will consider forecast of traffic light states; false: trajectory will only consider current traffic light state
consider_future_states: False # true: trajectory will consider forecast states of supported regulatory elements; false: only current states

#### object parameters
consider_objects: True # true: planner will consider perceived objects on the route; false: planner will ignore objects
ignore_objects_behind_ego: True # exclude objects with reference-point x < 0 in vehicle_frame_id
object_timeout: 1.0 # time after which a received object list is considered invalid (s) (use -1 for no timeout)
min_prediction_prob: 0.0 # minimum probability for considering an object prediction branch; otherwise the most likely one is used
min_prediction_probability: 0.0 # consider predictions with probability > this threshold; otherwise use the most likely one
object_longitudinal_safety_distance: 1.5 # longitudinal ego-box margin; negative values shrink the box (m)
object_lateral_safety_distance: 0.0 # lateral ego-box margin; negative values shrink the box (m)
object_lateral_safety_distance: -0.8 # lateral ego-box margin; negative values shrink the box (m)
object_interaction_time_window: 0.5 # maximum time offset for counting a spatial overlap as interaction (s)
object_velocity_reduction_step: 0.1 # velocity decrement per object-avoidance iteration (m/s)
object_velocity_release_step: 0.5 # maximum velocity increase per cycle after hysteresis cleared object conflicts (m/s)
Expand Down
32 changes: 18 additions & 14 deletions demo/trajectory_optimization/params.yml
Original file line number Diff line number Diff line change
Expand Up @@ -9,11 +9,12 @@
standstill_threshold: 0.3 # threshold for standstill detection [m/s]. If all state velocities are below this threshold, publish standstill trajectory
high_level_stabilization: False # init first trajectory point with: current EgoData (True); interpolation of last trajectory -> bi-level (False)
consider_objects: 2 # consider objects in optimization: 0 = no, 1 = static (no prediction), 2 = dynamic (with prediction)
ignore_objects_behind_ego: True # exclude objects with reference-point x <= 0 in vehicle_frame_id
min_prediction_probability: 0.0 # consider only predictions with probability > this threshold
consider_boundaries: 1 # consider route boundaries in optimization: 0 = no, 1 = suggested lane, 2 = including adjacent, 3 = drivable space
consider_boundaries: 3 # consider route boundaries in optimization: 0 = no, 1 = suggested lane, 2 = including adjacent, 3 = drivable space
verbose: False # print debug infromation and solver statistics
performance_logging: False # write one CSV record for each completed solver run
debug_visualization: True # publish debug visualization markers (e.g. obstacle circles)
debug_visualization: True # publish debug visualization markers for ego, objects and boundaries
run_as_callback: False # run OCP once for each received reference trajectory (true) or on a timer (false)

#### thresholds for bi-level stabilization
Expand All @@ -22,28 +23,31 @@
bi_level_dYaw: 89.0 # maximum yaw difference before bi-level stabilization hits [degree]

### general parameters defining the ocp
model_name: 'karl' # name of the acados model
optimization_horizon: 5.0 # optimization horizon [s] (also used as build parameter in OCP)
n_shots: 50 # number of shooting intervals in optimization horizon (also used as build parameter in OCP)
model_name: 'karl' # name of the acados model
optimization_horizon: 5.0 # optimization horizon [s] (also used as build parameter in OCP)
n_shots: 50 # number of shooting intervals in optimization horizon (also used as build parameter in OCP)
two_stage_optimization: False # initialize the constrained OCP with a solve without object and boundary constraints
relaxed_solve_timeout_ms: 100.0 # timeout of the relaxed initialization solve [ms]; 0 disables the timeout
constrained_solve_timeout_ms: 100.0 # timeout of the fully constrained solve [ms]; 0 disables the timeout

#### cost weights
cost_weights:
- 0.02 # dlat (0)
- 0.1 # dlat (0)
- 0.0 # psi (1) (considered if RWS model is used)
- 0.3 # overspeed (2)
- 0.1 # underspeed (3)
- 0.5 # overspeed (2)
- 0.4 # underspeed (3)
- 0.15 # a_lat (4)
- 0.2 # a_lon_pos (5)
- 0.15 # a_lon_pos (5)
- 0.1 # a_lon_neg (6)
- 0.2 # j_lat (7)
- 0.1 # j_lon_pos (8)
- 0.15 # j_lon_neg (9)
- 0.1 # j_lon_neg (9)
- 0.1 # alpha (10)
- 3.0 # endYaw (11)
dynamic_weight: 1.0 # base for exponential weight

# other cost params
thw: 2.0 # time headway [s]
d_min_obstacle_long: 1.0 # minimum distance to keep to obstacles in longitudinal direction [m]
d_min_obstacle_lat: 0.1 # minimum distance to keep to obstacles in lateral direction [m]
d_min_boundary_lat: -0.5 # minimum distance to keep to boundaries in lateral direction [m]
thw: 2.0 # desired time headway [s]; soft with object slacks
d_min_object_long: 3.0 # desired longitudinal object clearance [m]; soft with object slacks
d_min_object_lat: 0.75 # desired lateral object clearance [m]; soft with object slacks
d_min_boundary_lat: 0.0 # minimum distance to keep to boundaries in lateral direction [m]
37 changes: 35 additions & 2 deletions demo/utils/rviz/conf.rviz
Original file line number Diff line number Diff line change
Expand Up @@ -300,6 +300,22 @@ Visualization Manager:
Velocity Color: 255; 0; 255
Velocity scale: 1
Visualize Z dimension: true
- Background Alpha: 0.5
Background Color: 20; 20; 20
Bottom: 10
Class: perception_msgs/EgoDataOverlay
Enabled: true
Height: 80
Left: 10
Name: Ego Overlay
Topic:
Depth: 5
Durability Policy: Volatile
History Policy: Keep Last
Reliability Policy: Reliable
Value: /localization/ego_state_estimation/ego_data
Value: true
Width: 350
- Class: rviz_default_plugins/Image
Enabled: true
Max Value: 1
Expand Down Expand Up @@ -753,6 +769,23 @@ Visualization Manager:
Opacity: 0.5
Value: true
Value: true
- Action Feedback Topic: /planning/lanelet2_route_planning/plan_route/_action/feedback
Background Alpha: 0.5
Background Color: 20; 20; 20
Class: route_planning_msgs/RouteOverlay
Enabled: true
Height: 125
Name: Route Overlay
Right: 10
Top: 10
Topic:
Depth: 5
Durability Policy: Volatile
History Policy: Keep Last
Reliability Policy: Reliable
Value: /planning/lanelet2_route_planning/route
Value: true
Width: 135
- Alpha: 0.5
Class: trajectory_planning_msgs/Trajectory
Enabled: true
Expand Down Expand Up @@ -829,13 +862,13 @@ Visualization Manager:
Enabled: true
Name: Optimized Trajectory
Namespaces:
ego-circles: true
ego-boxes: true
Topic:
Depth: 5
Durability Policy: Volatile
History Policy: Keep Last
Reliability Policy: Reliable
Value: /planning/trajectory_optimization/visualization/ego_circles
Value: /planning/trajectory_optimization/visualization/ego
Value: true
Enabled: true
Global Options:
Expand Down
2 changes: 1 addition & 1 deletion docs/functional-architecture.md
Original file line number Diff line number Diff line change
Expand Up @@ -43,7 +43,7 @@ For communication between nodes, [common interfaces](https://github.com/ros2/com
| OpenADService | Description |
| --- | --- |
| [lanelet2_route_planning](https://github.com/openads-project/lanelet2_route_planning) | Plans a route on a Lanelet2 map |
| [simple_planner](https://github.com/openads-project/simple_planner) | Generates route-following reference trajectories with safe-stop, traffic-light, turn-signal, and object-aware speed handling. |
| [simple_planner](https://github.com/openads-project/simple_planner) | Generates route-following reference trajectories with safe-stop, regulatory-element, occupancy-grid, turn-signal, and object-aware speed handling. |
| [trajectory_optimization](https://github.com/openads-project/trajectory_optimization) | Periodically solves a nonlinear OCP to generate optimized trajectories for automated driving. |

### Control
Expand Down
2 changes: 1 addition & 1 deletion docs/integration-architecture.md
Original file line number Diff line number Diff line change
Expand Up @@ -32,7 +32,7 @@ The override can then add or replace stack-specific values such as namespaces an

```yaml
include:
- oci://ghcr.io/openads-project/trajectory_optimization:compose-v1.3.0
- oci://ghcr.io/openads-project/trajectory_optimization/compose:v1.5.0

services:
trajectory-optimization:
Expand Down
Original file line number Diff line number Diff line change
Expand Up @@ -2,7 +2,7 @@
# `../../utils/scripts/render_compose_sources.py`

include:
- oci://ghcr.io/openads-project/lanelet2_map_server:compose-v1.2.2
- oci://ghcr.io/openads-project/lanelet2_map_server/compose:v1.2.4

services:

Expand Down
8 changes: 4 additions & 4 deletions localization/lanelet2_map_server/docker-compose.yml
Original file line number Diff line number Diff line change
@@ -1,16 +1,16 @@
# Auto-generated by `../../utils/scripts/render_compose_sources.py`
# based on `.docker-compose.oci-overrides.yml` with resolved includes
# include:
# # https://github.com/openads-project/lanelet2_map_server/blob/v1.2.2/deployment/compose/docker-compose.yml
# - oci://ghcr.io/openads-project/lanelet2_map_server:compose-v1.2.2
# # https://github.com/openads-project/lanelet2_map_server/blob/v1.2.4/deployment/compose/docker-compose.yml
# - oci://ghcr.io/openads-project/lanelet2_map_server/compose:v1.2.4

services:

localization.lanelet2-map-server:
extends:
file: ../../utils/compose/docker-compose.template.yml
service: ros2-service
image: ghcr.io/openads-project/lanelet2_map_server:v1.2.2
image: ghcr.io/openads-project/lanelet2_map_server:v1.2.4
environment:
# --- name ------
# NAMESPACE: /
Expand All @@ -22,7 +22,7 @@ services:
# --- other -----
LOG_LEVEL: ${LOG_LEVEL:-info}
USE_SIM_TIME: ${USE_SIM_TIME:-false}
PARAMS: ${PARAMS:-/docker-ros/ws/install/lanelet2_map_server/share/lanelet2_map_server/config/params.yml}
PARAMS: /docker-ros/ws/install/lanelet2_map_server/share/lanelet2_map_server/config/params.yml
command:
- /bin/bash
- -ic
Expand Down
2 changes: 1 addition & 1 deletion monitoring/monitoring/.docker-compose.oci-overrides.yml
Original file line number Diff line number Diff line change
Expand Up @@ -2,7 +2,7 @@
# `../../utils/scripts/render_compose_sources.py`

include:
- oci://ghcr.io/openads-project/monitoring:compose-v1.0.0
- oci://ghcr.io/openads-project/monitoring/compose:v26.10.20

services:

Expand Down
Loading
Loading