From 4c00fd5a5a7205090ebb8d6789ed6790700f5e9b Mon Sep 17 00:00:00 2001 From: Zulfaqar Azmi Date: Mon, 9 Mar 2026 11:19:10 +0900 Subject: [PATCH 01/10] feat: rename safety filter to validator Signed-off-by: Zulfaqar Azmi --- .../CMakeLists.txt | 0 .../README.md | 0 .../config/trajectory_safety_filter.param.yaml | 0 .../include/autoware/trajectory_safety_filter/filter_context.hpp | 0 .../trajectory_safety_filter/filters/collision_check_filter.hpp | 0 .../trajectory_safety_filter/filters/collision_filter.hpp | 0 .../trajectory_safety_filter/filters/out_of_lane_filter.hpp | 0 .../filters/uncrossable_boundary_departure_filter.hpp | 0 .../filters/vehicle_constraint_filter.hpp | 0 .../autoware/trajectory_safety_filter/safety_filter_interface.hpp | 0 .../trajectory_safety_filter/trajectory_safety_filter_node.hpp | 0 .../launch/trajectory_safety_filter.launch.xml | 0 .../package.xml | 0 .../param/parameter_struct.yaml | 0 .../plugins.xml | 0 .../src/filters/collision_check_filter.cpp | 0 .../src/filters/collision_filter.cpp | 0 .../src/filters/out_of_lane_filter.cpp | 0 .../src/filters/uncrossable_boundary_departure_filter.cpp | 0 .../src/filters/vehicle_constraint_filter.cpp | 0 .../src/trajectory_safety_filter_node.cpp | 0 .../test/collision_check_filter/test_collision.cpp | 0 .../collision_check_filter/test_constant_curvature_predictor.cpp | 0 .../test/collision_check_filter/test_motion.cpp | 0 .../test/collision_check_filter/test_polygon.cpp | 0 .../test/dummy_plugin/dummy_plugins.xml | 0 .../test/dummy_plugin/dummy_safety_filter_plugin.cpp | 0 .../test/node/test_trajectory_safety_filter_node.cpp | 0 .../test/plugins/test_vehicle_constraint_filter.cpp | 0 29 files changed, 0 insertions(+), 0 deletions(-) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/CMakeLists.txt (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/README.md (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/config/trajectory_safety_filter.param.yaml (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/include/autoware/trajectory_safety_filter/filter_context.hpp (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/include/autoware/trajectory_safety_filter/filters/collision_check_filter.hpp (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/include/autoware/trajectory_safety_filter/filters/collision_filter.hpp (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/include/autoware/trajectory_safety_filter/filters/out_of_lane_filter.hpp (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/include/autoware/trajectory_safety_filter/filters/uncrossable_boundary_departure_filter.hpp (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/include/autoware/trajectory_safety_filter/filters/vehicle_constraint_filter.hpp (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/include/autoware/trajectory_safety_filter/safety_filter_interface.hpp (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/include/autoware/trajectory_safety_filter/trajectory_safety_filter_node.hpp (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/launch/trajectory_safety_filter.launch.xml (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/package.xml (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/param/parameter_struct.yaml (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/plugins.xml (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/src/filters/collision_check_filter.cpp (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/src/filters/collision_filter.cpp (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/src/filters/out_of_lane_filter.cpp (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/src/filters/uncrossable_boundary_departure_filter.cpp (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/src/filters/vehicle_constraint_filter.cpp (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/src/trajectory_safety_filter_node.cpp (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/test/collision_check_filter/test_collision.cpp (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/test/collision_check_filter/test_constant_curvature_predictor.cpp (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/test/collision_check_filter/test_motion.cpp (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/test/collision_check_filter/test_polygon.cpp (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/test/dummy_plugin/dummy_plugins.xml (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/test/dummy_plugin/dummy_safety_filter_plugin.cpp (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/test/node/test_trajectory_safety_filter_node.cpp (100%) rename planning/{autoware_trajectory_safety_filter => autoware_trajectory_validator}/test/plugins/test_vehicle_constraint_filter.cpp (100%) diff --git a/planning/autoware_trajectory_safety_filter/CMakeLists.txt b/planning/autoware_trajectory_validator/CMakeLists.txt similarity index 100% rename from planning/autoware_trajectory_safety_filter/CMakeLists.txt rename to planning/autoware_trajectory_validator/CMakeLists.txt diff --git a/planning/autoware_trajectory_safety_filter/README.md b/planning/autoware_trajectory_validator/README.md similarity index 100% rename from planning/autoware_trajectory_safety_filter/README.md rename to planning/autoware_trajectory_validator/README.md diff --git a/planning/autoware_trajectory_safety_filter/config/trajectory_safety_filter.param.yaml b/planning/autoware_trajectory_validator/config/trajectory_safety_filter.param.yaml similarity index 100% rename from planning/autoware_trajectory_safety_filter/config/trajectory_safety_filter.param.yaml rename to planning/autoware_trajectory_validator/config/trajectory_safety_filter.param.yaml diff --git a/planning/autoware_trajectory_safety_filter/include/autoware/trajectory_safety_filter/filter_context.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/filter_context.hpp similarity index 100% rename from planning/autoware_trajectory_safety_filter/include/autoware/trajectory_safety_filter/filter_context.hpp rename to planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/filter_context.hpp diff --git a/planning/autoware_trajectory_safety_filter/include/autoware/trajectory_safety_filter/filters/collision_check_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/filters/collision_check_filter.hpp similarity index 100% rename from planning/autoware_trajectory_safety_filter/include/autoware/trajectory_safety_filter/filters/collision_check_filter.hpp rename to planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/filters/collision_check_filter.hpp diff --git a/planning/autoware_trajectory_safety_filter/include/autoware/trajectory_safety_filter/filters/collision_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/filters/collision_filter.hpp similarity index 100% rename from planning/autoware_trajectory_safety_filter/include/autoware/trajectory_safety_filter/filters/collision_filter.hpp rename to planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/filters/collision_filter.hpp diff --git a/planning/autoware_trajectory_safety_filter/include/autoware/trajectory_safety_filter/filters/out_of_lane_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/filters/out_of_lane_filter.hpp similarity index 100% rename from planning/autoware_trajectory_safety_filter/include/autoware/trajectory_safety_filter/filters/out_of_lane_filter.hpp rename to planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/filters/out_of_lane_filter.hpp diff --git a/planning/autoware_trajectory_safety_filter/include/autoware/trajectory_safety_filter/filters/uncrossable_boundary_departure_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/filters/uncrossable_boundary_departure_filter.hpp similarity index 100% rename from planning/autoware_trajectory_safety_filter/include/autoware/trajectory_safety_filter/filters/uncrossable_boundary_departure_filter.hpp rename to planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/filters/uncrossable_boundary_departure_filter.hpp diff --git a/planning/autoware_trajectory_safety_filter/include/autoware/trajectory_safety_filter/filters/vehicle_constraint_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/filters/vehicle_constraint_filter.hpp similarity index 100% rename from planning/autoware_trajectory_safety_filter/include/autoware/trajectory_safety_filter/filters/vehicle_constraint_filter.hpp rename to planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/filters/vehicle_constraint_filter.hpp diff --git a/planning/autoware_trajectory_safety_filter/include/autoware/trajectory_safety_filter/safety_filter_interface.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/safety_filter_interface.hpp similarity index 100% rename from planning/autoware_trajectory_safety_filter/include/autoware/trajectory_safety_filter/safety_filter_interface.hpp rename to planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/safety_filter_interface.hpp diff --git a/planning/autoware_trajectory_safety_filter/include/autoware/trajectory_safety_filter/trajectory_safety_filter_node.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/trajectory_safety_filter_node.hpp similarity index 100% rename from planning/autoware_trajectory_safety_filter/include/autoware/trajectory_safety_filter/trajectory_safety_filter_node.hpp rename to planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/trajectory_safety_filter_node.hpp diff --git a/planning/autoware_trajectory_safety_filter/launch/trajectory_safety_filter.launch.xml b/planning/autoware_trajectory_validator/launch/trajectory_safety_filter.launch.xml similarity index 100% rename from planning/autoware_trajectory_safety_filter/launch/trajectory_safety_filter.launch.xml rename to planning/autoware_trajectory_validator/launch/trajectory_safety_filter.launch.xml diff --git a/planning/autoware_trajectory_safety_filter/package.xml b/planning/autoware_trajectory_validator/package.xml similarity index 100% rename from planning/autoware_trajectory_safety_filter/package.xml rename to planning/autoware_trajectory_validator/package.xml diff --git a/planning/autoware_trajectory_safety_filter/param/parameter_struct.yaml b/planning/autoware_trajectory_validator/param/parameter_struct.yaml similarity index 100% rename from planning/autoware_trajectory_safety_filter/param/parameter_struct.yaml rename to planning/autoware_trajectory_validator/param/parameter_struct.yaml diff --git a/planning/autoware_trajectory_safety_filter/plugins.xml b/planning/autoware_trajectory_validator/plugins.xml similarity index 100% rename from planning/autoware_trajectory_safety_filter/plugins.xml rename to planning/autoware_trajectory_validator/plugins.xml diff --git a/planning/autoware_trajectory_safety_filter/src/filters/collision_check_filter.cpp b/planning/autoware_trajectory_validator/src/filters/collision_check_filter.cpp similarity index 100% rename from planning/autoware_trajectory_safety_filter/src/filters/collision_check_filter.cpp rename to planning/autoware_trajectory_validator/src/filters/collision_check_filter.cpp diff --git a/planning/autoware_trajectory_safety_filter/src/filters/collision_filter.cpp b/planning/autoware_trajectory_validator/src/filters/collision_filter.cpp similarity index 100% rename from planning/autoware_trajectory_safety_filter/src/filters/collision_filter.cpp rename to planning/autoware_trajectory_validator/src/filters/collision_filter.cpp diff --git a/planning/autoware_trajectory_safety_filter/src/filters/out_of_lane_filter.cpp b/planning/autoware_trajectory_validator/src/filters/out_of_lane_filter.cpp similarity index 100% rename from planning/autoware_trajectory_safety_filter/src/filters/out_of_lane_filter.cpp rename to planning/autoware_trajectory_validator/src/filters/out_of_lane_filter.cpp diff --git a/planning/autoware_trajectory_safety_filter/src/filters/uncrossable_boundary_departure_filter.cpp b/planning/autoware_trajectory_validator/src/filters/uncrossable_boundary_departure_filter.cpp similarity index 100% rename from planning/autoware_trajectory_safety_filter/src/filters/uncrossable_boundary_departure_filter.cpp rename to planning/autoware_trajectory_validator/src/filters/uncrossable_boundary_departure_filter.cpp diff --git a/planning/autoware_trajectory_safety_filter/src/filters/vehicle_constraint_filter.cpp b/planning/autoware_trajectory_validator/src/filters/vehicle_constraint_filter.cpp similarity index 100% rename from planning/autoware_trajectory_safety_filter/src/filters/vehicle_constraint_filter.cpp rename to planning/autoware_trajectory_validator/src/filters/vehicle_constraint_filter.cpp diff --git a/planning/autoware_trajectory_safety_filter/src/trajectory_safety_filter_node.cpp b/planning/autoware_trajectory_validator/src/trajectory_safety_filter_node.cpp similarity index 100% rename from planning/autoware_trajectory_safety_filter/src/trajectory_safety_filter_node.cpp rename to planning/autoware_trajectory_validator/src/trajectory_safety_filter_node.cpp diff --git a/planning/autoware_trajectory_safety_filter/test/collision_check_filter/test_collision.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp similarity index 100% rename from planning/autoware_trajectory_safety_filter/test/collision_check_filter/test_collision.cpp rename to planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp diff --git a/planning/autoware_trajectory_safety_filter/test/collision_check_filter/test_constant_curvature_predictor.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp similarity index 100% rename from planning/autoware_trajectory_safety_filter/test/collision_check_filter/test_constant_curvature_predictor.cpp rename to planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp diff --git a/planning/autoware_trajectory_safety_filter/test/collision_check_filter/test_motion.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp similarity index 100% rename from planning/autoware_trajectory_safety_filter/test/collision_check_filter/test_motion.cpp rename to planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp diff --git a/planning/autoware_trajectory_safety_filter/test/collision_check_filter/test_polygon.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp similarity index 100% rename from planning/autoware_trajectory_safety_filter/test/collision_check_filter/test_polygon.cpp rename to planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp diff --git a/planning/autoware_trajectory_safety_filter/test/dummy_plugin/dummy_plugins.xml b/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_plugins.xml similarity index 100% rename from planning/autoware_trajectory_safety_filter/test/dummy_plugin/dummy_plugins.xml rename to planning/autoware_trajectory_validator/test/dummy_plugin/dummy_plugins.xml diff --git a/planning/autoware_trajectory_safety_filter/test/dummy_plugin/dummy_safety_filter_plugin.cpp b/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_safety_filter_plugin.cpp similarity index 100% rename from planning/autoware_trajectory_safety_filter/test/dummy_plugin/dummy_safety_filter_plugin.cpp rename to planning/autoware_trajectory_validator/test/dummy_plugin/dummy_safety_filter_plugin.cpp diff --git a/planning/autoware_trajectory_safety_filter/test/node/test_trajectory_safety_filter_node.cpp b/planning/autoware_trajectory_validator/test/node/test_trajectory_safety_filter_node.cpp similarity index 100% rename from planning/autoware_trajectory_safety_filter/test/node/test_trajectory_safety_filter_node.cpp rename to planning/autoware_trajectory_validator/test/node/test_trajectory_safety_filter_node.cpp diff --git a/planning/autoware_trajectory_safety_filter/test/plugins/test_vehicle_constraint_filter.cpp b/planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp similarity index 100% rename from planning/autoware_trajectory_safety_filter/test/plugins/test_vehicle_constraint_filter.cpp rename to planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp From 10b78161d4d3c636ae118e7a93d408192bb3d9a3 Mon Sep 17 00:00:00 2001 From: Zulfaqar Azmi Date: Mon, 9 Mar 2026 11:33:27 +0900 Subject: [PATCH 02/10] refactor: renaming safety filter files Signed-off-by: Zulfaqar Azmi --- ...y_safety_filter.param.yaml => trajectory_validator.param.yaml} | 0 .../filter_context.hpp | 0 .../filters/collision_check_filter.hpp | 0 .../filters/collision_filter.hpp | 0 .../filters/out_of_lane_filter.hpp | 0 .../filters/uncrossable_boundary_departure_filter.hpp | 0 .../filters/vehicle_constraint_filter.hpp | 0 .../trajectory_validator_node.hpp} | 0 .../validator_interface.hpp} | 0 ...y_safety_filter.launch.xml => trajectory_validator.launch.xml} | 0 ...ctory_safety_filter_node.cpp => trajectory_validator_node.cpp} | 0 ...{dummy_safety_filter_plugin.cpp => dummy_validator_plugin.cpp} | 0 ..._safety_filter_node.cpp => test_trajectory_validator_node.cpp} | 0 13 files changed, 0 insertions(+), 0 deletions(-) rename planning/autoware_trajectory_validator/config/{trajectory_safety_filter.param.yaml => trajectory_validator.param.yaml} (100%) rename planning/autoware_trajectory_validator/include/autoware/{trajectory_safety_filter => trajectory_validator}/filter_context.hpp (100%) rename planning/autoware_trajectory_validator/include/autoware/{trajectory_safety_filter => trajectory_validator}/filters/collision_check_filter.hpp (100%) rename planning/autoware_trajectory_validator/include/autoware/{trajectory_safety_filter => trajectory_validator}/filters/collision_filter.hpp (100%) rename planning/autoware_trajectory_validator/include/autoware/{trajectory_safety_filter => trajectory_validator}/filters/out_of_lane_filter.hpp (100%) rename planning/autoware_trajectory_validator/include/autoware/{trajectory_safety_filter => trajectory_validator}/filters/uncrossable_boundary_departure_filter.hpp (100%) rename planning/autoware_trajectory_validator/include/autoware/{trajectory_safety_filter => trajectory_validator}/filters/vehicle_constraint_filter.hpp (100%) rename planning/autoware_trajectory_validator/include/autoware/{trajectory_safety_filter/trajectory_safety_filter_node.hpp => trajectory_validator/trajectory_validator_node.hpp} (100%) rename planning/autoware_trajectory_validator/include/autoware/{trajectory_safety_filter/safety_filter_interface.hpp => trajectory_validator/validator_interface.hpp} (100%) rename planning/autoware_trajectory_validator/launch/{trajectory_safety_filter.launch.xml => trajectory_validator.launch.xml} (100%) rename planning/autoware_trajectory_validator/src/{trajectory_safety_filter_node.cpp => trajectory_validator_node.cpp} (100%) rename planning/autoware_trajectory_validator/test/dummy_plugin/{dummy_safety_filter_plugin.cpp => dummy_validator_plugin.cpp} (100%) rename planning/autoware_trajectory_validator/test/node/{test_trajectory_safety_filter_node.cpp => test_trajectory_validator_node.cpp} (100%) diff --git a/planning/autoware_trajectory_validator/config/trajectory_safety_filter.param.yaml b/planning/autoware_trajectory_validator/config/trajectory_validator.param.yaml similarity index 100% rename from planning/autoware_trajectory_validator/config/trajectory_safety_filter.param.yaml rename to planning/autoware_trajectory_validator/config/trajectory_validator.param.yaml diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/filter_context.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp similarity index 100% rename from planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/filter_context.hpp rename to planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/filters/collision_check_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_check_filter.hpp similarity index 100% rename from planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/filters/collision_check_filter.hpp rename to planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_check_filter.hpp diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/filters/collision_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_filter.hpp similarity index 100% rename from planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/filters/collision_filter.hpp rename to planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_filter.hpp diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/filters/out_of_lane_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/out_of_lane_filter.hpp similarity index 100% rename from planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/filters/out_of_lane_filter.hpp rename to planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/out_of_lane_filter.hpp diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/filters/uncrossable_boundary_departure_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp similarity index 100% rename from planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/filters/uncrossable_boundary_departure_filter.hpp rename to planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/filters/vehicle_constraint_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp similarity index 100% rename from planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/filters/vehicle_constraint_filter.hpp rename to planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/trajectory_safety_filter_node.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp similarity index 100% rename from planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/trajectory_safety_filter_node.hpp rename to planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/safety_filter_interface.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp similarity index 100% rename from planning/autoware_trajectory_validator/include/autoware/trajectory_safety_filter/safety_filter_interface.hpp rename to planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp diff --git a/planning/autoware_trajectory_validator/launch/trajectory_safety_filter.launch.xml b/planning/autoware_trajectory_validator/launch/trajectory_validator.launch.xml similarity index 100% rename from planning/autoware_trajectory_validator/launch/trajectory_safety_filter.launch.xml rename to planning/autoware_trajectory_validator/launch/trajectory_validator.launch.xml diff --git a/planning/autoware_trajectory_validator/src/trajectory_safety_filter_node.cpp b/planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp similarity index 100% rename from planning/autoware_trajectory_validator/src/trajectory_safety_filter_node.cpp rename to planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp diff --git a/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_safety_filter_plugin.cpp b/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_validator_plugin.cpp similarity index 100% rename from planning/autoware_trajectory_validator/test/dummy_plugin/dummy_safety_filter_plugin.cpp rename to planning/autoware_trajectory_validator/test/dummy_plugin/dummy_validator_plugin.cpp diff --git a/planning/autoware_trajectory_validator/test/node/test_trajectory_safety_filter_node.cpp b/planning/autoware_trajectory_validator/test/node/test_trajectory_validator_node.cpp similarity index 100% rename from planning/autoware_trajectory_validator/test/node/test_trajectory_safety_filter_node.cpp rename to planning/autoware_trajectory_validator/test/node/test_trajectory_validator_node.cpp From f4adce8482c602a2b64e2adfc8aef91c8e3ca0b0 Mon Sep 17 00:00:00 2001 From: Zulfaqar Azmi Date: Mon, 9 Mar 2026 11:54:42 +0900 Subject: [PATCH 03/10] fix: rename in trajectory safety filter Signed-off-by: Zulfaqar Azmi --- .../CMakeLists.txt | 32 ++++++------- .../config/trajectory_validator.param.yaml | 20 ++++---- .../trajectory_validator/filter_context.hpp | 4 +- .../filters/collision_check_filter.hpp | 10 ++-- .../filters/collision_filter.hpp | 10 ++-- .../filters/out_of_lane_filter.hpp | 8 ++-- .../uncrossable_boundary_departure_filter.hpp | 10 ++-- .../filters/vehicle_constraint_filter.hpp | 8 ++-- .../trajectory_validator_node.hpp | 20 ++++---- .../validator_interface.hpp | 20 ++++---- .../launch/trajectory_validator.launch.xml | 6 +-- .../autoware_trajectory_validator/package.xml | 4 +- .../param/parameter_struct.yaml | 2 +- .../autoware_trajectory_validator/plugins.xml | 22 ++++----- .../src/filters/collision_check_filter.cpp | 10 ++-- .../src/filters/collision_filter.cpp | 10 ++-- .../src/filters/out_of_lane_filter.cpp | 12 ++--- .../uncrossable_boundary_departure_filter.cpp | 10 ++-- .../src/filters/vehicle_constraint_filter.cpp | 12 ++--- .../src/trajectory_validator_node.cpp | 46 +++++++++---------- .../collision_check_filter/test_collision.cpp | 4 +- .../test_constant_curvature_predictor.cpp | 6 +-- .../collision_check_filter/test_motion.cpp | 6 +-- .../collision_check_filter/test_polygon.cpp | 6 +-- .../test/dummy_plugin/dummy_plugins.xml | 6 +-- .../dummy_plugin/dummy_validator_plugin.cpp | 14 +++--- .../node/test_trajectory_validator_node.cpp | 32 ++++++------- .../test_vehicle_constraint_filter.cpp | 6 +-- 28 files changed, 178 insertions(+), 178 deletions(-) diff --git a/planning/autoware_trajectory_validator/CMakeLists.txt b/planning/autoware_trajectory_validator/CMakeLists.txt index 640b41cca92a9..19cde55922c45 100644 --- a/planning/autoware_trajectory_validator/CMakeLists.txt +++ b/planning/autoware_trajectory_validator/CMakeLists.txt @@ -1,9 +1,9 @@ cmake_minimum_required(VERSION 3.14) -project(autoware_trajectory_safety_filter) +project(autoware_trajectory_validator) find_package(autoware_cmake REQUIRED) autoware_package() -pluginlib_export_plugin_description_file(autoware_trajectory_safety_filter plugins.xml) +pluginlib_export_plugin_description_file(autoware_trajectory_validator plugins.xml) generate_parameter_library(${PROJECT_NAME}_param param/parameter_struct.yaml @@ -14,7 +14,7 @@ include_directories( ) ament_auto_add_library(${PROJECT_NAME} SHARED - src/trajectory_safety_filter_node.cpp + src/trajectory_validator_node.cpp ) target_link_libraries(${PROJECT_NAME} @@ -26,11 +26,11 @@ target_compile_options(${PROJECT_NAME} PUBLIC ) rclcpp_components_register_node(${PROJECT_NAME} - PLUGIN "autoware::trajectory_safety_filter::TrajectorySafetyFilter" + PLUGIN "autoware::trajectory_validator::TrajectoryValidator" EXECUTABLE ${PROJECT_NAME}_node ) -ament_auto_add_library(autoware_trajectory_safety_filter_plugins SHARED +ament_auto_add_library(autoware_trajectory_validator_plugins SHARED src/filters/out_of_lane_filter.cpp src/filters/collision_filter.cpp src/filters/uncrossable_boundary_departure_filter.cpp @@ -38,7 +38,7 @@ ament_auto_add_library(autoware_trajectory_safety_filter_plugins SHARED src/filters/collision_check_filter.cpp ) -target_link_libraries(autoware_trajectory_safety_filter_plugins +target_link_libraries(autoware_trajectory_validator_plugins ${PROJECT_NAME} ) @@ -54,7 +54,7 @@ if(BUILD_TESTING) test/plugins/test_vehicle_constraint_filter.cpp ) target_link_libraries(test_vehicle_constraint_filter - autoware_trajectory_safety_filter_plugins + autoware_trajectory_validator_plugins ) ament_add_ros_isolated_gtest(test_constant_curvature @@ -80,31 +80,31 @@ if(BUILD_TESTING) # ========================================== # 2. Dummy Plugin (Test Utility) # ========================================== - pluginlib_export_plugin_description_file(autoware_trajectory_safety_filter + pluginlib_export_plugin_description_file(autoware_trajectory_validator test/dummy_plugin/dummy_plugins.xml ) - ament_auto_add_library(dummy_safety_filter_plugin SHARED - test/dummy_plugin/dummy_safety_filter_plugin.cpp + ament_auto_add_library(dummy_validator_plugin SHARED + test/dummy_plugin/dummy_validator_plugin.cpp ) - target_link_libraries(dummy_safety_filter_plugin + target_link_libraries(dummy_validator_plugin ${PROJECT_NAME} ) # ========================================== # 3. Node Integration/Unit Tests # ========================================== - ament_add_ros_isolated_gtest(test_trajectory_safety_filter_node - test/node/test_trajectory_safety_filter_node.cpp + ament_add_ros_isolated_gtest(test_trajectory_validator_node + test/node/test_trajectory_validator_node.cpp ) - target_link_libraries(test_trajectory_safety_filter_node + target_link_libraries(test_trajectory_validator_node ${PROJECT_NAME} - dummy_safety_filter_plugin + dummy_validator_plugin ) - ament_target_dependencies(test_trajectory_safety_filter_node + ament_target_dependencies(test_trajectory_validator_node autoware_test_utils ) endif() diff --git a/planning/autoware_trajectory_validator/config/trajectory_validator.param.yaml b/planning/autoware_trajectory_validator/config/trajectory_validator.param.yaml index 93f21ca3b651a..3aa30ee67a935 100644 --- a/planning/autoware_trajectory_validator/config/trajectory_validator.param.yaml +++ b/planning/autoware_trajectory_validator/config/trajectory_validator.param.yaml @@ -2,18 +2,18 @@ ros__parameters: filter_names: [ - "autoware::trajectory_safety_filter::plugin::OutOfLaneFilter", - "autoware::trajectory_safety_filter::plugin::CollisionFilter", - "autoware::trajectory_safety_filter::plugin::CollisionCheckFilter", - "autoware::trajectory_safety_filter::plugin::UncrossableBoundaryDepartureFilter", - "autoware::trajectory_safety_filter::plugin::VehicleConstraintFilter", + "autoware::trajectory_validator::plugin::OutOfLaneFilter", + "autoware::trajectory_validator::plugin::CollisionFilter", + "autoware::trajectory_validator::plugin::CollisionCheckFilter", + "autoware::trajectory_validator::plugin::UncrossableBoundaryDepartureFilter", + "autoware::trajectory_validator::plugin::VehicleConstraintFilter", ] # available filters: - # "autoware::trajectory_safety_filter::plugin::OutOfLaneFilter" - # "autoware::trajectory_safety_filter::plugin::CollisionFilter" - # "autoware::trajectory_safety_filter::plugin::CollisionCheckFilter" - # "autoware::trajectory_safety_filter::plugin::UncrossableBoundaryDepartureFilter" - # "autoware::trajectory_safety_filter::plugin::VehicleConstraintFilter" + # "autoware::trajectory_validator::plugin::OutOfLaneFilter" + # "autoware::trajectory_validator::plugin::CollisionFilter" + # "autoware::trajectory_validator::plugin::CollisionCheckFilter" + # "autoware::trajectory_validator::plugin::UncrossableBoundaryDepartureFilter" + # "autoware::trajectory_validator::plugin::VehicleConstraintFilter" out_of_lane: time: 2.0 diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp index 2cb3548ce32e8..265b1df8ea3a6 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp @@ -29,7 +29,7 @@ #include #include -namespace autoware::trajectory_safety_filter +namespace autoware::trajectory_validator { // Base context that all filters can access @@ -40,6 +40,6 @@ struct FilterContext std::shared_ptr lanelet_map; autoware_perception_msgs::msg::PredictedObjects::ConstSharedPtr predicted_objects; }; -} // namespace autoware::trajectory_safety_filter +} // namespace autoware::trajectory_validator #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTER_CONTEXT_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_check_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_check_filter.hpp index dbbbc7c904fb7..a9fc8b9db7005 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_check_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_check_filter.hpp @@ -15,7 +15,7 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_CHECK_FILTER_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_CHECK_FILTER_HPP_ -#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" +#include "autoware/trajectory_validator/validator_interface.hpp" #include #include @@ -33,7 +33,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { using autoware_utils_geometry::Box2d; using autoware_utils_geometry::MultiPoint2d; @@ -130,10 +130,10 @@ PoseTrajectory compute_pose_trajectory( return pose_trajectory; } -class CollisionCheckFilter : public SafetyFilterInterface +class CollisionCheckFilter : public ValidatorInterface { public: - CollisionCheckFilter() : SafetyFilterInterface("CollisionCheckFilter") {} + CollisionCheckFilter() : ValidatorInterface("CollisionCheckFilter") {} tl::expected is_feasible( const TrajectoryPoints & traj_points, const FilterContext & context) override; @@ -151,6 +151,6 @@ class CollisionCheckFilter : public SafetyFilterInterface } pet_collision_params_; }; -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_CHECK_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_filter.hpp index 23aa77db8defe..f4c9c8d4180c5 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_filter.hpp @@ -15,7 +15,7 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_FILTER_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_FILTER_HPP_ -#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" +#include "autoware/trajectory_validator/validator_interface.hpp" #include @@ -26,7 +26,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { // Parameters for CollisionFilter @@ -36,10 +36,10 @@ struct CollisionParams double min_ttc = 2.0; // seconds - minimum acceptable time to collision }; -class CollisionFilter : public SafetyFilterInterface +class CollisionFilter : public ValidatorInterface { public: - CollisionFilter() : SafetyFilterInterface("CollisionFilter") {} + CollisionFilter() : ValidatorInterface("CollisionFilter") {} tl::expected is_feasible( const TrajectoryPoints & traj_points, const FilterContext & context) final; @@ -71,6 +71,6 @@ class CollisionFilter : public SafetyFilterInterface double time_from_start) const; }; -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/out_of_lane_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/out_of_lane_filter.hpp index da0b2fb6b98a4..957570ee247ec 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/out_of_lane_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/out_of_lane_filter.hpp @@ -15,7 +15,7 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__OUT_OF_LANE_FILTER_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__OUT_OF_LANE_FILTER_HPP_ -#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" +#include "autoware/trajectory_validator/validator_interface.hpp" #include #include @@ -28,7 +28,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { // Parameters for OutOfLaneFilter @@ -38,7 +38,7 @@ struct OutOfLaneParams double min_value = 0.0; // meters - minimum distance to lane boundary }; -class OutOfLaneFilter : public SafetyFilterInterface +class OutOfLaneFilter : public ValidatorInterface { public: OutOfLaneFilter(); @@ -55,6 +55,6 @@ class OutOfLaneFilter : public SafetyFilterInterface std::unique_ptr boundary_departure_checker_; }; -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__OUT_OF_LANE_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp index 2fe8e46889cf2..2e76b8ddb8bfd 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp @@ -15,7 +15,7 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__UNCROSSABLE_BOUNDARY_DEPARTURE_FILTER_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__UNCROSSABLE_BOUNDARY_DEPARTURE_FILTER_HPP_ -#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" +#include "autoware/trajectory_validator/validator_interface.hpp" #include #include @@ -24,12 +24,12 @@ #include #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { -class UncrossableBoundaryDepartureFilter : public SafetyFilterInterface +class UncrossableBoundaryDepartureFilter : public ValidatorInterface { public: - UncrossableBoundaryDepartureFilter() : SafetyFilterInterface("UncrossableBoundaryDepartureFilter") + UncrossableBoundaryDepartureFilter() : ValidatorInterface("UncrossableBoundaryDepartureFilter") { } @@ -65,6 +65,6 @@ class UncrossableBoundaryDepartureFilter : public SafetyFilterInterface RCLCPP_WARN_THROTTLE(log_, *clock_, 5000, fmt, args...); } }; -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__UNCROSSABLE_BOUNDARY_DEPARTURE_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp index 457c8868355b2..d662e5fcdb3a5 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp @@ -15,19 +15,19 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__VEHICLE_CONSTRAINT_FILTER_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__VEHICLE_CONSTRAINT_FILTER_HPP_ -#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" +#include "autoware/trajectory_validator/validator_interface.hpp" #include #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { /** * @brief VehicleConstraintFilter class - checks if the trajectory respects vehicle constraints * (e.g., max speed, max acceleration/deceleration). */ -class VehicleConstraintFilter final : public SafetyFilterInterface +class VehicleConstraintFilter final : public ValidatorInterface { public: using result_t = tl::expected; @@ -122,5 +122,5 @@ bool is_steering_angle_ok( */ bool is_steering_rate_ok( const TrajectoryPoints & traj_points, const VehicleInfo & vehicle_info, double max_steering_rate); -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__VEHICLE_CONSTRAINT_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp index 420fb793d041e..416d212186acd 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp @@ -15,10 +15,10 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__TRAJECTORY_SAFETY_FILTER_NODE_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__TRAJECTORY_SAFETY_FILTER_NODE_HPP_ -#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" +#include "autoware/trajectory_validator/validator_interface.hpp" #include -#include +#include #include #include #include @@ -39,7 +39,7 @@ #include #include -namespace autoware::trajectory_safety_filter +namespace autoware::trajectory_validator { using autoware_internal_planning_msgs::msg::CandidateTrajectories; using autoware_internal_planning_msgs::msg::CandidateTrajectory; @@ -50,10 +50,10 @@ using autoware_utils_diagnostics::DiagnosticsInterface; using geometry_msgs::msg::AccelWithCovarianceStamped; using nav_msgs::msg::Odometry; -class TrajectorySafetyFilter : public rclcpp::Node +class TrajectoryValidator : public rclcpp::Node { public: - explicit TrajectorySafetyFilter(const rclcpp::NodeOptions & node_options); + explicit TrajectoryValidator(const rclcpp::NodeOptions & node_options); private: void process(const CandidateTrajectories::ConstSharedPtr msg); @@ -74,7 +74,7 @@ class TrajectorySafetyFilter : public rclcpp::Node rcl_interfaces::msg::SetParametersResult on_parameter( const std::vector & parameters); - std::unique_ptr listener_; + std::unique_ptr listener_; rclcpp::Publisher::SharedPtr debug_processing_time_detail_pub_; @@ -96,14 +96,14 @@ class TrajectorySafetyFilter : public rclcpp::Node rclcpp::node_interfaces::OnSetParametersCallbackHandle::SharedPtr set_param_res_; - pluginlib::ClassLoader plugin_loader_; + pluginlib::ClassLoader plugin_loader_; - std::vector> plugins_; + std::vector> plugins_; autoware::vehicle_info_utils::VehicleInfo vehicle_info_; - DiagnosticsInterface diagnostics_interface_{this, "trajectory_safety_filter"}; + DiagnosticsInterface diagnostics_interface_{this, "trajectory_validator"}; }; -} // namespace autoware::trajectory_safety_filter +} // namespace autoware::trajectory_validator #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__TRAJECTORY_SAFETY_FILTER_NODE_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp index d641062d6d94f..6dd99fe83e349 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp @@ -15,7 +15,7 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__SAFETY_FILTER_INTERFACE_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__SAFETY_FILTER_INTERFACE_HPP_ -#include "autoware/trajectory_safety_filter/filter_context.hpp" +#include "autoware/trajectory_validator/filter_context.hpp" #include #include @@ -29,22 +29,22 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { using autoware_planning_msgs::msg::TrajectoryPoint; using TrajectoryPoints = std::vector; using VehicleInfo = autoware::vehicle_info_utils::VehicleInfo; -class SafetyFilterInterface +class ValidatorInterface { public: - explicit SafetyFilterInterface(std::string name) : name_(std::move(name)) {} + explicit ValidatorInterface(std::string name) : name_(std::move(name)) {} - virtual ~SafetyFilterInterface() = default; - SafetyFilterInterface(const SafetyFilterInterface &) = delete; - SafetyFilterInterface & operator=(const SafetyFilterInterface &) = delete; - SafetyFilterInterface(SafetyFilterInterface &&) = delete; - SafetyFilterInterface & operator=(SafetyFilterInterface &&) = delete; + virtual ~ValidatorInterface() = default; + ValidatorInterface(const ValidatorInterface &) = delete; + ValidatorInterface & operator=(const ValidatorInterface &) = delete; + ValidatorInterface(ValidatorInterface &&) = delete; + ValidatorInterface & operator=(ValidatorInterface &&) = delete; // Main filter method with context for plugin-specific data virtual tl::expected is_feasible( @@ -68,7 +68,7 @@ class SafetyFilterInterface std::string name_; std::shared_ptr vehicle_info_ptr_; }; -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin // NOLINTNEXTLINE #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__SAFETY_FILTER_INTERFACE_HPP_ diff --git a/planning/autoware_trajectory_validator/launch/trajectory_validator.launch.xml b/planning/autoware_trajectory_validator/launch/trajectory_validator.launch.xml index 88ac22e05a5af..eade3d9b9ebe2 100644 --- a/planning/autoware_trajectory_validator/launch/trajectory_validator.launch.xml +++ b/planning/autoware_trajectory_validator/launch/trajectory_validator.launch.xml @@ -1,6 +1,6 @@ - + @@ -8,8 +8,8 @@ - - + + diff --git a/planning/autoware_trajectory_validator/package.xml b/planning/autoware_trajectory_validator/package.xml index e2cf4d9022bbd..81caf758cd213 100644 --- a/planning/autoware_trajectory_validator/package.xml +++ b/planning/autoware_trajectory_validator/package.xml @@ -1,9 +1,9 @@ - autoware_trajectory_safety_filter + autoware_trajectory_validator 0.1.0 - The autoware_trajectory_safety_filter package + The autoware_trajectory_validator package Daniel Sanchez Yukihiro Saito diff --git a/planning/autoware_trajectory_validator/param/parameter_struct.yaml b/planning/autoware_trajectory_validator/param/parameter_struct.yaml index 1e9a4446a9017..0751ee163a555 100644 --- a/planning/autoware_trajectory_validator/param/parameter_struct.yaml +++ b/planning/autoware_trajectory_validator/param/parameter_struct.yaml @@ -1,4 +1,4 @@ -safety_filter: +validator: filter_names: type: string_array default_value: [] diff --git a/planning/autoware_trajectory_validator/plugins.xml b/planning/autoware_trajectory_validator/plugins.xml index a9197d4e71735..5e4d6492012ce 100644 --- a/planning/autoware_trajectory_validator/plugins.xml +++ b/planning/autoware_trajectory_validator/plugins.xml @@ -1,31 +1,31 @@ - - + + Filters trajectories that go out of lane boundaries - + Filters trajectories based on Time To Collision (TTC) with predicted objects - + Filters trajectories that cross uncrossable boundaries - + Filters trajectories that violate vehicle constraints such as maximum speed, acceleration, and steering angle - + Filters trajectories based on collision checks with predicted objects diff --git a/planning/autoware_trajectory_validator/src/filters/collision_check_filter.cpp b/planning/autoware_trajectory_validator/src/filters/collision_check_filter.cpp index f79a4474854b9..8d0e06494f75b 100644 --- a/planning/autoware_trajectory_validator/src/filters/collision_check_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/collision_check_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/filters/collision_check_filter.hpp" +#include "autoware/trajectory_validator/filters/collision_check_filter.hpp" #include #include @@ -31,7 +31,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { namespace motion @@ -420,9 +420,9 @@ tl::expected CollisionCheckFilter::is_feasible( return {}; } -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #include PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_safety_filter::plugin::CollisionCheckFilter, - autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) + autoware::trajectory_validator::plugin::CollisionCheckFilter, + autoware::trajectory_validator::plugin::ValidatorInterface) diff --git a/planning/autoware_trajectory_validator/src/filters/collision_filter.cpp b/planning/autoware_trajectory_validator/src/filters/collision_filter.cpp index de8dda6503123..c3c3780e9be2a 100644 --- a/planning/autoware_trajectory_validator/src/filters/collision_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/collision_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/filters/collision_filter.hpp" +#include "autoware/trajectory_validator/filters/collision_filter.hpp" #include @@ -27,7 +27,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { namespace @@ -283,9 +283,9 @@ void CollisionFilter::update_parameters(const std::vector & p update_param(parameters, "collision.time", params_.max_check_time); update_param(parameters, "collision.min_value", params_.min_ttc); } -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #include PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_safety_filter::plugin::CollisionFilter, - autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) + autoware::trajectory_validator::plugin::CollisionFilter, + autoware::trajectory_validator::plugin::ValidatorInterface) diff --git a/planning/autoware_trajectory_validator/src/filters/out_of_lane_filter.cpp b/planning/autoware_trajectory_validator/src/filters/out_of_lane_filter.cpp index 98b7c1136ed3c..ddb915720bb0f 100644 --- a/planning/autoware_trajectory_validator/src/filters/out_of_lane_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/out_of_lane_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/filters/out_of_lane_filter.hpp" +#include "autoware/trajectory_validator/filters/out_of_lane_filter.hpp" #include @@ -24,7 +24,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { namespace @@ -60,7 +60,7 @@ autoware_internal_planning_msgs::msg::PathWithLaneId convert_to_path_with_lane_i } } // namespace -OutOfLaneFilter::OutOfLaneFilter() : SafetyFilterInterface("OutOfLaneFilter") +OutOfLaneFilter::OutOfLaneFilter() : ValidatorInterface("OutOfLaneFilter") { // BoundaryDepartureChecker will be initialized when vehicle_info is set } @@ -109,9 +109,9 @@ tl::expected OutOfLaneFilter::is_feasible( return {}; } -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #include PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_safety_filter::plugin::OutOfLaneFilter, - autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) + autoware::trajectory_validator::plugin::OutOfLaneFilter, + autoware::trajectory_validator::plugin::ValidatorInterface) diff --git a/planning/autoware_trajectory_validator/src/filters/uncrossable_boundary_departure_filter.cpp b/planning/autoware_trajectory_validator/src/filters/uncrossable_boundary_departure_filter.cpp index 387219c5aefa0..694085ddfbfca 100644 --- a/planning/autoware_trajectory_validator/src/filters/uncrossable_boundary_departure_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/uncrossable_boundary_departure_filter.cpp @@ -12,12 +12,12 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/filters/uncrossable_boundary_departure_filter.hpp" +#include "autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp" #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { tl::expected UncrossableBoundaryDepartureFilter::is_feasible( const TrajectoryPoints & traj_points, const FilterContext & context) @@ -64,9 +64,9 @@ std::optional UncrossableBoundaryDepartureFilter::is_invalid_input( return std::nullopt; } -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #include PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_safety_filter::plugin::UncrossableBoundaryDepartureFilter, - autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) + autoware::trajectory_validator::plugin::UncrossableBoundaryDepartureFilter, + autoware::trajectory_validator::plugin::ValidatorInterface) diff --git a/planning/autoware_trajectory_validator/src/filters/vehicle_constraint_filter.cpp b/planning/autoware_trajectory_validator/src/filters/vehicle_constraint_filter.cpp index 80686c5df6416..e42976ddeac0a 100644 --- a/planning/autoware_trajectory_validator/src/filters/vehicle_constraint_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/vehicle_constraint_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/filters/vehicle_constraint_filter.hpp" +#include "autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp" #include #include @@ -20,7 +20,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { namespace { @@ -90,7 +90,7 @@ double to_steering_rate( } // namespace VehicleConstraintFilter::VehicleConstraintFilter() -: SafetyFilterInterface("VehicleConstraintFilter") +: ValidatorInterface("VehicleConstraintFilter") { } @@ -260,9 +260,9 @@ bool is_steering_rate_ok( } return true; } -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #include PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_safety_filter::plugin::VehicleConstraintFilter, - autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) + autoware::trajectory_validator::plugin::VehicleConstraintFilter, + autoware::trajectory_validator::plugin::ValidatorInterface) diff --git a/planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp b/planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp index f53565cf0dd8d..b59c2daabc312 100644 --- a/planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp +++ b/planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp @@ -12,10 +12,10 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/trajectory_safety_filter_node.hpp" +#include "autoware/trajectory_validator/trajectory_validator_node.hpp" -#include "autoware/trajectory_safety_filter/filter_context.hpp" -#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" +#include "autoware/trajectory_validator/filter_context.hpp" +#include "autoware/trajectory_validator/validator_interface.hpp" #include @@ -61,15 +61,15 @@ bool has_trajectory_from_generator( } } // namespace -namespace autoware::trajectory_safety_filter +namespace autoware::trajectory_validator { -TrajectorySafetyFilter::TrajectorySafetyFilter(const rclcpp::NodeOptions & options) -: Node{"trajectory_safety_filter_node", options}, - listener_{std::make_unique(get_node_parameters_interface())}, +TrajectoryValidator::TrajectoryValidator(const rclcpp::NodeOptions & options) +: Node{"trajectory_validator_node", options}, + listener_{std::make_unique(get_node_parameters_interface())}, plugin_loader_( - "autoware_trajectory_safety_filter", - "autoware::trajectory_safety_filter::plugin::SafetyFilterInterface"), + "autoware_trajectory_validator", + "autoware::trajectory_validator::plugin::ValidatorInterface"), vehicle_info_(autoware::vehicle_info_utils::VehicleInfoUtils(*this).getVehicleInfo()) { const auto filters = listener_->get_params().filter_names; @@ -79,11 +79,11 @@ TrajectorySafetyFilter::TrajectorySafetyFilter(const rclcpp::NodeOptions & optio sub_map_ = create_subscription( "~/input/lanelet2_map", rclcpp::QoS{1}.transient_local(), - std::bind(&TrajectorySafetyFilter::map_callback, this, std::placeholders::_1)); + std::bind(&TrajectoryValidator::map_callback, this, std::placeholders::_1)); sub_trajectories_ = create_subscription( "~/input/trajectories", 1, - std::bind(&TrajectorySafetyFilter::process, this, std::placeholders::_1)); + std::bind(&TrajectoryValidator::process, this, std::placeholders::_1)); pub_trajectories_ = create_publisher("~/output/trajectories", 1); @@ -93,10 +93,10 @@ TrajectorySafetyFilter::TrajectorySafetyFilter(const rclcpp::NodeOptions & optio std::make_shared(debug_processing_time_detail_pub_); set_param_res_ = this->add_on_set_parameters_callback( - std::bind(&TrajectorySafetyFilter::on_parameter, this, std::placeholders::_1)); + std::bind(&TrajectoryValidator::on_parameter, this, std::placeholders::_1)); } -void TrajectorySafetyFilter::process(const CandidateTrajectories::ConstSharedPtr msg) +void TrajectoryValidator::process(const CandidateTrajectories::ConstSharedPtr msg) { autoware_utils_debug::ScopedTimeTrack st(__func__, *time_keeper_); @@ -161,7 +161,7 @@ void TrajectorySafetyFilter::process(const CandidateTrajectories::ConstSharedPtr pub_trajectories_->publish(*filtered_msg); } -void TrajectorySafetyFilter::map_callback(const LaneletMapBin::ConstSharedPtr msg) +void TrajectoryValidator::map_callback(const LaneletMapBin::ConstSharedPtr msg) { autoware_utils_debug::ScopedTimeTrack st(__func__, *time_keeper_); @@ -169,7 +169,7 @@ void TrajectorySafetyFilter::map_callback(const LaneletMapBin::ConstSharedPtr ms lanelet::utils::conversion::fromBinMsg(*msg, lanelet_map_ptr_); } -void TrajectorySafetyFilter::load_metric(const std::string & name) +void TrajectoryValidator::load_metric(const std::string & name) { if (name == "") return; @@ -193,18 +193,18 @@ void TrajectorySafetyFilter::load_metric(const std::string & name) } catch (const pluginlib::CreateClassException & e) { RCLCPP_ERROR_STREAM( get_logger(), - "[safety_filter] createSharedInstance failed for '" << name << "': " << e.what()); + "[validator] createSharedInstance failed for '" << name << "': " << e.what()); } catch (const std::exception & e) { RCLCPP_ERROR_STREAM( - get_logger(), "[safety_filter] unexpected exception for '" << name << "': " << e.what()); + get_logger(), "[validator] unexpected exception for '" << name << "': " << e.what()); } } -void TrajectorySafetyFilter::unload_metric(const std::string & name) +void TrajectoryValidator::unload_metric(const std::string & name) { auto it = std::remove_if( plugins_.begin(), plugins_.end(), - [&](const std::shared_ptr & plugin) { + [&](const std::shared_ptr & plugin) { return plugin->get_name() == name; }); @@ -217,7 +217,7 @@ void TrajectorySafetyFilter::unload_metric(const std::string & name) } } -void TrajectorySafetyFilter::update_diagnostic( +void TrajectoryValidator::update_diagnostic( const CandidateTrajectories & input_trajectories, const CandidateTrajectories & filtered_trajectories) { @@ -242,7 +242,7 @@ void TrajectorySafetyFilter::update_diagnostic( diagnostics_interface_.publish(this->get_clock()->now()); } -rcl_interfaces::msg::SetParametersResult TrajectorySafetyFilter::on_parameter( +rcl_interfaces::msg::SetParametersResult TrajectoryValidator::on_parameter( const std::vector & parameters) { rcl_interfaces::msg::SetParametersResult result; @@ -262,7 +262,7 @@ rcl_interfaces::msg::SetParametersResult TrajectorySafetyFilter::on_parameter( return result; } -} // namespace autoware::trajectory_safety_filter +} // namespace autoware::trajectory_validator #include -RCLCPP_COMPONENTS_REGISTER_NODE(autoware::trajectory_safety_filter::TrajectorySafetyFilter) +RCLCPP_COMPONENTS_REGISTER_NODE(autoware::trajectory_validator::TrajectoryValidator) diff --git a/planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp index d4066c8d08e03..e96447032c30b 100644 --- a/planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp +++ b/planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp @@ -20,7 +20,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { class CollisionCheckFilterTest : public ::testing::Test @@ -227,4 +227,4 @@ TEST_F(CollisionCheckFilterTest, ObjectWillEnterPath) << "Error string did not contain 'constant_curvature_path'. Actual: " << error_msg; } -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin diff --git a/planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp index f0f8a304110f5..55255c0562538 100644 --- a/planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp +++ b/planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -// #include "autoware/trajectory_safety_filter/filters/collision_check_filter.cpp" +// #include "autoware/trajectory_validator/filters/collision_check_filter.cpp" #include "../..//src/filters/collision_check_filter.cpp" #include @@ -23,7 +23,7 @@ #include -namespace autoware::trajectory_safety_filter::plugin::constant_curvature_predictor +namespace autoware::trajectory_validator::plugin::constant_curvature_predictor { TEST(ConstantCurvaturePoseTrajectoryCalculatorTest, PoseToIsometry) @@ -216,4 +216,4 @@ TEST(ConstantCurvaturePoseTrajectoryCalculatorTest, ComputeTrajectory) } } -} // namespace autoware::trajectory_safety_filter::plugin::constant_curvature_predictor +} // namespace autoware::trajectory_validator::plugin::constant_curvature_predictor diff --git a/planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp index d56ace55c074c..5ba98e0502741 100644 --- a/planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp +++ b/planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -// #include "autoware/trajectory_safety_filter/filters/collision_check_filter.hpp" +// #include "autoware/trajectory_validator/filters/collision_check_filter.hpp" #include "../../src/filters/collision_check_filter.cpp" #include @@ -20,7 +20,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin::motion +namespace autoware::trajectory_validator::plugin::motion { class ComputeMotionProfile1dTest : public ::testing::Test { @@ -127,4 +127,4 @@ TEST_F(ComputeMotionProfile1dTest, LagLongerThanMaxTime) } } -} // namespace autoware::trajectory_safety_filter::plugin::motion +} // namespace autoware::trajectory_validator::plugin::motion diff --git a/planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp index c239f7e1b89f1..d88bb3deb4ed4 100644 --- a/planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp +++ b/planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -// #include "autoware/trajectory_safety_filter/filters/collision_check_filter.hpp" +// #include "autoware/trajectory_validator/filters/collision_check_filter.hpp" #include "../../src/filters/collision_check_filter.cpp" #include @@ -20,7 +20,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin::polygon +namespace autoware::trajectory_validator::plugin::polygon { class PolygonCollisionTest : public ::testing::Test @@ -95,4 +95,4 @@ TEST_F(PolygonCollisionTest, CheckPathPolygonConvexCollision) EXPECT_TRUE(check_path_polygon_convex_collision(traj1_collide, traj2_collide)); } -} // namespace autoware::trajectory_safety_filter::plugin::polygon +} // namespace autoware::trajectory_validator::plugin::polygon diff --git a/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_plugins.xml b/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_plugins.xml index 433397d5eed61..15f5b710dd034 100644 --- a/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_plugins.xml +++ b/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_plugins.xml @@ -1,7 +1,7 @@ - - + + A predictable dummy filter for testing the main node diff --git a/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_validator_plugin.cpp b/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_validator_plugin.cpp index 11f4284c4824a..f5da10a814e9c 100644 --- a/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_validator_plugin.cpp +++ b/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_validator_plugin.cpp @@ -12,16 +12,16 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" +#include "autoware/trajectory_validator/validator_interface.hpp" #include #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { -class DummyFilter : public SafetyFilterInterface +class DummyFilter : public ValidatorInterface { struct DummyFilterParam { @@ -29,7 +29,7 @@ class DummyFilter : public SafetyFilterInterface }; public: - DummyFilter() : SafetyFilterInterface("DummyFilter") {} + DummyFilter() : ValidatorInterface("DummyFilter") {} tl::expected is_feasible( const TrajectoryPoints & traj_points, const FilterContext & /*context*/) final @@ -62,8 +62,8 @@ class DummyFilter : public SafetyFilterInterface private: DummyFilterParam params_; }; -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_safety_filter::plugin::DummyFilter, - autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) + autoware::trajectory_validator::plugin::DummyFilter, + autoware::trajectory_validator::plugin::ValidatorInterface) diff --git a/planning/autoware_trajectory_validator/test/node/test_trajectory_validator_node.cpp b/planning/autoware_trajectory_validator/test/node/test_trajectory_validator_node.cpp index d16afb1fcd40e..3d5dd66dda4af 100644 --- a/planning/autoware_trajectory_validator/test/node/test_trajectory_validator_node.cpp +++ b/planning/autoware_trajectory_validator/test/node/test_trajectory_validator_node.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/trajectory_safety_filter_node.hpp" +#include "autoware/trajectory_validator/trajectory_validator_node.hpp" #include #include @@ -23,10 +23,10 @@ #include #include -namespace autoware::trajectory_safety_filter +namespace autoware::trajectory_validator { -class TrajectorySafetyFilterNodeTest : public ::testing::Test +class TrajectoryValidatorNodeTest : public ::testing::Test { protected: void SetUp() override @@ -34,7 +34,7 @@ class TrajectorySafetyFilterNodeTest : public ::testing::Test rclcpp::init(0, nullptr); node_options_.append_parameter_override( "filter_names", - std::vector{"autoware::trajectory_safety_filter::plugin::DummyFilter"}); + std::vector{"autoware::trajectory_validator::plugin::DummyFilter"}); node_options_.append_parameter_override("dummy.dummy_param", 0.0); const auto test_pkg_share = ament_index_cpp::get_package_share_directory("autoware_test_utils"); @@ -43,25 +43,25 @@ class TrajectorySafetyFilterNodeTest : public ::testing::Test autoware::test_utils::updateNodeOptions(node_options_, {vehicle_info_param_path}); - node_under_test_ = std::make_shared(node_options_); + node_under_test_ = std::make_shared(node_options_); test_node_ = std::make_shared("test_helper_node"); map_pub_ = test_node_->create_publisher( - "/trajectory_safety_filter_node/input/lanelet2_map", rclcpp::QoS{1}.transient_local()); + "/trajectory_validator_node/input/lanelet2_map", rclcpp::QoS{1}.transient_local()); odom_pub_ = test_node_->create_publisher( - "/trajectory_safety_filter_node/input/odometry", 1); + "/trajectory_validator_node/input/odometry", 1); accel_pub_ = test_node_->create_publisher( - "/trajectory_safety_filter_node/input/acceleration", 1); + "/trajectory_validator_node/input/acceleration", 1); obj_pub_ = test_node_->create_publisher( - "/trajectory_safety_filter_node/input/objects", 1); + "/trajectory_validator_node/input/objects", 1); traj_pub_ = test_node_->create_publisher( - "/trajectory_safety_filter_node/input/trajectories", 1); + "/trajectory_validator_node/input/trajectories", 1); output_sub_ = test_node_->create_subscription( - "/trajectory_safety_filter_node/output/trajectories", 1, + "/trajectory_validator_node/output/trajectories", 1, [this]( const autoware_internal_planning_msgs::msg::CandidateTrajectories::ConstSharedPtr msg) { last_output_ = msg; @@ -126,7 +126,7 @@ class TrajectorySafetyFilterNodeTest : public ::testing::Test rclcpp::NodeOptions node_options_; rclcpp::Node::SharedPtr test_node_; - std::shared_ptr node_under_test_; + std::shared_ptr node_under_test_; rclcpp::Publisher::SharedPtr map_pub_; rclcpp::Publisher::SharedPtr odom_pub_; @@ -140,7 +140,7 @@ class TrajectorySafetyFilterNodeTest : public ::testing::Test autoware_internal_planning_msgs::msg::CandidateTrajectories::ConstSharedPtr last_output_; }; -TEST_F(TrajectorySafetyFilterNodeTest, FiltersTrajectoriesViaPlugin) +TEST_F(TrajectoryValidatorNodeTest, FiltersTrajectoriesViaPlugin) { publish_context(); spin_until([] { return false; }, std::chrono::milliseconds(100)); @@ -160,7 +160,7 @@ TEST_F(TrajectorySafetyFilterNodeTest, FiltersTrajectoriesViaPlugin) EXPECT_EQ(last_output_->generator_info.front().generator_name.data, "SafePlanner"); } -TEST_F(TrajectorySafetyFilterNodeTest, UpdateParametersDynamically) +TEST_F(TrajectoryValidatorNodeTest, UpdateParametersDynamically) { publish_context(); spin_until([] { return false; }, std::chrono::milliseconds(100)); @@ -183,7 +183,7 @@ TEST_F(TrajectorySafetyFilterNodeTest, UpdateParametersDynamically) EXPECT_EQ(last_output_->candidate_trajectories.size(), 1u); } -TEST_F(TrajectorySafetyFilterNodeTest, HandlesPluginRejection) +TEST_F(TrajectoryValidatorNodeTest, HandlesPluginRejection) { publish_context(); spin_until([] { return false; }, std::chrono::milliseconds(100)); @@ -196,4 +196,4 @@ TEST_F(TrajectorySafetyFilterNodeTest, HandlesPluginRejection) ASSERT_TRUE(spin_until([this] { return last_output_ != nullptr; })); EXPECT_EQ(last_output_->candidate_trajectories.size(), 0u); } -} // namespace autoware::trajectory_safety_filter +} // namespace autoware::trajectory_validator diff --git a/planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp b/planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp index cd5526cf8f5c9..8e813bf01795b 100644 --- a/planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp +++ b/planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/filters/vehicle_constraint_filter.hpp" +#include "autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp" #include @@ -36,7 +36,7 @@ autoware_planning_msgs::msg::TrajectoryPoint create_trajectory_point( } } // namespace -namespace autoware::trajectory_safety_filter::plugin::testing +namespace autoware::trajectory_validator::plugin::testing { TEST(VehicleConstraintFilterTest, FeasibleWhenAllConstraintsSatisfied) { @@ -308,4 +308,4 @@ TEST(IsSteeringRateOkTest, FalseWhenAnySteeringRateAboveMax) EXPECT_FALSE(is_steering_rate_ok(traj_points, vehicle_info, max_steering_rate)); } -} // namespace autoware::trajectory_safety_filter::plugin::testing +} // namespace autoware::trajectory_validator::plugin::testing From c7b26b2d8321b7deb9dd75f6951673cbd50c3100 Mon Sep 17 00:00:00 2001 From: Zulfaqar Azmi Date: Mon, 9 Mar 2026 12:02:42 +0900 Subject: [PATCH 04/10] Revert "fix: rename in trajectory safety filter" This reverts commit 42979cd735a69f39e9108f2024e1470ad2dd6563. --- .../CMakeLists.txt | 32 +++++++------- .../config/trajectory_validator.param.yaml | 20 ++++----- .../trajectory_validator/filter_context.hpp | 4 +- .../filters/collision_check_filter.hpp | 10 ++--- .../filters/collision_filter.hpp | 10 ++--- .../filters/out_of_lane_filter.hpp | 8 ++-- .../uncrossable_boundary_departure_filter.hpp | 10 ++--- .../filters/vehicle_constraint_filter.hpp | 8 ++-- .../trajectory_validator_node.hpp | 20 ++++----- .../validator_interface.hpp | 20 ++++----- .../launch/trajectory_validator.launch.xml | 6 +-- .../autoware_trajectory_validator/package.xml | 4 +- .../param/parameter_struct.yaml | 2 +- .../autoware_trajectory_validator/plugins.xml | 22 +++++----- .../src/filters/collision_check_filter.cpp | 10 ++--- .../src/filters/collision_filter.cpp | 10 ++--- .../src/filters/out_of_lane_filter.cpp | 12 ++--- .../uncrossable_boundary_departure_filter.cpp | 10 ++--- .../src/filters/vehicle_constraint_filter.cpp | 12 ++--- .../src/trajectory_validator_node.cpp | 44 +++++++++---------- .../collision_check_filter/test_collision.cpp | 4 +- .../test_constant_curvature_predictor.cpp | 6 +-- .../collision_check_filter/test_motion.cpp | 6 +-- .../collision_check_filter/test_polygon.cpp | 6 +-- .../test/dummy_plugin/dummy_plugins.xml | 6 +-- .../dummy_plugin/dummy_validator_plugin.cpp | 14 +++--- .../node/test_trajectory_validator_node.cpp | 32 +++++++------- .../test_vehicle_constraint_filter.cpp | 6 +-- 28 files changed, 177 insertions(+), 177 deletions(-) diff --git a/planning/autoware_trajectory_validator/CMakeLists.txt b/planning/autoware_trajectory_validator/CMakeLists.txt index 19cde55922c45..640b41cca92a9 100644 --- a/planning/autoware_trajectory_validator/CMakeLists.txt +++ b/planning/autoware_trajectory_validator/CMakeLists.txt @@ -1,9 +1,9 @@ cmake_minimum_required(VERSION 3.14) -project(autoware_trajectory_validator) +project(autoware_trajectory_safety_filter) find_package(autoware_cmake REQUIRED) autoware_package() -pluginlib_export_plugin_description_file(autoware_trajectory_validator plugins.xml) +pluginlib_export_plugin_description_file(autoware_trajectory_safety_filter plugins.xml) generate_parameter_library(${PROJECT_NAME}_param param/parameter_struct.yaml @@ -14,7 +14,7 @@ include_directories( ) ament_auto_add_library(${PROJECT_NAME} SHARED - src/trajectory_validator_node.cpp + src/trajectory_safety_filter_node.cpp ) target_link_libraries(${PROJECT_NAME} @@ -26,11 +26,11 @@ target_compile_options(${PROJECT_NAME} PUBLIC ) rclcpp_components_register_node(${PROJECT_NAME} - PLUGIN "autoware::trajectory_validator::TrajectoryValidator" + PLUGIN "autoware::trajectory_safety_filter::TrajectorySafetyFilter" EXECUTABLE ${PROJECT_NAME}_node ) -ament_auto_add_library(autoware_trajectory_validator_plugins SHARED +ament_auto_add_library(autoware_trajectory_safety_filter_plugins SHARED src/filters/out_of_lane_filter.cpp src/filters/collision_filter.cpp src/filters/uncrossable_boundary_departure_filter.cpp @@ -38,7 +38,7 @@ ament_auto_add_library(autoware_trajectory_validator_plugins SHARED src/filters/collision_check_filter.cpp ) -target_link_libraries(autoware_trajectory_validator_plugins +target_link_libraries(autoware_trajectory_safety_filter_plugins ${PROJECT_NAME} ) @@ -54,7 +54,7 @@ if(BUILD_TESTING) test/plugins/test_vehicle_constraint_filter.cpp ) target_link_libraries(test_vehicle_constraint_filter - autoware_trajectory_validator_plugins + autoware_trajectory_safety_filter_plugins ) ament_add_ros_isolated_gtest(test_constant_curvature @@ -80,31 +80,31 @@ if(BUILD_TESTING) # ========================================== # 2. Dummy Plugin (Test Utility) # ========================================== - pluginlib_export_plugin_description_file(autoware_trajectory_validator + pluginlib_export_plugin_description_file(autoware_trajectory_safety_filter test/dummy_plugin/dummy_plugins.xml ) - ament_auto_add_library(dummy_validator_plugin SHARED - test/dummy_plugin/dummy_validator_plugin.cpp + ament_auto_add_library(dummy_safety_filter_plugin SHARED + test/dummy_plugin/dummy_safety_filter_plugin.cpp ) - target_link_libraries(dummy_validator_plugin + target_link_libraries(dummy_safety_filter_plugin ${PROJECT_NAME} ) # ========================================== # 3. Node Integration/Unit Tests # ========================================== - ament_add_ros_isolated_gtest(test_trajectory_validator_node - test/node/test_trajectory_validator_node.cpp + ament_add_ros_isolated_gtest(test_trajectory_safety_filter_node + test/node/test_trajectory_safety_filter_node.cpp ) - target_link_libraries(test_trajectory_validator_node + target_link_libraries(test_trajectory_safety_filter_node ${PROJECT_NAME} - dummy_validator_plugin + dummy_safety_filter_plugin ) - ament_target_dependencies(test_trajectory_validator_node + ament_target_dependencies(test_trajectory_safety_filter_node autoware_test_utils ) endif() diff --git a/planning/autoware_trajectory_validator/config/trajectory_validator.param.yaml b/planning/autoware_trajectory_validator/config/trajectory_validator.param.yaml index 3aa30ee67a935..93f21ca3b651a 100644 --- a/planning/autoware_trajectory_validator/config/trajectory_validator.param.yaml +++ b/planning/autoware_trajectory_validator/config/trajectory_validator.param.yaml @@ -2,18 +2,18 @@ ros__parameters: filter_names: [ - "autoware::trajectory_validator::plugin::OutOfLaneFilter", - "autoware::trajectory_validator::plugin::CollisionFilter", - "autoware::trajectory_validator::plugin::CollisionCheckFilter", - "autoware::trajectory_validator::plugin::UncrossableBoundaryDepartureFilter", - "autoware::trajectory_validator::plugin::VehicleConstraintFilter", + "autoware::trajectory_safety_filter::plugin::OutOfLaneFilter", + "autoware::trajectory_safety_filter::plugin::CollisionFilter", + "autoware::trajectory_safety_filter::plugin::CollisionCheckFilter", + "autoware::trajectory_safety_filter::plugin::UncrossableBoundaryDepartureFilter", + "autoware::trajectory_safety_filter::plugin::VehicleConstraintFilter", ] # available filters: - # "autoware::trajectory_validator::plugin::OutOfLaneFilter" - # "autoware::trajectory_validator::plugin::CollisionFilter" - # "autoware::trajectory_validator::plugin::CollisionCheckFilter" - # "autoware::trajectory_validator::plugin::UncrossableBoundaryDepartureFilter" - # "autoware::trajectory_validator::plugin::VehicleConstraintFilter" + # "autoware::trajectory_safety_filter::plugin::OutOfLaneFilter" + # "autoware::trajectory_safety_filter::plugin::CollisionFilter" + # "autoware::trajectory_safety_filter::plugin::CollisionCheckFilter" + # "autoware::trajectory_safety_filter::plugin::UncrossableBoundaryDepartureFilter" + # "autoware::trajectory_safety_filter::plugin::VehicleConstraintFilter" out_of_lane: time: 2.0 diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp index 265b1df8ea3a6..2cb3548ce32e8 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp @@ -29,7 +29,7 @@ #include #include -namespace autoware::trajectory_validator +namespace autoware::trajectory_safety_filter { // Base context that all filters can access @@ -40,6 +40,6 @@ struct FilterContext std::shared_ptr lanelet_map; autoware_perception_msgs::msg::PredictedObjects::ConstSharedPtr predicted_objects; }; -} // namespace autoware::trajectory_validator +} // namespace autoware::trajectory_safety_filter #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTER_CONTEXT_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_check_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_check_filter.hpp index a9fc8b9db7005..dbbbc7c904fb7 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_check_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_check_filter.hpp @@ -15,7 +15,7 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_CHECK_FILTER_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_CHECK_FILTER_HPP_ -#include "autoware/trajectory_validator/validator_interface.hpp" +#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" #include #include @@ -33,7 +33,7 @@ #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { using autoware_utils_geometry::Box2d; using autoware_utils_geometry::MultiPoint2d; @@ -130,10 +130,10 @@ PoseTrajectory compute_pose_trajectory( return pose_trajectory; } -class CollisionCheckFilter : public ValidatorInterface +class CollisionCheckFilter : public SafetyFilterInterface { public: - CollisionCheckFilter() : ValidatorInterface("CollisionCheckFilter") {} + CollisionCheckFilter() : SafetyFilterInterface("CollisionCheckFilter") {} tl::expected is_feasible( const TrajectoryPoints & traj_points, const FilterContext & context) override; @@ -151,6 +151,6 @@ class CollisionCheckFilter : public ValidatorInterface } pet_collision_params_; }; -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_CHECK_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_filter.hpp index f4c9c8d4180c5..23aa77db8defe 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_filter.hpp @@ -15,7 +15,7 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_FILTER_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_FILTER_HPP_ -#include "autoware/trajectory_validator/validator_interface.hpp" +#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" #include @@ -26,7 +26,7 @@ #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { // Parameters for CollisionFilter @@ -36,10 +36,10 @@ struct CollisionParams double min_ttc = 2.0; // seconds - minimum acceptable time to collision }; -class CollisionFilter : public ValidatorInterface +class CollisionFilter : public SafetyFilterInterface { public: - CollisionFilter() : ValidatorInterface("CollisionFilter") {} + CollisionFilter() : SafetyFilterInterface("CollisionFilter") {} tl::expected is_feasible( const TrajectoryPoints & traj_points, const FilterContext & context) final; @@ -71,6 +71,6 @@ class CollisionFilter : public ValidatorInterface double time_from_start) const; }; -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/out_of_lane_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/out_of_lane_filter.hpp index 957570ee247ec..da0b2fb6b98a4 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/out_of_lane_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/out_of_lane_filter.hpp @@ -15,7 +15,7 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__OUT_OF_LANE_FILTER_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__OUT_OF_LANE_FILTER_HPP_ -#include "autoware/trajectory_validator/validator_interface.hpp" +#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" #include #include @@ -28,7 +28,7 @@ #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { // Parameters for OutOfLaneFilter @@ -38,7 +38,7 @@ struct OutOfLaneParams double min_value = 0.0; // meters - minimum distance to lane boundary }; -class OutOfLaneFilter : public ValidatorInterface +class OutOfLaneFilter : public SafetyFilterInterface { public: OutOfLaneFilter(); @@ -55,6 +55,6 @@ class OutOfLaneFilter : public ValidatorInterface std::unique_ptr boundary_departure_checker_; }; -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__OUT_OF_LANE_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp index 2e76b8ddb8bfd..2fe8e46889cf2 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp @@ -15,7 +15,7 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__UNCROSSABLE_BOUNDARY_DEPARTURE_FILTER_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__UNCROSSABLE_BOUNDARY_DEPARTURE_FILTER_HPP_ -#include "autoware/trajectory_validator/validator_interface.hpp" +#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" #include #include @@ -24,12 +24,12 @@ #include #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { -class UncrossableBoundaryDepartureFilter : public ValidatorInterface +class UncrossableBoundaryDepartureFilter : public SafetyFilterInterface { public: - UncrossableBoundaryDepartureFilter() : ValidatorInterface("UncrossableBoundaryDepartureFilter") + UncrossableBoundaryDepartureFilter() : SafetyFilterInterface("UncrossableBoundaryDepartureFilter") { } @@ -65,6 +65,6 @@ class UncrossableBoundaryDepartureFilter : public ValidatorInterface RCLCPP_WARN_THROTTLE(log_, *clock_, 5000, fmt, args...); } }; -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__UNCROSSABLE_BOUNDARY_DEPARTURE_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp index d662e5fcdb3a5..457c8868355b2 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp @@ -15,19 +15,19 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__VEHICLE_CONSTRAINT_FILTER_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__VEHICLE_CONSTRAINT_FILTER_HPP_ -#include "autoware/trajectory_validator/validator_interface.hpp" +#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" #include #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { /** * @brief VehicleConstraintFilter class - checks if the trajectory respects vehicle constraints * (e.g., max speed, max acceleration/deceleration). */ -class VehicleConstraintFilter final : public ValidatorInterface +class VehicleConstraintFilter final : public SafetyFilterInterface { public: using result_t = tl::expected; @@ -122,5 +122,5 @@ bool is_steering_angle_ok( */ bool is_steering_rate_ok( const TrajectoryPoints & traj_points, const VehicleInfo & vehicle_info, double max_steering_rate); -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__VEHICLE_CONSTRAINT_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp index 416d212186acd..420fb793d041e 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp @@ -15,10 +15,10 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__TRAJECTORY_SAFETY_FILTER_NODE_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__TRAJECTORY_SAFETY_FILTER_NODE_HPP_ -#include "autoware/trajectory_validator/validator_interface.hpp" +#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" #include -#include +#include #include #include #include @@ -39,7 +39,7 @@ #include #include -namespace autoware::trajectory_validator +namespace autoware::trajectory_safety_filter { using autoware_internal_planning_msgs::msg::CandidateTrajectories; using autoware_internal_planning_msgs::msg::CandidateTrajectory; @@ -50,10 +50,10 @@ using autoware_utils_diagnostics::DiagnosticsInterface; using geometry_msgs::msg::AccelWithCovarianceStamped; using nav_msgs::msg::Odometry; -class TrajectoryValidator : public rclcpp::Node +class TrajectorySafetyFilter : public rclcpp::Node { public: - explicit TrajectoryValidator(const rclcpp::NodeOptions & node_options); + explicit TrajectorySafetyFilter(const rclcpp::NodeOptions & node_options); private: void process(const CandidateTrajectories::ConstSharedPtr msg); @@ -74,7 +74,7 @@ class TrajectoryValidator : public rclcpp::Node rcl_interfaces::msg::SetParametersResult on_parameter( const std::vector & parameters); - std::unique_ptr listener_; + std::unique_ptr listener_; rclcpp::Publisher::SharedPtr debug_processing_time_detail_pub_; @@ -96,14 +96,14 @@ class TrajectoryValidator : public rclcpp::Node rclcpp::node_interfaces::OnSetParametersCallbackHandle::SharedPtr set_param_res_; - pluginlib::ClassLoader plugin_loader_; + pluginlib::ClassLoader plugin_loader_; - std::vector> plugins_; + std::vector> plugins_; autoware::vehicle_info_utils::VehicleInfo vehicle_info_; - DiagnosticsInterface diagnostics_interface_{this, "trajectory_validator"}; + DiagnosticsInterface diagnostics_interface_{this, "trajectory_safety_filter"}; }; -} // namespace autoware::trajectory_validator +} // namespace autoware::trajectory_safety_filter #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__TRAJECTORY_SAFETY_FILTER_NODE_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp index 6dd99fe83e349..d641062d6d94f 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp @@ -15,7 +15,7 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__SAFETY_FILTER_INTERFACE_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__SAFETY_FILTER_INTERFACE_HPP_ -#include "autoware/trajectory_validator/filter_context.hpp" +#include "autoware/trajectory_safety_filter/filter_context.hpp" #include #include @@ -29,22 +29,22 @@ #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { using autoware_planning_msgs::msg::TrajectoryPoint; using TrajectoryPoints = std::vector; using VehicleInfo = autoware::vehicle_info_utils::VehicleInfo; -class ValidatorInterface +class SafetyFilterInterface { public: - explicit ValidatorInterface(std::string name) : name_(std::move(name)) {} + explicit SafetyFilterInterface(std::string name) : name_(std::move(name)) {} - virtual ~ValidatorInterface() = default; - ValidatorInterface(const ValidatorInterface &) = delete; - ValidatorInterface & operator=(const ValidatorInterface &) = delete; - ValidatorInterface(ValidatorInterface &&) = delete; - ValidatorInterface & operator=(ValidatorInterface &&) = delete; + virtual ~SafetyFilterInterface() = default; + SafetyFilterInterface(const SafetyFilterInterface &) = delete; + SafetyFilterInterface & operator=(const SafetyFilterInterface &) = delete; + SafetyFilterInterface(SafetyFilterInterface &&) = delete; + SafetyFilterInterface & operator=(SafetyFilterInterface &&) = delete; // Main filter method with context for plugin-specific data virtual tl::expected is_feasible( @@ -68,7 +68,7 @@ class ValidatorInterface std::string name_; std::shared_ptr vehicle_info_ptr_; }; -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin // NOLINTNEXTLINE #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__SAFETY_FILTER_INTERFACE_HPP_ diff --git a/planning/autoware_trajectory_validator/launch/trajectory_validator.launch.xml b/planning/autoware_trajectory_validator/launch/trajectory_validator.launch.xml index eade3d9b9ebe2..88ac22e05a5af 100644 --- a/planning/autoware_trajectory_validator/launch/trajectory_validator.launch.xml +++ b/planning/autoware_trajectory_validator/launch/trajectory_validator.launch.xml @@ -1,6 +1,6 @@ - + @@ -8,8 +8,8 @@ - - + + diff --git a/planning/autoware_trajectory_validator/package.xml b/planning/autoware_trajectory_validator/package.xml index 81caf758cd213..e2cf4d9022bbd 100644 --- a/planning/autoware_trajectory_validator/package.xml +++ b/planning/autoware_trajectory_validator/package.xml @@ -1,9 +1,9 @@ - autoware_trajectory_validator + autoware_trajectory_safety_filter 0.1.0 - The autoware_trajectory_validator package + The autoware_trajectory_safety_filter package Daniel Sanchez Yukihiro Saito diff --git a/planning/autoware_trajectory_validator/param/parameter_struct.yaml b/planning/autoware_trajectory_validator/param/parameter_struct.yaml index 0751ee163a555..1e9a4446a9017 100644 --- a/planning/autoware_trajectory_validator/param/parameter_struct.yaml +++ b/planning/autoware_trajectory_validator/param/parameter_struct.yaml @@ -1,4 +1,4 @@ -validator: +safety_filter: filter_names: type: string_array default_value: [] diff --git a/planning/autoware_trajectory_validator/plugins.xml b/planning/autoware_trajectory_validator/plugins.xml index 5e4d6492012ce..a9197d4e71735 100644 --- a/planning/autoware_trajectory_validator/plugins.xml +++ b/planning/autoware_trajectory_validator/plugins.xml @@ -1,31 +1,31 @@ - - + + Filters trajectories that go out of lane boundaries - + Filters trajectories based on Time To Collision (TTC) with predicted objects - + Filters trajectories that cross uncrossable boundaries - + Filters trajectories that violate vehicle constraints such as maximum speed, acceleration, and steering angle - + Filters trajectories based on collision checks with predicted objects diff --git a/planning/autoware_trajectory_validator/src/filters/collision_check_filter.cpp b/planning/autoware_trajectory_validator/src/filters/collision_check_filter.cpp index 8d0e06494f75b..f79a4474854b9 100644 --- a/planning/autoware_trajectory_validator/src/filters/collision_check_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/collision_check_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_validator/filters/collision_check_filter.hpp" +#include "autoware/trajectory_safety_filter/filters/collision_check_filter.hpp" #include #include @@ -31,7 +31,7 @@ #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { namespace motion @@ -420,9 +420,9 @@ tl::expected CollisionCheckFilter::is_feasible( return {}; } -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin #include PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_validator::plugin::CollisionCheckFilter, - autoware::trajectory_validator::plugin::ValidatorInterface) + autoware::trajectory_safety_filter::plugin::CollisionCheckFilter, + autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) diff --git a/planning/autoware_trajectory_validator/src/filters/collision_filter.cpp b/planning/autoware_trajectory_validator/src/filters/collision_filter.cpp index c3c3780e9be2a..de8dda6503123 100644 --- a/planning/autoware_trajectory_validator/src/filters/collision_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/collision_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_validator/filters/collision_filter.hpp" +#include "autoware/trajectory_safety_filter/filters/collision_filter.hpp" #include @@ -27,7 +27,7 @@ #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { namespace @@ -283,9 +283,9 @@ void CollisionFilter::update_parameters(const std::vector & p update_param(parameters, "collision.time", params_.max_check_time); update_param(parameters, "collision.min_value", params_.min_ttc); } -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin #include PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_validator::plugin::CollisionFilter, - autoware::trajectory_validator::plugin::ValidatorInterface) + autoware::trajectory_safety_filter::plugin::CollisionFilter, + autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) diff --git a/planning/autoware_trajectory_validator/src/filters/out_of_lane_filter.cpp b/planning/autoware_trajectory_validator/src/filters/out_of_lane_filter.cpp index ddb915720bb0f..98b7c1136ed3c 100644 --- a/planning/autoware_trajectory_validator/src/filters/out_of_lane_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/out_of_lane_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_validator/filters/out_of_lane_filter.hpp" +#include "autoware/trajectory_safety_filter/filters/out_of_lane_filter.hpp" #include @@ -24,7 +24,7 @@ #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { namespace @@ -60,7 +60,7 @@ autoware_internal_planning_msgs::msg::PathWithLaneId convert_to_path_with_lane_i } } // namespace -OutOfLaneFilter::OutOfLaneFilter() : ValidatorInterface("OutOfLaneFilter") +OutOfLaneFilter::OutOfLaneFilter() : SafetyFilterInterface("OutOfLaneFilter") { // BoundaryDepartureChecker will be initialized when vehicle_info is set } @@ -109,9 +109,9 @@ tl::expected OutOfLaneFilter::is_feasible( return {}; } -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin #include PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_validator::plugin::OutOfLaneFilter, - autoware::trajectory_validator::plugin::ValidatorInterface) + autoware::trajectory_safety_filter::plugin::OutOfLaneFilter, + autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) diff --git a/planning/autoware_trajectory_validator/src/filters/uncrossable_boundary_departure_filter.cpp b/planning/autoware_trajectory_validator/src/filters/uncrossable_boundary_departure_filter.cpp index 694085ddfbfca..387219c5aefa0 100644 --- a/planning/autoware_trajectory_validator/src/filters/uncrossable_boundary_departure_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/uncrossable_boundary_departure_filter.cpp @@ -12,12 +12,12 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp" +#include "autoware/trajectory_safety_filter/filters/uncrossable_boundary_departure_filter.hpp" #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { tl::expected UncrossableBoundaryDepartureFilter::is_feasible( const TrajectoryPoints & traj_points, const FilterContext & context) @@ -64,9 +64,9 @@ std::optional UncrossableBoundaryDepartureFilter::is_invalid_input( return std::nullopt; } -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin #include PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_validator::plugin::UncrossableBoundaryDepartureFilter, - autoware::trajectory_validator::plugin::ValidatorInterface) + autoware::trajectory_safety_filter::plugin::UncrossableBoundaryDepartureFilter, + autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) diff --git a/planning/autoware_trajectory_validator/src/filters/vehicle_constraint_filter.cpp b/planning/autoware_trajectory_validator/src/filters/vehicle_constraint_filter.cpp index e42976ddeac0a..80686c5df6416 100644 --- a/planning/autoware_trajectory_validator/src/filters/vehicle_constraint_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/vehicle_constraint_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp" +#include "autoware/trajectory_safety_filter/filters/vehicle_constraint_filter.hpp" #include #include @@ -20,7 +20,7 @@ #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { namespace { @@ -90,7 +90,7 @@ double to_steering_rate( } // namespace VehicleConstraintFilter::VehicleConstraintFilter() -: ValidatorInterface("VehicleConstraintFilter") +: SafetyFilterInterface("VehicleConstraintFilter") { } @@ -260,9 +260,9 @@ bool is_steering_rate_ok( } return true; } -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin #include PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_validator::plugin::VehicleConstraintFilter, - autoware::trajectory_validator::plugin::ValidatorInterface) + autoware::trajectory_safety_filter::plugin::VehicleConstraintFilter, + autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) diff --git a/planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp b/planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp index b59c2daabc312..a4e334a8ad93c 100644 --- a/planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp +++ b/planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp @@ -12,10 +12,10 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_validator/trajectory_validator_node.hpp" +#include "autoware/trajectory_safety_filter/trajectory_safety_filter_node.hpp" -#include "autoware/trajectory_validator/filter_context.hpp" -#include "autoware/trajectory_validator/validator_interface.hpp" +#include "autoware/trajectory_safety_filter/filter_context.hpp" +#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" #include @@ -61,15 +61,15 @@ bool has_trajectory_from_generator( } } // namespace -namespace autoware::trajectory_validator +namespace autoware::trajectory_safety_filter { -TrajectoryValidator::TrajectoryValidator(const rclcpp::NodeOptions & options) -: Node{"trajectory_validator_node", options}, - listener_{std::make_unique(get_node_parameters_interface())}, +TrajectorySafetyFilter::TrajectorySafetyFilter(const rclcpp::NodeOptions & options) +: Node{"trajectory_safety_filter_node", options}, + listener_{std::make_unique(get_node_parameters_interface())}, plugin_loader_( - "autoware_trajectory_validator", - "autoware::trajectory_validator::plugin::ValidatorInterface"), + "autoware_trajectory_safety_filter", + "autoware::trajectory_safety_filter::plugin::SafetyFilterInterface"), vehicle_info_(autoware::vehicle_info_utils::VehicleInfoUtils(*this).getVehicleInfo()) { const auto filters = listener_->get_params().filter_names; @@ -79,11 +79,11 @@ TrajectoryValidator::TrajectoryValidator(const rclcpp::NodeOptions & options) sub_map_ = create_subscription( "~/input/lanelet2_map", rclcpp::QoS{1}.transient_local(), - std::bind(&TrajectoryValidator::map_callback, this, std::placeholders::_1)); + std::bind(&TrajectorySafetyFilter::map_callback, this, std::placeholders::_1)); sub_trajectories_ = create_subscription( "~/input/trajectories", 1, - std::bind(&TrajectoryValidator::process, this, std::placeholders::_1)); + std::bind(&TrajectorySafetyFilter::process, this, std::placeholders::_1)); pub_trajectories_ = create_publisher("~/output/trajectories", 1); @@ -93,10 +93,10 @@ TrajectoryValidator::TrajectoryValidator(const rclcpp::NodeOptions & options) std::make_shared(debug_processing_time_detail_pub_); set_param_res_ = this->add_on_set_parameters_callback( - std::bind(&TrajectoryValidator::on_parameter, this, std::placeholders::_1)); + std::bind(&TrajectorySafetyFilter::on_parameter, this, std::placeholders::_1)); } -void TrajectoryValidator::process(const CandidateTrajectories::ConstSharedPtr msg) +void TrajectorySafetyFilter::process(const CandidateTrajectories::ConstSharedPtr msg) { autoware_utils_debug::ScopedTimeTrack st(__func__, *time_keeper_); @@ -161,7 +161,7 @@ void TrajectoryValidator::process(const CandidateTrajectories::ConstSharedPtr ms pub_trajectories_->publish(*filtered_msg); } -void TrajectoryValidator::map_callback(const LaneletMapBin::ConstSharedPtr msg) +void TrajectorySafetyFilter::map_callback(const LaneletMapBin::ConstSharedPtr msg) { autoware_utils_debug::ScopedTimeTrack st(__func__, *time_keeper_); @@ -169,7 +169,7 @@ void TrajectoryValidator::map_callback(const LaneletMapBin::ConstSharedPtr msg) lanelet::utils::conversion::fromBinMsg(*msg, lanelet_map_ptr_); } -void TrajectoryValidator::load_metric(const std::string & name) +void TrajectorySafetyFilter::load_metric(const std::string & name) { if (name == "") return; @@ -193,18 +193,18 @@ void TrajectoryValidator::load_metric(const std::string & name) } catch (const pluginlib::CreateClassException & e) { RCLCPP_ERROR_STREAM( get_logger(), - "[validator] createSharedInstance failed for '" << name << "': " << e.what()); + "[safety_filter] createSharedInstance failed for '" << name << "': " << e.what()); } catch (const std::exception & e) { RCLCPP_ERROR_STREAM( - get_logger(), "[validator] unexpected exception for '" << name << "': " << e.what()); + get_logger(), "[safety_filter] unexpected exception for '" << name << "': " << e.what()); } } -void TrajectoryValidator::unload_metric(const std::string & name) +void TrajectorySafetyFilter::unload_metric(const std::string & name) { auto it = std::remove_if( plugins_.begin(), plugins_.end(), - [&](const std::shared_ptr & plugin) { + [&](const std::shared_ptr & plugin) { return plugin->get_name() == name; }); @@ -242,7 +242,7 @@ void TrajectoryValidator::update_diagnostic( diagnostics_interface_.publish(this->get_clock()->now()); } -rcl_interfaces::msg::SetParametersResult TrajectoryValidator::on_parameter( +rcl_interfaces::msg::SetParametersResult TrajectorySafetyFilter::on_parameter( const std::vector & parameters) { rcl_interfaces::msg::SetParametersResult result; @@ -262,7 +262,7 @@ rcl_interfaces::msg::SetParametersResult TrajectoryValidator::on_parameter( return result; } -} // namespace autoware::trajectory_validator +} // namespace autoware::trajectory_safety_filter #include -RCLCPP_COMPONENTS_REGISTER_NODE(autoware::trajectory_validator::TrajectoryValidator) +RCLCPP_COMPONENTS_REGISTER_NODE(autoware::trajectory_safety_filter::TrajectorySafetyFilter) diff --git a/planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp index e96447032c30b..d4066c8d08e03 100644 --- a/planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp +++ b/planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp @@ -20,7 +20,7 @@ #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { class CollisionCheckFilterTest : public ::testing::Test @@ -227,4 +227,4 @@ TEST_F(CollisionCheckFilterTest, ObjectWillEnterPath) << "Error string did not contain 'constant_curvature_path'. Actual: " << error_msg; } -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin diff --git a/planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp index 55255c0562538..f0f8a304110f5 100644 --- a/planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp +++ b/planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -// #include "autoware/trajectory_validator/filters/collision_check_filter.cpp" +// #include "autoware/trajectory_safety_filter/filters/collision_check_filter.cpp" #include "../..//src/filters/collision_check_filter.cpp" #include @@ -23,7 +23,7 @@ #include -namespace autoware::trajectory_validator::plugin::constant_curvature_predictor +namespace autoware::trajectory_safety_filter::plugin::constant_curvature_predictor { TEST(ConstantCurvaturePoseTrajectoryCalculatorTest, PoseToIsometry) @@ -216,4 +216,4 @@ TEST(ConstantCurvaturePoseTrajectoryCalculatorTest, ComputeTrajectory) } } -} // namespace autoware::trajectory_validator::plugin::constant_curvature_predictor +} // namespace autoware::trajectory_safety_filter::plugin::constant_curvature_predictor diff --git a/planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp index 5ba98e0502741..d56ace55c074c 100644 --- a/planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp +++ b/planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -// #include "autoware/trajectory_validator/filters/collision_check_filter.hpp" +// #include "autoware/trajectory_safety_filter/filters/collision_check_filter.hpp" #include "../../src/filters/collision_check_filter.cpp" #include @@ -20,7 +20,7 @@ #include #include -namespace autoware::trajectory_validator::plugin::motion +namespace autoware::trajectory_safety_filter::plugin::motion { class ComputeMotionProfile1dTest : public ::testing::Test { @@ -127,4 +127,4 @@ TEST_F(ComputeMotionProfile1dTest, LagLongerThanMaxTime) } } -} // namespace autoware::trajectory_validator::plugin::motion +} // namespace autoware::trajectory_safety_filter::plugin::motion diff --git a/planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp index d88bb3deb4ed4..c239f7e1b89f1 100644 --- a/planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp +++ b/planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -// #include "autoware/trajectory_validator/filters/collision_check_filter.hpp" +// #include "autoware/trajectory_safety_filter/filters/collision_check_filter.hpp" #include "../../src/filters/collision_check_filter.cpp" #include @@ -20,7 +20,7 @@ #include #include -namespace autoware::trajectory_validator::plugin::polygon +namespace autoware::trajectory_safety_filter::plugin::polygon { class PolygonCollisionTest : public ::testing::Test @@ -95,4 +95,4 @@ TEST_F(PolygonCollisionTest, CheckPathPolygonConvexCollision) EXPECT_TRUE(check_path_polygon_convex_collision(traj1_collide, traj2_collide)); } -} // namespace autoware::trajectory_validator::plugin::polygon +} // namespace autoware::trajectory_safety_filter::plugin::polygon diff --git a/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_plugins.xml b/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_plugins.xml index 15f5b710dd034..433397d5eed61 100644 --- a/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_plugins.xml +++ b/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_plugins.xml @@ -1,7 +1,7 @@ - - + + A predictable dummy filter for testing the main node diff --git a/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_validator_plugin.cpp b/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_validator_plugin.cpp index f5da10a814e9c..11f4284c4824a 100644 --- a/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_validator_plugin.cpp +++ b/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_validator_plugin.cpp @@ -12,16 +12,16 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_validator/validator_interface.hpp" +#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" #include #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { -class DummyFilter : public ValidatorInterface +class DummyFilter : public SafetyFilterInterface { struct DummyFilterParam { @@ -29,7 +29,7 @@ class DummyFilter : public ValidatorInterface }; public: - DummyFilter() : ValidatorInterface("DummyFilter") {} + DummyFilter() : SafetyFilterInterface("DummyFilter") {} tl::expected is_feasible( const TrajectoryPoints & traj_points, const FilterContext & /*context*/) final @@ -62,8 +62,8 @@ class DummyFilter : public ValidatorInterface private: DummyFilterParam params_; }; -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_validator::plugin::DummyFilter, - autoware::trajectory_validator::plugin::ValidatorInterface) + autoware::trajectory_safety_filter::plugin::DummyFilter, + autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) diff --git a/planning/autoware_trajectory_validator/test/node/test_trajectory_validator_node.cpp b/planning/autoware_trajectory_validator/test/node/test_trajectory_validator_node.cpp index 3d5dd66dda4af..d16afb1fcd40e 100644 --- a/planning/autoware_trajectory_validator/test/node/test_trajectory_validator_node.cpp +++ b/planning/autoware_trajectory_validator/test/node/test_trajectory_validator_node.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_validator/trajectory_validator_node.hpp" +#include "autoware/trajectory_safety_filter/trajectory_safety_filter_node.hpp" #include #include @@ -23,10 +23,10 @@ #include #include -namespace autoware::trajectory_validator +namespace autoware::trajectory_safety_filter { -class TrajectoryValidatorNodeTest : public ::testing::Test +class TrajectorySafetyFilterNodeTest : public ::testing::Test { protected: void SetUp() override @@ -34,7 +34,7 @@ class TrajectoryValidatorNodeTest : public ::testing::Test rclcpp::init(0, nullptr); node_options_.append_parameter_override( "filter_names", - std::vector{"autoware::trajectory_validator::plugin::DummyFilter"}); + std::vector{"autoware::trajectory_safety_filter::plugin::DummyFilter"}); node_options_.append_parameter_override("dummy.dummy_param", 0.0); const auto test_pkg_share = ament_index_cpp::get_package_share_directory("autoware_test_utils"); @@ -43,25 +43,25 @@ class TrajectoryValidatorNodeTest : public ::testing::Test autoware::test_utils::updateNodeOptions(node_options_, {vehicle_info_param_path}); - node_under_test_ = std::make_shared(node_options_); + node_under_test_ = std::make_shared(node_options_); test_node_ = std::make_shared("test_helper_node"); map_pub_ = test_node_->create_publisher( - "/trajectory_validator_node/input/lanelet2_map", rclcpp::QoS{1}.transient_local()); + "/trajectory_safety_filter_node/input/lanelet2_map", rclcpp::QoS{1}.transient_local()); odom_pub_ = test_node_->create_publisher( - "/trajectory_validator_node/input/odometry", 1); + "/trajectory_safety_filter_node/input/odometry", 1); accel_pub_ = test_node_->create_publisher( - "/trajectory_validator_node/input/acceleration", 1); + "/trajectory_safety_filter_node/input/acceleration", 1); obj_pub_ = test_node_->create_publisher( - "/trajectory_validator_node/input/objects", 1); + "/trajectory_safety_filter_node/input/objects", 1); traj_pub_ = test_node_->create_publisher( - "/trajectory_validator_node/input/trajectories", 1); + "/trajectory_safety_filter_node/input/trajectories", 1); output_sub_ = test_node_->create_subscription( - "/trajectory_validator_node/output/trajectories", 1, + "/trajectory_safety_filter_node/output/trajectories", 1, [this]( const autoware_internal_planning_msgs::msg::CandidateTrajectories::ConstSharedPtr msg) { last_output_ = msg; @@ -126,7 +126,7 @@ class TrajectoryValidatorNodeTest : public ::testing::Test rclcpp::NodeOptions node_options_; rclcpp::Node::SharedPtr test_node_; - std::shared_ptr node_under_test_; + std::shared_ptr node_under_test_; rclcpp::Publisher::SharedPtr map_pub_; rclcpp::Publisher::SharedPtr odom_pub_; @@ -140,7 +140,7 @@ class TrajectoryValidatorNodeTest : public ::testing::Test autoware_internal_planning_msgs::msg::CandidateTrajectories::ConstSharedPtr last_output_; }; -TEST_F(TrajectoryValidatorNodeTest, FiltersTrajectoriesViaPlugin) +TEST_F(TrajectorySafetyFilterNodeTest, FiltersTrajectoriesViaPlugin) { publish_context(); spin_until([] { return false; }, std::chrono::milliseconds(100)); @@ -160,7 +160,7 @@ TEST_F(TrajectoryValidatorNodeTest, FiltersTrajectoriesViaPlugin) EXPECT_EQ(last_output_->generator_info.front().generator_name.data, "SafePlanner"); } -TEST_F(TrajectoryValidatorNodeTest, UpdateParametersDynamically) +TEST_F(TrajectorySafetyFilterNodeTest, UpdateParametersDynamically) { publish_context(); spin_until([] { return false; }, std::chrono::milliseconds(100)); @@ -183,7 +183,7 @@ TEST_F(TrajectoryValidatorNodeTest, UpdateParametersDynamically) EXPECT_EQ(last_output_->candidate_trajectories.size(), 1u); } -TEST_F(TrajectoryValidatorNodeTest, HandlesPluginRejection) +TEST_F(TrajectorySafetyFilterNodeTest, HandlesPluginRejection) { publish_context(); spin_until([] { return false; }, std::chrono::milliseconds(100)); @@ -196,4 +196,4 @@ TEST_F(TrajectoryValidatorNodeTest, HandlesPluginRejection) ASSERT_TRUE(spin_until([this] { return last_output_ != nullptr; })); EXPECT_EQ(last_output_->candidate_trajectories.size(), 0u); } -} // namespace autoware::trajectory_validator +} // namespace autoware::trajectory_safety_filter diff --git a/planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp b/planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp index 8e813bf01795b..cd5526cf8f5c9 100644 --- a/planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp +++ b/planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp" +#include "autoware/trajectory_safety_filter/filters/vehicle_constraint_filter.hpp" #include @@ -36,7 +36,7 @@ autoware_planning_msgs::msg::TrajectoryPoint create_trajectory_point( } } // namespace -namespace autoware::trajectory_validator::plugin::testing +namespace autoware::trajectory_safety_filter::plugin::testing { TEST(VehicleConstraintFilterTest, FeasibleWhenAllConstraintsSatisfied) { @@ -308,4 +308,4 @@ TEST(IsSteeringRateOkTest, FalseWhenAnySteeringRateAboveMax) EXPECT_FALSE(is_steering_rate_ok(traj_points, vehicle_info, max_steering_rate)); } -} // namespace autoware::trajectory_validator::plugin::testing +} // namespace autoware::trajectory_safety_filter::plugin::testing From da206694dc4cc3de9e9481803d2fe653d6f06bd2 Mon Sep 17 00:00:00 2001 From: Zulfaqar Azmi Date: Mon, 9 Mar 2026 12:03:53 +0900 Subject: [PATCH 05/10] fix: rename in trajectory safety filter Signed-off-by: Zulfaqar Azmi --- .../CMakeLists.txt | 32 +++++++------- .../config/trajectory_validator.param.yaml | 20 ++++----- .../trajectory_validator/filter_context.hpp | 4 +- .../filters/collision_check_filter.hpp | 10 ++--- .../filters/collision_filter.hpp | 10 ++--- .../filters/out_of_lane_filter.hpp | 8 ++-- .../uncrossable_boundary_departure_filter.hpp | 10 ++--- .../filters/vehicle_constraint_filter.hpp | 8 ++-- .../trajectory_validator_node.hpp | 20 ++++----- .../validator_interface.hpp | 20 ++++----- .../launch/trajectory_validator.launch.xml | 6 +-- .../autoware_trajectory_validator/package.xml | 4 +- .../param/parameter_struct.yaml | 2 +- .../autoware_trajectory_validator/plugins.xml | 22 +++++----- .../src/filters/collision_check_filter.cpp | 10 ++--- .../src/filters/collision_filter.cpp | 10 ++--- .../src/filters/out_of_lane_filter.cpp | 12 ++--- .../uncrossable_boundary_departure_filter.cpp | 10 ++--- .../src/filters/vehicle_constraint_filter.cpp | 12 ++--- .../src/trajectory_validator_node.cpp | 44 +++++++++---------- .../collision_check_filter/test_collision.cpp | 4 +- .../test_constant_curvature_predictor.cpp | 6 +-- .../collision_check_filter/test_motion.cpp | 6 +-- .../collision_check_filter/test_polygon.cpp | 6 +-- .../test/dummy_plugin/dummy_plugins.xml | 6 +-- .../dummy_plugin/dummy_validator_plugin.cpp | 14 +++--- .../node/test_trajectory_validator_node.cpp | 32 +++++++------- .../test_vehicle_constraint_filter.cpp | 6 +-- 28 files changed, 177 insertions(+), 177 deletions(-) diff --git a/planning/autoware_trajectory_validator/CMakeLists.txt b/planning/autoware_trajectory_validator/CMakeLists.txt index 640b41cca92a9..19cde55922c45 100644 --- a/planning/autoware_trajectory_validator/CMakeLists.txt +++ b/planning/autoware_trajectory_validator/CMakeLists.txt @@ -1,9 +1,9 @@ cmake_minimum_required(VERSION 3.14) -project(autoware_trajectory_safety_filter) +project(autoware_trajectory_validator) find_package(autoware_cmake REQUIRED) autoware_package() -pluginlib_export_plugin_description_file(autoware_trajectory_safety_filter plugins.xml) +pluginlib_export_plugin_description_file(autoware_trajectory_validator plugins.xml) generate_parameter_library(${PROJECT_NAME}_param param/parameter_struct.yaml @@ -14,7 +14,7 @@ include_directories( ) ament_auto_add_library(${PROJECT_NAME} SHARED - src/trajectory_safety_filter_node.cpp + src/trajectory_validator_node.cpp ) target_link_libraries(${PROJECT_NAME} @@ -26,11 +26,11 @@ target_compile_options(${PROJECT_NAME} PUBLIC ) rclcpp_components_register_node(${PROJECT_NAME} - PLUGIN "autoware::trajectory_safety_filter::TrajectorySafetyFilter" + PLUGIN "autoware::trajectory_validator::TrajectoryValidator" EXECUTABLE ${PROJECT_NAME}_node ) -ament_auto_add_library(autoware_trajectory_safety_filter_plugins SHARED +ament_auto_add_library(autoware_trajectory_validator_plugins SHARED src/filters/out_of_lane_filter.cpp src/filters/collision_filter.cpp src/filters/uncrossable_boundary_departure_filter.cpp @@ -38,7 +38,7 @@ ament_auto_add_library(autoware_trajectory_safety_filter_plugins SHARED src/filters/collision_check_filter.cpp ) -target_link_libraries(autoware_trajectory_safety_filter_plugins +target_link_libraries(autoware_trajectory_validator_plugins ${PROJECT_NAME} ) @@ -54,7 +54,7 @@ if(BUILD_TESTING) test/plugins/test_vehicle_constraint_filter.cpp ) target_link_libraries(test_vehicle_constraint_filter - autoware_trajectory_safety_filter_plugins + autoware_trajectory_validator_plugins ) ament_add_ros_isolated_gtest(test_constant_curvature @@ -80,31 +80,31 @@ if(BUILD_TESTING) # ========================================== # 2. Dummy Plugin (Test Utility) # ========================================== - pluginlib_export_plugin_description_file(autoware_trajectory_safety_filter + pluginlib_export_plugin_description_file(autoware_trajectory_validator test/dummy_plugin/dummy_plugins.xml ) - ament_auto_add_library(dummy_safety_filter_plugin SHARED - test/dummy_plugin/dummy_safety_filter_plugin.cpp + ament_auto_add_library(dummy_validator_plugin SHARED + test/dummy_plugin/dummy_validator_plugin.cpp ) - target_link_libraries(dummy_safety_filter_plugin + target_link_libraries(dummy_validator_plugin ${PROJECT_NAME} ) # ========================================== # 3. Node Integration/Unit Tests # ========================================== - ament_add_ros_isolated_gtest(test_trajectory_safety_filter_node - test/node/test_trajectory_safety_filter_node.cpp + ament_add_ros_isolated_gtest(test_trajectory_validator_node + test/node/test_trajectory_validator_node.cpp ) - target_link_libraries(test_trajectory_safety_filter_node + target_link_libraries(test_trajectory_validator_node ${PROJECT_NAME} - dummy_safety_filter_plugin + dummy_validator_plugin ) - ament_target_dependencies(test_trajectory_safety_filter_node + ament_target_dependencies(test_trajectory_validator_node autoware_test_utils ) endif() diff --git a/planning/autoware_trajectory_validator/config/trajectory_validator.param.yaml b/planning/autoware_trajectory_validator/config/trajectory_validator.param.yaml index 93f21ca3b651a..3aa30ee67a935 100644 --- a/planning/autoware_trajectory_validator/config/trajectory_validator.param.yaml +++ b/planning/autoware_trajectory_validator/config/trajectory_validator.param.yaml @@ -2,18 +2,18 @@ ros__parameters: filter_names: [ - "autoware::trajectory_safety_filter::plugin::OutOfLaneFilter", - "autoware::trajectory_safety_filter::plugin::CollisionFilter", - "autoware::trajectory_safety_filter::plugin::CollisionCheckFilter", - "autoware::trajectory_safety_filter::plugin::UncrossableBoundaryDepartureFilter", - "autoware::trajectory_safety_filter::plugin::VehicleConstraintFilter", + "autoware::trajectory_validator::plugin::OutOfLaneFilter", + "autoware::trajectory_validator::plugin::CollisionFilter", + "autoware::trajectory_validator::plugin::CollisionCheckFilter", + "autoware::trajectory_validator::plugin::UncrossableBoundaryDepartureFilter", + "autoware::trajectory_validator::plugin::VehicleConstraintFilter", ] # available filters: - # "autoware::trajectory_safety_filter::plugin::OutOfLaneFilter" - # "autoware::trajectory_safety_filter::plugin::CollisionFilter" - # "autoware::trajectory_safety_filter::plugin::CollisionCheckFilter" - # "autoware::trajectory_safety_filter::plugin::UncrossableBoundaryDepartureFilter" - # "autoware::trajectory_safety_filter::plugin::VehicleConstraintFilter" + # "autoware::trajectory_validator::plugin::OutOfLaneFilter" + # "autoware::trajectory_validator::plugin::CollisionFilter" + # "autoware::trajectory_validator::plugin::CollisionCheckFilter" + # "autoware::trajectory_validator::plugin::UncrossableBoundaryDepartureFilter" + # "autoware::trajectory_validator::plugin::VehicleConstraintFilter" out_of_lane: time: 2.0 diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp index 2cb3548ce32e8..265b1df8ea3a6 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp @@ -29,7 +29,7 @@ #include #include -namespace autoware::trajectory_safety_filter +namespace autoware::trajectory_validator { // Base context that all filters can access @@ -40,6 +40,6 @@ struct FilterContext std::shared_ptr lanelet_map; autoware_perception_msgs::msg::PredictedObjects::ConstSharedPtr predicted_objects; }; -} // namespace autoware::trajectory_safety_filter +} // namespace autoware::trajectory_validator #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTER_CONTEXT_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_check_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_check_filter.hpp index dbbbc7c904fb7..a9fc8b9db7005 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_check_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_check_filter.hpp @@ -15,7 +15,7 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_CHECK_FILTER_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_CHECK_FILTER_HPP_ -#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" +#include "autoware/trajectory_validator/validator_interface.hpp" #include #include @@ -33,7 +33,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { using autoware_utils_geometry::Box2d; using autoware_utils_geometry::MultiPoint2d; @@ -130,10 +130,10 @@ PoseTrajectory compute_pose_trajectory( return pose_trajectory; } -class CollisionCheckFilter : public SafetyFilterInterface +class CollisionCheckFilter : public ValidatorInterface { public: - CollisionCheckFilter() : SafetyFilterInterface("CollisionCheckFilter") {} + CollisionCheckFilter() : ValidatorInterface("CollisionCheckFilter") {} tl::expected is_feasible( const TrajectoryPoints & traj_points, const FilterContext & context) override; @@ -151,6 +151,6 @@ class CollisionCheckFilter : public SafetyFilterInterface } pet_collision_params_; }; -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_CHECK_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_filter.hpp index 23aa77db8defe..f4c9c8d4180c5 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_filter.hpp @@ -15,7 +15,7 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_FILTER_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_FILTER_HPP_ -#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" +#include "autoware/trajectory_validator/validator_interface.hpp" #include @@ -26,7 +26,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { // Parameters for CollisionFilter @@ -36,10 +36,10 @@ struct CollisionParams double min_ttc = 2.0; // seconds - minimum acceptable time to collision }; -class CollisionFilter : public SafetyFilterInterface +class CollisionFilter : public ValidatorInterface { public: - CollisionFilter() : SafetyFilterInterface("CollisionFilter") {} + CollisionFilter() : ValidatorInterface("CollisionFilter") {} tl::expected is_feasible( const TrajectoryPoints & traj_points, const FilterContext & context) final; @@ -71,6 +71,6 @@ class CollisionFilter : public SafetyFilterInterface double time_from_start) const; }; -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/out_of_lane_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/out_of_lane_filter.hpp index da0b2fb6b98a4..957570ee247ec 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/out_of_lane_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/out_of_lane_filter.hpp @@ -15,7 +15,7 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__OUT_OF_LANE_FILTER_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__OUT_OF_LANE_FILTER_HPP_ -#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" +#include "autoware/trajectory_validator/validator_interface.hpp" #include #include @@ -28,7 +28,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { // Parameters for OutOfLaneFilter @@ -38,7 +38,7 @@ struct OutOfLaneParams double min_value = 0.0; // meters - minimum distance to lane boundary }; -class OutOfLaneFilter : public SafetyFilterInterface +class OutOfLaneFilter : public ValidatorInterface { public: OutOfLaneFilter(); @@ -55,6 +55,6 @@ class OutOfLaneFilter : public SafetyFilterInterface std::unique_ptr boundary_departure_checker_; }; -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__OUT_OF_LANE_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp index 2fe8e46889cf2..2e76b8ddb8bfd 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp @@ -15,7 +15,7 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__UNCROSSABLE_BOUNDARY_DEPARTURE_FILTER_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__UNCROSSABLE_BOUNDARY_DEPARTURE_FILTER_HPP_ -#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" +#include "autoware/trajectory_validator/validator_interface.hpp" #include #include @@ -24,12 +24,12 @@ #include #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { -class UncrossableBoundaryDepartureFilter : public SafetyFilterInterface +class UncrossableBoundaryDepartureFilter : public ValidatorInterface { public: - UncrossableBoundaryDepartureFilter() : SafetyFilterInterface("UncrossableBoundaryDepartureFilter") + UncrossableBoundaryDepartureFilter() : ValidatorInterface("UncrossableBoundaryDepartureFilter") { } @@ -65,6 +65,6 @@ class UncrossableBoundaryDepartureFilter : public SafetyFilterInterface RCLCPP_WARN_THROTTLE(log_, *clock_, 5000, fmt, args...); } }; -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__UNCROSSABLE_BOUNDARY_DEPARTURE_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp index 457c8868355b2..d662e5fcdb3a5 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp @@ -15,19 +15,19 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__VEHICLE_CONSTRAINT_FILTER_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__VEHICLE_CONSTRAINT_FILTER_HPP_ -#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" +#include "autoware/trajectory_validator/validator_interface.hpp" #include #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { /** * @brief VehicleConstraintFilter class - checks if the trajectory respects vehicle constraints * (e.g., max speed, max acceleration/deceleration). */ -class VehicleConstraintFilter final : public SafetyFilterInterface +class VehicleConstraintFilter final : public ValidatorInterface { public: using result_t = tl::expected; @@ -122,5 +122,5 @@ bool is_steering_angle_ok( */ bool is_steering_rate_ok( const TrajectoryPoints & traj_points, const VehicleInfo & vehicle_info, double max_steering_rate); -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__VEHICLE_CONSTRAINT_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp index 420fb793d041e..416d212186acd 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp @@ -15,10 +15,10 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__TRAJECTORY_SAFETY_FILTER_NODE_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__TRAJECTORY_SAFETY_FILTER_NODE_HPP_ -#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" +#include "autoware/trajectory_validator/validator_interface.hpp" #include -#include +#include #include #include #include @@ -39,7 +39,7 @@ #include #include -namespace autoware::trajectory_safety_filter +namespace autoware::trajectory_validator { using autoware_internal_planning_msgs::msg::CandidateTrajectories; using autoware_internal_planning_msgs::msg::CandidateTrajectory; @@ -50,10 +50,10 @@ using autoware_utils_diagnostics::DiagnosticsInterface; using geometry_msgs::msg::AccelWithCovarianceStamped; using nav_msgs::msg::Odometry; -class TrajectorySafetyFilter : public rclcpp::Node +class TrajectoryValidator : public rclcpp::Node { public: - explicit TrajectorySafetyFilter(const rclcpp::NodeOptions & node_options); + explicit TrajectoryValidator(const rclcpp::NodeOptions & node_options); private: void process(const CandidateTrajectories::ConstSharedPtr msg); @@ -74,7 +74,7 @@ class TrajectorySafetyFilter : public rclcpp::Node rcl_interfaces::msg::SetParametersResult on_parameter( const std::vector & parameters); - std::unique_ptr listener_; + std::unique_ptr listener_; rclcpp::Publisher::SharedPtr debug_processing_time_detail_pub_; @@ -96,14 +96,14 @@ class TrajectorySafetyFilter : public rclcpp::Node rclcpp::node_interfaces::OnSetParametersCallbackHandle::SharedPtr set_param_res_; - pluginlib::ClassLoader plugin_loader_; + pluginlib::ClassLoader plugin_loader_; - std::vector> plugins_; + std::vector> plugins_; autoware::vehicle_info_utils::VehicleInfo vehicle_info_; - DiagnosticsInterface diagnostics_interface_{this, "trajectory_safety_filter"}; + DiagnosticsInterface diagnostics_interface_{this, "trajectory_validator"}; }; -} // namespace autoware::trajectory_safety_filter +} // namespace autoware::trajectory_validator #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__TRAJECTORY_SAFETY_FILTER_NODE_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp index d641062d6d94f..6dd99fe83e349 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp @@ -15,7 +15,7 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__SAFETY_FILTER_INTERFACE_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__SAFETY_FILTER_INTERFACE_HPP_ -#include "autoware/trajectory_safety_filter/filter_context.hpp" +#include "autoware/trajectory_validator/filter_context.hpp" #include #include @@ -29,22 +29,22 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { using autoware_planning_msgs::msg::TrajectoryPoint; using TrajectoryPoints = std::vector; using VehicleInfo = autoware::vehicle_info_utils::VehicleInfo; -class SafetyFilterInterface +class ValidatorInterface { public: - explicit SafetyFilterInterface(std::string name) : name_(std::move(name)) {} + explicit ValidatorInterface(std::string name) : name_(std::move(name)) {} - virtual ~SafetyFilterInterface() = default; - SafetyFilterInterface(const SafetyFilterInterface &) = delete; - SafetyFilterInterface & operator=(const SafetyFilterInterface &) = delete; - SafetyFilterInterface(SafetyFilterInterface &&) = delete; - SafetyFilterInterface & operator=(SafetyFilterInterface &&) = delete; + virtual ~ValidatorInterface() = default; + ValidatorInterface(const ValidatorInterface &) = delete; + ValidatorInterface & operator=(const ValidatorInterface &) = delete; + ValidatorInterface(ValidatorInterface &&) = delete; + ValidatorInterface & operator=(ValidatorInterface &&) = delete; // Main filter method with context for plugin-specific data virtual tl::expected is_feasible( @@ -68,7 +68,7 @@ class SafetyFilterInterface std::string name_; std::shared_ptr vehicle_info_ptr_; }; -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin // NOLINTNEXTLINE #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__SAFETY_FILTER_INTERFACE_HPP_ diff --git a/planning/autoware_trajectory_validator/launch/trajectory_validator.launch.xml b/planning/autoware_trajectory_validator/launch/trajectory_validator.launch.xml index 88ac22e05a5af..eade3d9b9ebe2 100644 --- a/planning/autoware_trajectory_validator/launch/trajectory_validator.launch.xml +++ b/planning/autoware_trajectory_validator/launch/trajectory_validator.launch.xml @@ -1,6 +1,6 @@ - + @@ -8,8 +8,8 @@ - - + + diff --git a/planning/autoware_trajectory_validator/package.xml b/planning/autoware_trajectory_validator/package.xml index e2cf4d9022bbd..81caf758cd213 100644 --- a/planning/autoware_trajectory_validator/package.xml +++ b/planning/autoware_trajectory_validator/package.xml @@ -1,9 +1,9 @@ - autoware_trajectory_safety_filter + autoware_trajectory_validator 0.1.0 - The autoware_trajectory_safety_filter package + The autoware_trajectory_validator package Daniel Sanchez Yukihiro Saito diff --git a/planning/autoware_trajectory_validator/param/parameter_struct.yaml b/planning/autoware_trajectory_validator/param/parameter_struct.yaml index 1e9a4446a9017..0751ee163a555 100644 --- a/planning/autoware_trajectory_validator/param/parameter_struct.yaml +++ b/planning/autoware_trajectory_validator/param/parameter_struct.yaml @@ -1,4 +1,4 @@ -safety_filter: +validator: filter_names: type: string_array default_value: [] diff --git a/planning/autoware_trajectory_validator/plugins.xml b/planning/autoware_trajectory_validator/plugins.xml index a9197d4e71735..5e4d6492012ce 100644 --- a/planning/autoware_trajectory_validator/plugins.xml +++ b/planning/autoware_trajectory_validator/plugins.xml @@ -1,31 +1,31 @@ - - + + Filters trajectories that go out of lane boundaries - + Filters trajectories based on Time To Collision (TTC) with predicted objects - + Filters trajectories that cross uncrossable boundaries - + Filters trajectories that violate vehicle constraints such as maximum speed, acceleration, and steering angle - + Filters trajectories based on collision checks with predicted objects diff --git a/planning/autoware_trajectory_validator/src/filters/collision_check_filter.cpp b/planning/autoware_trajectory_validator/src/filters/collision_check_filter.cpp index f79a4474854b9..8d0e06494f75b 100644 --- a/planning/autoware_trajectory_validator/src/filters/collision_check_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/collision_check_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/filters/collision_check_filter.hpp" +#include "autoware/trajectory_validator/filters/collision_check_filter.hpp" #include #include @@ -31,7 +31,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { namespace motion @@ -420,9 +420,9 @@ tl::expected CollisionCheckFilter::is_feasible( return {}; } -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #include PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_safety_filter::plugin::CollisionCheckFilter, - autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) + autoware::trajectory_validator::plugin::CollisionCheckFilter, + autoware::trajectory_validator::plugin::ValidatorInterface) diff --git a/planning/autoware_trajectory_validator/src/filters/collision_filter.cpp b/planning/autoware_trajectory_validator/src/filters/collision_filter.cpp index de8dda6503123..c3c3780e9be2a 100644 --- a/planning/autoware_trajectory_validator/src/filters/collision_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/collision_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/filters/collision_filter.hpp" +#include "autoware/trajectory_validator/filters/collision_filter.hpp" #include @@ -27,7 +27,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { namespace @@ -283,9 +283,9 @@ void CollisionFilter::update_parameters(const std::vector & p update_param(parameters, "collision.time", params_.max_check_time); update_param(parameters, "collision.min_value", params_.min_ttc); } -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #include PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_safety_filter::plugin::CollisionFilter, - autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) + autoware::trajectory_validator::plugin::CollisionFilter, + autoware::trajectory_validator::plugin::ValidatorInterface) diff --git a/planning/autoware_trajectory_validator/src/filters/out_of_lane_filter.cpp b/planning/autoware_trajectory_validator/src/filters/out_of_lane_filter.cpp index 98b7c1136ed3c..ddb915720bb0f 100644 --- a/planning/autoware_trajectory_validator/src/filters/out_of_lane_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/out_of_lane_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/filters/out_of_lane_filter.hpp" +#include "autoware/trajectory_validator/filters/out_of_lane_filter.hpp" #include @@ -24,7 +24,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { namespace @@ -60,7 +60,7 @@ autoware_internal_planning_msgs::msg::PathWithLaneId convert_to_path_with_lane_i } } // namespace -OutOfLaneFilter::OutOfLaneFilter() : SafetyFilterInterface("OutOfLaneFilter") +OutOfLaneFilter::OutOfLaneFilter() : ValidatorInterface("OutOfLaneFilter") { // BoundaryDepartureChecker will be initialized when vehicle_info is set } @@ -109,9 +109,9 @@ tl::expected OutOfLaneFilter::is_feasible( return {}; } -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #include PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_safety_filter::plugin::OutOfLaneFilter, - autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) + autoware::trajectory_validator::plugin::OutOfLaneFilter, + autoware::trajectory_validator::plugin::ValidatorInterface) diff --git a/planning/autoware_trajectory_validator/src/filters/uncrossable_boundary_departure_filter.cpp b/planning/autoware_trajectory_validator/src/filters/uncrossable_boundary_departure_filter.cpp index 387219c5aefa0..694085ddfbfca 100644 --- a/planning/autoware_trajectory_validator/src/filters/uncrossable_boundary_departure_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/uncrossable_boundary_departure_filter.cpp @@ -12,12 +12,12 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/filters/uncrossable_boundary_departure_filter.hpp" +#include "autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp" #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { tl::expected UncrossableBoundaryDepartureFilter::is_feasible( const TrajectoryPoints & traj_points, const FilterContext & context) @@ -64,9 +64,9 @@ std::optional UncrossableBoundaryDepartureFilter::is_invalid_input( return std::nullopt; } -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #include PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_safety_filter::plugin::UncrossableBoundaryDepartureFilter, - autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) + autoware::trajectory_validator::plugin::UncrossableBoundaryDepartureFilter, + autoware::trajectory_validator::plugin::ValidatorInterface) diff --git a/planning/autoware_trajectory_validator/src/filters/vehicle_constraint_filter.cpp b/planning/autoware_trajectory_validator/src/filters/vehicle_constraint_filter.cpp index 80686c5df6416..e42976ddeac0a 100644 --- a/planning/autoware_trajectory_validator/src/filters/vehicle_constraint_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/vehicle_constraint_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/filters/vehicle_constraint_filter.hpp" +#include "autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp" #include #include @@ -20,7 +20,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { namespace { @@ -90,7 +90,7 @@ double to_steering_rate( } // namespace VehicleConstraintFilter::VehicleConstraintFilter() -: SafetyFilterInterface("VehicleConstraintFilter") +: ValidatorInterface("VehicleConstraintFilter") { } @@ -260,9 +260,9 @@ bool is_steering_rate_ok( } return true; } -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #include PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_safety_filter::plugin::VehicleConstraintFilter, - autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) + autoware::trajectory_validator::plugin::VehicleConstraintFilter, + autoware::trajectory_validator::plugin::ValidatorInterface) diff --git a/planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp b/planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp index a4e334a8ad93c..b59c2daabc312 100644 --- a/planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp +++ b/planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp @@ -12,10 +12,10 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/trajectory_safety_filter_node.hpp" +#include "autoware/trajectory_validator/trajectory_validator_node.hpp" -#include "autoware/trajectory_safety_filter/filter_context.hpp" -#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" +#include "autoware/trajectory_validator/filter_context.hpp" +#include "autoware/trajectory_validator/validator_interface.hpp" #include @@ -61,15 +61,15 @@ bool has_trajectory_from_generator( } } // namespace -namespace autoware::trajectory_safety_filter +namespace autoware::trajectory_validator { -TrajectorySafetyFilter::TrajectorySafetyFilter(const rclcpp::NodeOptions & options) -: Node{"trajectory_safety_filter_node", options}, - listener_{std::make_unique(get_node_parameters_interface())}, +TrajectoryValidator::TrajectoryValidator(const rclcpp::NodeOptions & options) +: Node{"trajectory_validator_node", options}, + listener_{std::make_unique(get_node_parameters_interface())}, plugin_loader_( - "autoware_trajectory_safety_filter", - "autoware::trajectory_safety_filter::plugin::SafetyFilterInterface"), + "autoware_trajectory_validator", + "autoware::trajectory_validator::plugin::ValidatorInterface"), vehicle_info_(autoware::vehicle_info_utils::VehicleInfoUtils(*this).getVehicleInfo()) { const auto filters = listener_->get_params().filter_names; @@ -79,11 +79,11 @@ TrajectorySafetyFilter::TrajectorySafetyFilter(const rclcpp::NodeOptions & optio sub_map_ = create_subscription( "~/input/lanelet2_map", rclcpp::QoS{1}.transient_local(), - std::bind(&TrajectorySafetyFilter::map_callback, this, std::placeholders::_1)); + std::bind(&TrajectoryValidator::map_callback, this, std::placeholders::_1)); sub_trajectories_ = create_subscription( "~/input/trajectories", 1, - std::bind(&TrajectorySafetyFilter::process, this, std::placeholders::_1)); + std::bind(&TrajectoryValidator::process, this, std::placeholders::_1)); pub_trajectories_ = create_publisher("~/output/trajectories", 1); @@ -93,10 +93,10 @@ TrajectorySafetyFilter::TrajectorySafetyFilter(const rclcpp::NodeOptions & optio std::make_shared(debug_processing_time_detail_pub_); set_param_res_ = this->add_on_set_parameters_callback( - std::bind(&TrajectorySafetyFilter::on_parameter, this, std::placeholders::_1)); + std::bind(&TrajectoryValidator::on_parameter, this, std::placeholders::_1)); } -void TrajectorySafetyFilter::process(const CandidateTrajectories::ConstSharedPtr msg) +void TrajectoryValidator::process(const CandidateTrajectories::ConstSharedPtr msg) { autoware_utils_debug::ScopedTimeTrack st(__func__, *time_keeper_); @@ -161,7 +161,7 @@ void TrajectorySafetyFilter::process(const CandidateTrajectories::ConstSharedPtr pub_trajectories_->publish(*filtered_msg); } -void TrajectorySafetyFilter::map_callback(const LaneletMapBin::ConstSharedPtr msg) +void TrajectoryValidator::map_callback(const LaneletMapBin::ConstSharedPtr msg) { autoware_utils_debug::ScopedTimeTrack st(__func__, *time_keeper_); @@ -169,7 +169,7 @@ void TrajectorySafetyFilter::map_callback(const LaneletMapBin::ConstSharedPtr ms lanelet::utils::conversion::fromBinMsg(*msg, lanelet_map_ptr_); } -void TrajectorySafetyFilter::load_metric(const std::string & name) +void TrajectoryValidator::load_metric(const std::string & name) { if (name == "") return; @@ -193,18 +193,18 @@ void TrajectorySafetyFilter::load_metric(const std::string & name) } catch (const pluginlib::CreateClassException & e) { RCLCPP_ERROR_STREAM( get_logger(), - "[safety_filter] createSharedInstance failed for '" << name << "': " << e.what()); + "[validator] createSharedInstance failed for '" << name << "': " << e.what()); } catch (const std::exception & e) { RCLCPP_ERROR_STREAM( - get_logger(), "[safety_filter] unexpected exception for '" << name << "': " << e.what()); + get_logger(), "[validator] unexpected exception for '" << name << "': " << e.what()); } } -void TrajectorySafetyFilter::unload_metric(const std::string & name) +void TrajectoryValidator::unload_metric(const std::string & name) { auto it = std::remove_if( plugins_.begin(), plugins_.end(), - [&](const std::shared_ptr & plugin) { + [&](const std::shared_ptr & plugin) { return plugin->get_name() == name; }); @@ -242,7 +242,7 @@ void TrajectoryValidator::update_diagnostic( diagnostics_interface_.publish(this->get_clock()->now()); } -rcl_interfaces::msg::SetParametersResult TrajectorySafetyFilter::on_parameter( +rcl_interfaces::msg::SetParametersResult TrajectoryValidator::on_parameter( const std::vector & parameters) { rcl_interfaces::msg::SetParametersResult result; @@ -262,7 +262,7 @@ rcl_interfaces::msg::SetParametersResult TrajectorySafetyFilter::on_parameter( return result; } -} // namespace autoware::trajectory_safety_filter +} // namespace autoware::trajectory_validator #include -RCLCPP_COMPONENTS_REGISTER_NODE(autoware::trajectory_safety_filter::TrajectorySafetyFilter) +RCLCPP_COMPONENTS_REGISTER_NODE(autoware::trajectory_validator::TrajectoryValidator) diff --git a/planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp index d4066c8d08e03..e96447032c30b 100644 --- a/planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp +++ b/planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp @@ -20,7 +20,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { class CollisionCheckFilterTest : public ::testing::Test @@ -227,4 +227,4 @@ TEST_F(CollisionCheckFilterTest, ObjectWillEnterPath) << "Error string did not contain 'constant_curvature_path'. Actual: " << error_msg; } -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin diff --git a/planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp index f0f8a304110f5..55255c0562538 100644 --- a/planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp +++ b/planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -// #include "autoware/trajectory_safety_filter/filters/collision_check_filter.cpp" +// #include "autoware/trajectory_validator/filters/collision_check_filter.cpp" #include "../..//src/filters/collision_check_filter.cpp" #include @@ -23,7 +23,7 @@ #include -namespace autoware::trajectory_safety_filter::plugin::constant_curvature_predictor +namespace autoware::trajectory_validator::plugin::constant_curvature_predictor { TEST(ConstantCurvaturePoseTrajectoryCalculatorTest, PoseToIsometry) @@ -216,4 +216,4 @@ TEST(ConstantCurvaturePoseTrajectoryCalculatorTest, ComputeTrajectory) } } -} // namespace autoware::trajectory_safety_filter::plugin::constant_curvature_predictor +} // namespace autoware::trajectory_validator::plugin::constant_curvature_predictor diff --git a/planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp index d56ace55c074c..5ba98e0502741 100644 --- a/planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp +++ b/planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -// #include "autoware/trajectory_safety_filter/filters/collision_check_filter.hpp" +// #include "autoware/trajectory_validator/filters/collision_check_filter.hpp" #include "../../src/filters/collision_check_filter.cpp" #include @@ -20,7 +20,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin::motion +namespace autoware::trajectory_validator::plugin::motion { class ComputeMotionProfile1dTest : public ::testing::Test { @@ -127,4 +127,4 @@ TEST_F(ComputeMotionProfile1dTest, LagLongerThanMaxTime) } } -} // namespace autoware::trajectory_safety_filter::plugin::motion +} // namespace autoware::trajectory_validator::plugin::motion diff --git a/planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp index c239f7e1b89f1..d88bb3deb4ed4 100644 --- a/planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp +++ b/planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -// #include "autoware/trajectory_safety_filter/filters/collision_check_filter.hpp" +// #include "autoware/trajectory_validator/filters/collision_check_filter.hpp" #include "../../src/filters/collision_check_filter.cpp" #include @@ -20,7 +20,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin::polygon +namespace autoware::trajectory_validator::plugin::polygon { class PolygonCollisionTest : public ::testing::Test @@ -95,4 +95,4 @@ TEST_F(PolygonCollisionTest, CheckPathPolygonConvexCollision) EXPECT_TRUE(check_path_polygon_convex_collision(traj1_collide, traj2_collide)); } -} // namespace autoware::trajectory_safety_filter::plugin::polygon +} // namespace autoware::trajectory_validator::plugin::polygon diff --git a/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_plugins.xml b/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_plugins.xml index 433397d5eed61..15f5b710dd034 100644 --- a/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_plugins.xml +++ b/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_plugins.xml @@ -1,7 +1,7 @@ - - + + A predictable dummy filter for testing the main node diff --git a/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_validator_plugin.cpp b/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_validator_plugin.cpp index 11f4284c4824a..f5da10a814e9c 100644 --- a/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_validator_plugin.cpp +++ b/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_validator_plugin.cpp @@ -12,16 +12,16 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" +#include "autoware/trajectory_validator/validator_interface.hpp" #include #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { -class DummyFilter : public SafetyFilterInterface +class DummyFilter : public ValidatorInterface { struct DummyFilterParam { @@ -29,7 +29,7 @@ class DummyFilter : public SafetyFilterInterface }; public: - DummyFilter() : SafetyFilterInterface("DummyFilter") {} + DummyFilter() : ValidatorInterface("DummyFilter") {} tl::expected is_feasible( const TrajectoryPoints & traj_points, const FilterContext & /*context*/) final @@ -62,8 +62,8 @@ class DummyFilter : public SafetyFilterInterface private: DummyFilterParam params_; }; -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_safety_filter::plugin::DummyFilter, - autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) + autoware::trajectory_validator::plugin::DummyFilter, + autoware::trajectory_validator::plugin::ValidatorInterface) diff --git a/planning/autoware_trajectory_validator/test/node/test_trajectory_validator_node.cpp b/planning/autoware_trajectory_validator/test/node/test_trajectory_validator_node.cpp index d16afb1fcd40e..3d5dd66dda4af 100644 --- a/planning/autoware_trajectory_validator/test/node/test_trajectory_validator_node.cpp +++ b/planning/autoware_trajectory_validator/test/node/test_trajectory_validator_node.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/trajectory_safety_filter_node.hpp" +#include "autoware/trajectory_validator/trajectory_validator_node.hpp" #include #include @@ -23,10 +23,10 @@ #include #include -namespace autoware::trajectory_safety_filter +namespace autoware::trajectory_validator { -class TrajectorySafetyFilterNodeTest : public ::testing::Test +class TrajectoryValidatorNodeTest : public ::testing::Test { protected: void SetUp() override @@ -34,7 +34,7 @@ class TrajectorySafetyFilterNodeTest : public ::testing::Test rclcpp::init(0, nullptr); node_options_.append_parameter_override( "filter_names", - std::vector{"autoware::trajectory_safety_filter::plugin::DummyFilter"}); + std::vector{"autoware::trajectory_validator::plugin::DummyFilter"}); node_options_.append_parameter_override("dummy.dummy_param", 0.0); const auto test_pkg_share = ament_index_cpp::get_package_share_directory("autoware_test_utils"); @@ -43,25 +43,25 @@ class TrajectorySafetyFilterNodeTest : public ::testing::Test autoware::test_utils::updateNodeOptions(node_options_, {vehicle_info_param_path}); - node_under_test_ = std::make_shared(node_options_); + node_under_test_ = std::make_shared(node_options_); test_node_ = std::make_shared("test_helper_node"); map_pub_ = test_node_->create_publisher( - "/trajectory_safety_filter_node/input/lanelet2_map", rclcpp::QoS{1}.transient_local()); + "/trajectory_validator_node/input/lanelet2_map", rclcpp::QoS{1}.transient_local()); odom_pub_ = test_node_->create_publisher( - "/trajectory_safety_filter_node/input/odometry", 1); + "/trajectory_validator_node/input/odometry", 1); accel_pub_ = test_node_->create_publisher( - "/trajectory_safety_filter_node/input/acceleration", 1); + "/trajectory_validator_node/input/acceleration", 1); obj_pub_ = test_node_->create_publisher( - "/trajectory_safety_filter_node/input/objects", 1); + "/trajectory_validator_node/input/objects", 1); traj_pub_ = test_node_->create_publisher( - "/trajectory_safety_filter_node/input/trajectories", 1); + "/trajectory_validator_node/input/trajectories", 1); output_sub_ = test_node_->create_subscription( - "/trajectory_safety_filter_node/output/trajectories", 1, + "/trajectory_validator_node/output/trajectories", 1, [this]( const autoware_internal_planning_msgs::msg::CandidateTrajectories::ConstSharedPtr msg) { last_output_ = msg; @@ -126,7 +126,7 @@ class TrajectorySafetyFilterNodeTest : public ::testing::Test rclcpp::NodeOptions node_options_; rclcpp::Node::SharedPtr test_node_; - std::shared_ptr node_under_test_; + std::shared_ptr node_under_test_; rclcpp::Publisher::SharedPtr map_pub_; rclcpp::Publisher::SharedPtr odom_pub_; @@ -140,7 +140,7 @@ class TrajectorySafetyFilterNodeTest : public ::testing::Test autoware_internal_planning_msgs::msg::CandidateTrajectories::ConstSharedPtr last_output_; }; -TEST_F(TrajectorySafetyFilterNodeTest, FiltersTrajectoriesViaPlugin) +TEST_F(TrajectoryValidatorNodeTest, FiltersTrajectoriesViaPlugin) { publish_context(); spin_until([] { return false; }, std::chrono::milliseconds(100)); @@ -160,7 +160,7 @@ TEST_F(TrajectorySafetyFilterNodeTest, FiltersTrajectoriesViaPlugin) EXPECT_EQ(last_output_->generator_info.front().generator_name.data, "SafePlanner"); } -TEST_F(TrajectorySafetyFilterNodeTest, UpdateParametersDynamically) +TEST_F(TrajectoryValidatorNodeTest, UpdateParametersDynamically) { publish_context(); spin_until([] { return false; }, std::chrono::milliseconds(100)); @@ -183,7 +183,7 @@ TEST_F(TrajectorySafetyFilterNodeTest, UpdateParametersDynamically) EXPECT_EQ(last_output_->candidate_trajectories.size(), 1u); } -TEST_F(TrajectorySafetyFilterNodeTest, HandlesPluginRejection) +TEST_F(TrajectoryValidatorNodeTest, HandlesPluginRejection) { publish_context(); spin_until([] { return false; }, std::chrono::milliseconds(100)); @@ -196,4 +196,4 @@ TEST_F(TrajectorySafetyFilterNodeTest, HandlesPluginRejection) ASSERT_TRUE(spin_until([this] { return last_output_ != nullptr; })); EXPECT_EQ(last_output_->candidate_trajectories.size(), 0u); } -} // namespace autoware::trajectory_safety_filter +} // namespace autoware::trajectory_validator diff --git a/planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp b/planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp index cd5526cf8f5c9..8e813bf01795b 100644 --- a/planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp +++ b/planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/filters/vehicle_constraint_filter.hpp" +#include "autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp" #include @@ -36,7 +36,7 @@ autoware_planning_msgs::msg::TrajectoryPoint create_trajectory_point( } } // namespace -namespace autoware::trajectory_safety_filter::plugin::testing +namespace autoware::trajectory_validator::plugin::testing { TEST(VehicleConstraintFilterTest, FeasibleWhenAllConstraintsSatisfied) { @@ -308,4 +308,4 @@ TEST(IsSteeringRateOkTest, FalseWhenAnySteeringRateAboveMax) EXPECT_FALSE(is_steering_rate_ok(traj_points, vehicle_info, max_steering_rate)); } -} // namespace autoware::trajectory_safety_filter::plugin::testing +} // namespace autoware::trajectory_validator::plugin::testing From d5fdf4d581fe5f0d6336a1145c5db0d04dd82372 Mon Sep 17 00:00:00 2001 From: Zulfaqar Azmi Date: Mon, 9 Mar 2026 12:05:28 +0900 Subject: [PATCH 06/10] Revert "fix: rename in trajectory safety filter" This reverts commit d5e7ca7b43ddace2e7cf15464e267fd224bc8350. --- .../CMakeLists.txt | 32 +++++++------- .../config/trajectory_validator.param.yaml | 20 ++++----- .../trajectory_validator/filter_context.hpp | 4 +- .../filters/collision_check_filter.hpp | 10 ++--- .../filters/collision_filter.hpp | 10 ++--- .../filters/out_of_lane_filter.hpp | 8 ++-- .../uncrossable_boundary_departure_filter.hpp | 10 ++--- .../filters/vehicle_constraint_filter.hpp | 8 ++-- .../trajectory_validator_node.hpp | 20 ++++----- .../validator_interface.hpp | 20 ++++----- .../launch/trajectory_validator.launch.xml | 6 +-- .../autoware_trajectory_validator/package.xml | 4 +- .../param/parameter_struct.yaml | 2 +- .../autoware_trajectory_validator/plugins.xml | 22 +++++----- .../src/filters/collision_check_filter.cpp | 10 ++--- .../src/filters/collision_filter.cpp | 10 ++--- .../src/filters/out_of_lane_filter.cpp | 12 ++--- .../uncrossable_boundary_departure_filter.cpp | 10 ++--- .../src/filters/vehicle_constraint_filter.cpp | 12 ++--- .../src/trajectory_validator_node.cpp | 44 +++++++++---------- .../collision_check_filter/test_collision.cpp | 4 +- .../test_constant_curvature_predictor.cpp | 6 +-- .../collision_check_filter/test_motion.cpp | 6 +-- .../collision_check_filter/test_polygon.cpp | 6 +-- .../test/dummy_plugin/dummy_plugins.xml | 6 +-- .../dummy_plugin/dummy_validator_plugin.cpp | 14 +++--- .../node/test_trajectory_validator_node.cpp | 32 +++++++------- .../test_vehicle_constraint_filter.cpp | 6 +-- 28 files changed, 177 insertions(+), 177 deletions(-) diff --git a/planning/autoware_trajectory_validator/CMakeLists.txt b/planning/autoware_trajectory_validator/CMakeLists.txt index 19cde55922c45..640b41cca92a9 100644 --- a/planning/autoware_trajectory_validator/CMakeLists.txt +++ b/planning/autoware_trajectory_validator/CMakeLists.txt @@ -1,9 +1,9 @@ cmake_minimum_required(VERSION 3.14) -project(autoware_trajectory_validator) +project(autoware_trajectory_safety_filter) find_package(autoware_cmake REQUIRED) autoware_package() -pluginlib_export_plugin_description_file(autoware_trajectory_validator plugins.xml) +pluginlib_export_plugin_description_file(autoware_trajectory_safety_filter plugins.xml) generate_parameter_library(${PROJECT_NAME}_param param/parameter_struct.yaml @@ -14,7 +14,7 @@ include_directories( ) ament_auto_add_library(${PROJECT_NAME} SHARED - src/trajectory_validator_node.cpp + src/trajectory_safety_filter_node.cpp ) target_link_libraries(${PROJECT_NAME} @@ -26,11 +26,11 @@ target_compile_options(${PROJECT_NAME} PUBLIC ) rclcpp_components_register_node(${PROJECT_NAME} - PLUGIN "autoware::trajectory_validator::TrajectoryValidator" + PLUGIN "autoware::trajectory_safety_filter::TrajectorySafetyFilter" EXECUTABLE ${PROJECT_NAME}_node ) -ament_auto_add_library(autoware_trajectory_validator_plugins SHARED +ament_auto_add_library(autoware_trajectory_safety_filter_plugins SHARED src/filters/out_of_lane_filter.cpp src/filters/collision_filter.cpp src/filters/uncrossable_boundary_departure_filter.cpp @@ -38,7 +38,7 @@ ament_auto_add_library(autoware_trajectory_validator_plugins SHARED src/filters/collision_check_filter.cpp ) -target_link_libraries(autoware_trajectory_validator_plugins +target_link_libraries(autoware_trajectory_safety_filter_plugins ${PROJECT_NAME} ) @@ -54,7 +54,7 @@ if(BUILD_TESTING) test/plugins/test_vehicle_constraint_filter.cpp ) target_link_libraries(test_vehicle_constraint_filter - autoware_trajectory_validator_plugins + autoware_trajectory_safety_filter_plugins ) ament_add_ros_isolated_gtest(test_constant_curvature @@ -80,31 +80,31 @@ if(BUILD_TESTING) # ========================================== # 2. Dummy Plugin (Test Utility) # ========================================== - pluginlib_export_plugin_description_file(autoware_trajectory_validator + pluginlib_export_plugin_description_file(autoware_trajectory_safety_filter test/dummy_plugin/dummy_plugins.xml ) - ament_auto_add_library(dummy_validator_plugin SHARED - test/dummy_plugin/dummy_validator_plugin.cpp + ament_auto_add_library(dummy_safety_filter_plugin SHARED + test/dummy_plugin/dummy_safety_filter_plugin.cpp ) - target_link_libraries(dummy_validator_plugin + target_link_libraries(dummy_safety_filter_plugin ${PROJECT_NAME} ) # ========================================== # 3. Node Integration/Unit Tests # ========================================== - ament_add_ros_isolated_gtest(test_trajectory_validator_node - test/node/test_trajectory_validator_node.cpp + ament_add_ros_isolated_gtest(test_trajectory_safety_filter_node + test/node/test_trajectory_safety_filter_node.cpp ) - target_link_libraries(test_trajectory_validator_node + target_link_libraries(test_trajectory_safety_filter_node ${PROJECT_NAME} - dummy_validator_plugin + dummy_safety_filter_plugin ) - ament_target_dependencies(test_trajectory_validator_node + ament_target_dependencies(test_trajectory_safety_filter_node autoware_test_utils ) endif() diff --git a/planning/autoware_trajectory_validator/config/trajectory_validator.param.yaml b/planning/autoware_trajectory_validator/config/trajectory_validator.param.yaml index 3aa30ee67a935..93f21ca3b651a 100644 --- a/planning/autoware_trajectory_validator/config/trajectory_validator.param.yaml +++ b/planning/autoware_trajectory_validator/config/trajectory_validator.param.yaml @@ -2,18 +2,18 @@ ros__parameters: filter_names: [ - "autoware::trajectory_validator::plugin::OutOfLaneFilter", - "autoware::trajectory_validator::plugin::CollisionFilter", - "autoware::trajectory_validator::plugin::CollisionCheckFilter", - "autoware::trajectory_validator::plugin::UncrossableBoundaryDepartureFilter", - "autoware::trajectory_validator::plugin::VehicleConstraintFilter", + "autoware::trajectory_safety_filter::plugin::OutOfLaneFilter", + "autoware::trajectory_safety_filter::plugin::CollisionFilter", + "autoware::trajectory_safety_filter::plugin::CollisionCheckFilter", + "autoware::trajectory_safety_filter::plugin::UncrossableBoundaryDepartureFilter", + "autoware::trajectory_safety_filter::plugin::VehicleConstraintFilter", ] # available filters: - # "autoware::trajectory_validator::plugin::OutOfLaneFilter" - # "autoware::trajectory_validator::plugin::CollisionFilter" - # "autoware::trajectory_validator::plugin::CollisionCheckFilter" - # "autoware::trajectory_validator::plugin::UncrossableBoundaryDepartureFilter" - # "autoware::trajectory_validator::plugin::VehicleConstraintFilter" + # "autoware::trajectory_safety_filter::plugin::OutOfLaneFilter" + # "autoware::trajectory_safety_filter::plugin::CollisionFilter" + # "autoware::trajectory_safety_filter::plugin::CollisionCheckFilter" + # "autoware::trajectory_safety_filter::plugin::UncrossableBoundaryDepartureFilter" + # "autoware::trajectory_safety_filter::plugin::VehicleConstraintFilter" out_of_lane: time: 2.0 diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp index 265b1df8ea3a6..2cb3548ce32e8 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp @@ -29,7 +29,7 @@ #include #include -namespace autoware::trajectory_validator +namespace autoware::trajectory_safety_filter { // Base context that all filters can access @@ -40,6 +40,6 @@ struct FilterContext std::shared_ptr lanelet_map; autoware_perception_msgs::msg::PredictedObjects::ConstSharedPtr predicted_objects; }; -} // namespace autoware::trajectory_validator +} // namespace autoware::trajectory_safety_filter #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTER_CONTEXT_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_check_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_check_filter.hpp index a9fc8b9db7005..dbbbc7c904fb7 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_check_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_check_filter.hpp @@ -15,7 +15,7 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_CHECK_FILTER_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_CHECK_FILTER_HPP_ -#include "autoware/trajectory_validator/validator_interface.hpp" +#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" #include #include @@ -33,7 +33,7 @@ #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { using autoware_utils_geometry::Box2d; using autoware_utils_geometry::MultiPoint2d; @@ -130,10 +130,10 @@ PoseTrajectory compute_pose_trajectory( return pose_trajectory; } -class CollisionCheckFilter : public ValidatorInterface +class CollisionCheckFilter : public SafetyFilterInterface { public: - CollisionCheckFilter() : ValidatorInterface("CollisionCheckFilter") {} + CollisionCheckFilter() : SafetyFilterInterface("CollisionCheckFilter") {} tl::expected is_feasible( const TrajectoryPoints & traj_points, const FilterContext & context) override; @@ -151,6 +151,6 @@ class CollisionCheckFilter : public ValidatorInterface } pet_collision_params_; }; -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_CHECK_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_filter.hpp index f4c9c8d4180c5..23aa77db8defe 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_filter.hpp @@ -15,7 +15,7 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_FILTER_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_FILTER_HPP_ -#include "autoware/trajectory_validator/validator_interface.hpp" +#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" #include @@ -26,7 +26,7 @@ #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { // Parameters for CollisionFilter @@ -36,10 +36,10 @@ struct CollisionParams double min_ttc = 2.0; // seconds - minimum acceptable time to collision }; -class CollisionFilter : public ValidatorInterface +class CollisionFilter : public SafetyFilterInterface { public: - CollisionFilter() : ValidatorInterface("CollisionFilter") {} + CollisionFilter() : SafetyFilterInterface("CollisionFilter") {} tl::expected is_feasible( const TrajectoryPoints & traj_points, const FilterContext & context) final; @@ -71,6 +71,6 @@ class CollisionFilter : public ValidatorInterface double time_from_start) const; }; -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/out_of_lane_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/out_of_lane_filter.hpp index 957570ee247ec..da0b2fb6b98a4 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/out_of_lane_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/out_of_lane_filter.hpp @@ -15,7 +15,7 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__OUT_OF_LANE_FILTER_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__OUT_OF_LANE_FILTER_HPP_ -#include "autoware/trajectory_validator/validator_interface.hpp" +#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" #include #include @@ -28,7 +28,7 @@ #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { // Parameters for OutOfLaneFilter @@ -38,7 +38,7 @@ struct OutOfLaneParams double min_value = 0.0; // meters - minimum distance to lane boundary }; -class OutOfLaneFilter : public ValidatorInterface +class OutOfLaneFilter : public SafetyFilterInterface { public: OutOfLaneFilter(); @@ -55,6 +55,6 @@ class OutOfLaneFilter : public ValidatorInterface std::unique_ptr boundary_departure_checker_; }; -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__OUT_OF_LANE_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp index 2e76b8ddb8bfd..2fe8e46889cf2 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp @@ -15,7 +15,7 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__UNCROSSABLE_BOUNDARY_DEPARTURE_FILTER_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__UNCROSSABLE_BOUNDARY_DEPARTURE_FILTER_HPP_ -#include "autoware/trajectory_validator/validator_interface.hpp" +#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" #include #include @@ -24,12 +24,12 @@ #include #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { -class UncrossableBoundaryDepartureFilter : public ValidatorInterface +class UncrossableBoundaryDepartureFilter : public SafetyFilterInterface { public: - UncrossableBoundaryDepartureFilter() : ValidatorInterface("UncrossableBoundaryDepartureFilter") + UncrossableBoundaryDepartureFilter() : SafetyFilterInterface("UncrossableBoundaryDepartureFilter") { } @@ -65,6 +65,6 @@ class UncrossableBoundaryDepartureFilter : public ValidatorInterface RCLCPP_WARN_THROTTLE(log_, *clock_, 5000, fmt, args...); } }; -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__UNCROSSABLE_BOUNDARY_DEPARTURE_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp index d662e5fcdb3a5..457c8868355b2 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp @@ -15,19 +15,19 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__VEHICLE_CONSTRAINT_FILTER_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__VEHICLE_CONSTRAINT_FILTER_HPP_ -#include "autoware/trajectory_validator/validator_interface.hpp" +#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" #include #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { /** * @brief VehicleConstraintFilter class - checks if the trajectory respects vehicle constraints * (e.g., max speed, max acceleration/deceleration). */ -class VehicleConstraintFilter final : public ValidatorInterface +class VehicleConstraintFilter final : public SafetyFilterInterface { public: using result_t = tl::expected; @@ -122,5 +122,5 @@ bool is_steering_angle_ok( */ bool is_steering_rate_ok( const TrajectoryPoints & traj_points, const VehicleInfo & vehicle_info, double max_steering_rate); -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__VEHICLE_CONSTRAINT_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp index 416d212186acd..420fb793d041e 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp @@ -15,10 +15,10 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__TRAJECTORY_SAFETY_FILTER_NODE_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__TRAJECTORY_SAFETY_FILTER_NODE_HPP_ -#include "autoware/trajectory_validator/validator_interface.hpp" +#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" #include -#include +#include #include #include #include @@ -39,7 +39,7 @@ #include #include -namespace autoware::trajectory_validator +namespace autoware::trajectory_safety_filter { using autoware_internal_planning_msgs::msg::CandidateTrajectories; using autoware_internal_planning_msgs::msg::CandidateTrajectory; @@ -50,10 +50,10 @@ using autoware_utils_diagnostics::DiagnosticsInterface; using geometry_msgs::msg::AccelWithCovarianceStamped; using nav_msgs::msg::Odometry; -class TrajectoryValidator : public rclcpp::Node +class TrajectorySafetyFilter : public rclcpp::Node { public: - explicit TrajectoryValidator(const rclcpp::NodeOptions & node_options); + explicit TrajectorySafetyFilter(const rclcpp::NodeOptions & node_options); private: void process(const CandidateTrajectories::ConstSharedPtr msg); @@ -74,7 +74,7 @@ class TrajectoryValidator : public rclcpp::Node rcl_interfaces::msg::SetParametersResult on_parameter( const std::vector & parameters); - std::unique_ptr listener_; + std::unique_ptr listener_; rclcpp::Publisher::SharedPtr debug_processing_time_detail_pub_; @@ -96,14 +96,14 @@ class TrajectoryValidator : public rclcpp::Node rclcpp::node_interfaces::OnSetParametersCallbackHandle::SharedPtr set_param_res_; - pluginlib::ClassLoader plugin_loader_; + pluginlib::ClassLoader plugin_loader_; - std::vector> plugins_; + std::vector> plugins_; autoware::vehicle_info_utils::VehicleInfo vehicle_info_; - DiagnosticsInterface diagnostics_interface_{this, "trajectory_validator"}; + DiagnosticsInterface diagnostics_interface_{this, "trajectory_safety_filter"}; }; -} // namespace autoware::trajectory_validator +} // namespace autoware::trajectory_safety_filter #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__TRAJECTORY_SAFETY_FILTER_NODE_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp index 6dd99fe83e349..d641062d6d94f 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp @@ -15,7 +15,7 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__SAFETY_FILTER_INTERFACE_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__SAFETY_FILTER_INTERFACE_HPP_ -#include "autoware/trajectory_validator/filter_context.hpp" +#include "autoware/trajectory_safety_filter/filter_context.hpp" #include #include @@ -29,22 +29,22 @@ #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { using autoware_planning_msgs::msg::TrajectoryPoint; using TrajectoryPoints = std::vector; using VehicleInfo = autoware::vehicle_info_utils::VehicleInfo; -class ValidatorInterface +class SafetyFilterInterface { public: - explicit ValidatorInterface(std::string name) : name_(std::move(name)) {} + explicit SafetyFilterInterface(std::string name) : name_(std::move(name)) {} - virtual ~ValidatorInterface() = default; - ValidatorInterface(const ValidatorInterface &) = delete; - ValidatorInterface & operator=(const ValidatorInterface &) = delete; - ValidatorInterface(ValidatorInterface &&) = delete; - ValidatorInterface & operator=(ValidatorInterface &&) = delete; + virtual ~SafetyFilterInterface() = default; + SafetyFilterInterface(const SafetyFilterInterface &) = delete; + SafetyFilterInterface & operator=(const SafetyFilterInterface &) = delete; + SafetyFilterInterface(SafetyFilterInterface &&) = delete; + SafetyFilterInterface & operator=(SafetyFilterInterface &&) = delete; // Main filter method with context for plugin-specific data virtual tl::expected is_feasible( @@ -68,7 +68,7 @@ class ValidatorInterface std::string name_; std::shared_ptr vehicle_info_ptr_; }; -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin // NOLINTNEXTLINE #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__SAFETY_FILTER_INTERFACE_HPP_ diff --git a/planning/autoware_trajectory_validator/launch/trajectory_validator.launch.xml b/planning/autoware_trajectory_validator/launch/trajectory_validator.launch.xml index eade3d9b9ebe2..88ac22e05a5af 100644 --- a/planning/autoware_trajectory_validator/launch/trajectory_validator.launch.xml +++ b/planning/autoware_trajectory_validator/launch/trajectory_validator.launch.xml @@ -1,6 +1,6 @@ - + @@ -8,8 +8,8 @@ - - + + diff --git a/planning/autoware_trajectory_validator/package.xml b/planning/autoware_trajectory_validator/package.xml index 81caf758cd213..e2cf4d9022bbd 100644 --- a/planning/autoware_trajectory_validator/package.xml +++ b/planning/autoware_trajectory_validator/package.xml @@ -1,9 +1,9 @@ - autoware_trajectory_validator + autoware_trajectory_safety_filter 0.1.0 - The autoware_trajectory_validator package + The autoware_trajectory_safety_filter package Daniel Sanchez Yukihiro Saito diff --git a/planning/autoware_trajectory_validator/param/parameter_struct.yaml b/planning/autoware_trajectory_validator/param/parameter_struct.yaml index 0751ee163a555..1e9a4446a9017 100644 --- a/planning/autoware_trajectory_validator/param/parameter_struct.yaml +++ b/planning/autoware_trajectory_validator/param/parameter_struct.yaml @@ -1,4 +1,4 @@ -validator: +safety_filter: filter_names: type: string_array default_value: [] diff --git a/planning/autoware_trajectory_validator/plugins.xml b/planning/autoware_trajectory_validator/plugins.xml index 5e4d6492012ce..a9197d4e71735 100644 --- a/planning/autoware_trajectory_validator/plugins.xml +++ b/planning/autoware_trajectory_validator/plugins.xml @@ -1,31 +1,31 @@ - - + + Filters trajectories that go out of lane boundaries - + Filters trajectories based on Time To Collision (TTC) with predicted objects - + Filters trajectories that cross uncrossable boundaries - + Filters trajectories that violate vehicle constraints such as maximum speed, acceleration, and steering angle - + Filters trajectories based on collision checks with predicted objects diff --git a/planning/autoware_trajectory_validator/src/filters/collision_check_filter.cpp b/planning/autoware_trajectory_validator/src/filters/collision_check_filter.cpp index 8d0e06494f75b..f79a4474854b9 100644 --- a/planning/autoware_trajectory_validator/src/filters/collision_check_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/collision_check_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_validator/filters/collision_check_filter.hpp" +#include "autoware/trajectory_safety_filter/filters/collision_check_filter.hpp" #include #include @@ -31,7 +31,7 @@ #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { namespace motion @@ -420,9 +420,9 @@ tl::expected CollisionCheckFilter::is_feasible( return {}; } -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin #include PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_validator::plugin::CollisionCheckFilter, - autoware::trajectory_validator::plugin::ValidatorInterface) + autoware::trajectory_safety_filter::plugin::CollisionCheckFilter, + autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) diff --git a/planning/autoware_trajectory_validator/src/filters/collision_filter.cpp b/planning/autoware_trajectory_validator/src/filters/collision_filter.cpp index c3c3780e9be2a..de8dda6503123 100644 --- a/planning/autoware_trajectory_validator/src/filters/collision_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/collision_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_validator/filters/collision_filter.hpp" +#include "autoware/trajectory_safety_filter/filters/collision_filter.hpp" #include @@ -27,7 +27,7 @@ #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { namespace @@ -283,9 +283,9 @@ void CollisionFilter::update_parameters(const std::vector & p update_param(parameters, "collision.time", params_.max_check_time); update_param(parameters, "collision.min_value", params_.min_ttc); } -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin #include PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_validator::plugin::CollisionFilter, - autoware::trajectory_validator::plugin::ValidatorInterface) + autoware::trajectory_safety_filter::plugin::CollisionFilter, + autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) diff --git a/planning/autoware_trajectory_validator/src/filters/out_of_lane_filter.cpp b/planning/autoware_trajectory_validator/src/filters/out_of_lane_filter.cpp index ddb915720bb0f..98b7c1136ed3c 100644 --- a/planning/autoware_trajectory_validator/src/filters/out_of_lane_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/out_of_lane_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_validator/filters/out_of_lane_filter.hpp" +#include "autoware/trajectory_safety_filter/filters/out_of_lane_filter.hpp" #include @@ -24,7 +24,7 @@ #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { namespace @@ -60,7 +60,7 @@ autoware_internal_planning_msgs::msg::PathWithLaneId convert_to_path_with_lane_i } } // namespace -OutOfLaneFilter::OutOfLaneFilter() : ValidatorInterface("OutOfLaneFilter") +OutOfLaneFilter::OutOfLaneFilter() : SafetyFilterInterface("OutOfLaneFilter") { // BoundaryDepartureChecker will be initialized when vehicle_info is set } @@ -109,9 +109,9 @@ tl::expected OutOfLaneFilter::is_feasible( return {}; } -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin #include PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_validator::plugin::OutOfLaneFilter, - autoware::trajectory_validator::plugin::ValidatorInterface) + autoware::trajectory_safety_filter::plugin::OutOfLaneFilter, + autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) diff --git a/planning/autoware_trajectory_validator/src/filters/uncrossable_boundary_departure_filter.cpp b/planning/autoware_trajectory_validator/src/filters/uncrossable_boundary_departure_filter.cpp index 694085ddfbfca..387219c5aefa0 100644 --- a/planning/autoware_trajectory_validator/src/filters/uncrossable_boundary_departure_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/uncrossable_boundary_departure_filter.cpp @@ -12,12 +12,12 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp" +#include "autoware/trajectory_safety_filter/filters/uncrossable_boundary_departure_filter.hpp" #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { tl::expected UncrossableBoundaryDepartureFilter::is_feasible( const TrajectoryPoints & traj_points, const FilterContext & context) @@ -64,9 +64,9 @@ std::optional UncrossableBoundaryDepartureFilter::is_invalid_input( return std::nullopt; } -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin #include PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_validator::plugin::UncrossableBoundaryDepartureFilter, - autoware::trajectory_validator::plugin::ValidatorInterface) + autoware::trajectory_safety_filter::plugin::UncrossableBoundaryDepartureFilter, + autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) diff --git a/planning/autoware_trajectory_validator/src/filters/vehicle_constraint_filter.cpp b/planning/autoware_trajectory_validator/src/filters/vehicle_constraint_filter.cpp index e42976ddeac0a..80686c5df6416 100644 --- a/planning/autoware_trajectory_validator/src/filters/vehicle_constraint_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/vehicle_constraint_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp" +#include "autoware/trajectory_safety_filter/filters/vehicle_constraint_filter.hpp" #include #include @@ -20,7 +20,7 @@ #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { namespace { @@ -90,7 +90,7 @@ double to_steering_rate( } // namespace VehicleConstraintFilter::VehicleConstraintFilter() -: ValidatorInterface("VehicleConstraintFilter") +: SafetyFilterInterface("VehicleConstraintFilter") { } @@ -260,9 +260,9 @@ bool is_steering_rate_ok( } return true; } -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin #include PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_validator::plugin::VehicleConstraintFilter, - autoware::trajectory_validator::plugin::ValidatorInterface) + autoware::trajectory_safety_filter::plugin::VehicleConstraintFilter, + autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) diff --git a/planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp b/planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp index b59c2daabc312..a4e334a8ad93c 100644 --- a/planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp +++ b/planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp @@ -12,10 +12,10 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_validator/trajectory_validator_node.hpp" +#include "autoware/trajectory_safety_filter/trajectory_safety_filter_node.hpp" -#include "autoware/trajectory_validator/filter_context.hpp" -#include "autoware/trajectory_validator/validator_interface.hpp" +#include "autoware/trajectory_safety_filter/filter_context.hpp" +#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" #include @@ -61,15 +61,15 @@ bool has_trajectory_from_generator( } } // namespace -namespace autoware::trajectory_validator +namespace autoware::trajectory_safety_filter { -TrajectoryValidator::TrajectoryValidator(const rclcpp::NodeOptions & options) -: Node{"trajectory_validator_node", options}, - listener_{std::make_unique(get_node_parameters_interface())}, +TrajectorySafetyFilter::TrajectorySafetyFilter(const rclcpp::NodeOptions & options) +: Node{"trajectory_safety_filter_node", options}, + listener_{std::make_unique(get_node_parameters_interface())}, plugin_loader_( - "autoware_trajectory_validator", - "autoware::trajectory_validator::plugin::ValidatorInterface"), + "autoware_trajectory_safety_filter", + "autoware::trajectory_safety_filter::plugin::SafetyFilterInterface"), vehicle_info_(autoware::vehicle_info_utils::VehicleInfoUtils(*this).getVehicleInfo()) { const auto filters = listener_->get_params().filter_names; @@ -79,11 +79,11 @@ TrajectoryValidator::TrajectoryValidator(const rclcpp::NodeOptions & options) sub_map_ = create_subscription( "~/input/lanelet2_map", rclcpp::QoS{1}.transient_local(), - std::bind(&TrajectoryValidator::map_callback, this, std::placeholders::_1)); + std::bind(&TrajectorySafetyFilter::map_callback, this, std::placeholders::_1)); sub_trajectories_ = create_subscription( "~/input/trajectories", 1, - std::bind(&TrajectoryValidator::process, this, std::placeholders::_1)); + std::bind(&TrajectorySafetyFilter::process, this, std::placeholders::_1)); pub_trajectories_ = create_publisher("~/output/trajectories", 1); @@ -93,10 +93,10 @@ TrajectoryValidator::TrajectoryValidator(const rclcpp::NodeOptions & options) std::make_shared(debug_processing_time_detail_pub_); set_param_res_ = this->add_on_set_parameters_callback( - std::bind(&TrajectoryValidator::on_parameter, this, std::placeholders::_1)); + std::bind(&TrajectorySafetyFilter::on_parameter, this, std::placeholders::_1)); } -void TrajectoryValidator::process(const CandidateTrajectories::ConstSharedPtr msg) +void TrajectorySafetyFilter::process(const CandidateTrajectories::ConstSharedPtr msg) { autoware_utils_debug::ScopedTimeTrack st(__func__, *time_keeper_); @@ -161,7 +161,7 @@ void TrajectoryValidator::process(const CandidateTrajectories::ConstSharedPtr ms pub_trajectories_->publish(*filtered_msg); } -void TrajectoryValidator::map_callback(const LaneletMapBin::ConstSharedPtr msg) +void TrajectorySafetyFilter::map_callback(const LaneletMapBin::ConstSharedPtr msg) { autoware_utils_debug::ScopedTimeTrack st(__func__, *time_keeper_); @@ -169,7 +169,7 @@ void TrajectoryValidator::map_callback(const LaneletMapBin::ConstSharedPtr msg) lanelet::utils::conversion::fromBinMsg(*msg, lanelet_map_ptr_); } -void TrajectoryValidator::load_metric(const std::string & name) +void TrajectorySafetyFilter::load_metric(const std::string & name) { if (name == "") return; @@ -193,18 +193,18 @@ void TrajectoryValidator::load_metric(const std::string & name) } catch (const pluginlib::CreateClassException & e) { RCLCPP_ERROR_STREAM( get_logger(), - "[validator] createSharedInstance failed for '" << name << "': " << e.what()); + "[safety_filter] createSharedInstance failed for '" << name << "': " << e.what()); } catch (const std::exception & e) { RCLCPP_ERROR_STREAM( - get_logger(), "[validator] unexpected exception for '" << name << "': " << e.what()); + get_logger(), "[safety_filter] unexpected exception for '" << name << "': " << e.what()); } } -void TrajectoryValidator::unload_metric(const std::string & name) +void TrajectorySafetyFilter::unload_metric(const std::string & name) { auto it = std::remove_if( plugins_.begin(), plugins_.end(), - [&](const std::shared_ptr & plugin) { + [&](const std::shared_ptr & plugin) { return plugin->get_name() == name; }); @@ -242,7 +242,7 @@ void TrajectoryValidator::update_diagnostic( diagnostics_interface_.publish(this->get_clock()->now()); } -rcl_interfaces::msg::SetParametersResult TrajectoryValidator::on_parameter( +rcl_interfaces::msg::SetParametersResult TrajectorySafetyFilter::on_parameter( const std::vector & parameters) { rcl_interfaces::msg::SetParametersResult result; @@ -262,7 +262,7 @@ rcl_interfaces::msg::SetParametersResult TrajectoryValidator::on_parameter( return result; } -} // namespace autoware::trajectory_validator +} // namespace autoware::trajectory_safety_filter #include -RCLCPP_COMPONENTS_REGISTER_NODE(autoware::trajectory_validator::TrajectoryValidator) +RCLCPP_COMPONENTS_REGISTER_NODE(autoware::trajectory_safety_filter::TrajectorySafetyFilter) diff --git a/planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp index e96447032c30b..d4066c8d08e03 100644 --- a/planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp +++ b/planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp @@ -20,7 +20,7 @@ #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { class CollisionCheckFilterTest : public ::testing::Test @@ -227,4 +227,4 @@ TEST_F(CollisionCheckFilterTest, ObjectWillEnterPath) << "Error string did not contain 'constant_curvature_path'. Actual: " << error_msg; } -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin diff --git a/planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp index 55255c0562538..f0f8a304110f5 100644 --- a/planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp +++ b/planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -// #include "autoware/trajectory_validator/filters/collision_check_filter.cpp" +// #include "autoware/trajectory_safety_filter/filters/collision_check_filter.cpp" #include "../..//src/filters/collision_check_filter.cpp" #include @@ -23,7 +23,7 @@ #include -namespace autoware::trajectory_validator::plugin::constant_curvature_predictor +namespace autoware::trajectory_safety_filter::plugin::constant_curvature_predictor { TEST(ConstantCurvaturePoseTrajectoryCalculatorTest, PoseToIsometry) @@ -216,4 +216,4 @@ TEST(ConstantCurvaturePoseTrajectoryCalculatorTest, ComputeTrajectory) } } -} // namespace autoware::trajectory_validator::plugin::constant_curvature_predictor +} // namespace autoware::trajectory_safety_filter::plugin::constant_curvature_predictor diff --git a/planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp index 5ba98e0502741..d56ace55c074c 100644 --- a/planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp +++ b/planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -// #include "autoware/trajectory_validator/filters/collision_check_filter.hpp" +// #include "autoware/trajectory_safety_filter/filters/collision_check_filter.hpp" #include "../../src/filters/collision_check_filter.cpp" #include @@ -20,7 +20,7 @@ #include #include -namespace autoware::trajectory_validator::plugin::motion +namespace autoware::trajectory_safety_filter::plugin::motion { class ComputeMotionProfile1dTest : public ::testing::Test { @@ -127,4 +127,4 @@ TEST_F(ComputeMotionProfile1dTest, LagLongerThanMaxTime) } } -} // namespace autoware::trajectory_validator::plugin::motion +} // namespace autoware::trajectory_safety_filter::plugin::motion diff --git a/planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp index d88bb3deb4ed4..c239f7e1b89f1 100644 --- a/planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp +++ b/planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -// #include "autoware/trajectory_validator/filters/collision_check_filter.hpp" +// #include "autoware/trajectory_safety_filter/filters/collision_check_filter.hpp" #include "../../src/filters/collision_check_filter.cpp" #include @@ -20,7 +20,7 @@ #include #include -namespace autoware::trajectory_validator::plugin::polygon +namespace autoware::trajectory_safety_filter::plugin::polygon { class PolygonCollisionTest : public ::testing::Test @@ -95,4 +95,4 @@ TEST_F(PolygonCollisionTest, CheckPathPolygonConvexCollision) EXPECT_TRUE(check_path_polygon_convex_collision(traj1_collide, traj2_collide)); } -} // namespace autoware::trajectory_validator::plugin::polygon +} // namespace autoware::trajectory_safety_filter::plugin::polygon diff --git a/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_plugins.xml b/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_plugins.xml index 15f5b710dd034..433397d5eed61 100644 --- a/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_plugins.xml +++ b/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_plugins.xml @@ -1,7 +1,7 @@ - - + + A predictable dummy filter for testing the main node diff --git a/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_validator_plugin.cpp b/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_validator_plugin.cpp index f5da10a814e9c..11f4284c4824a 100644 --- a/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_validator_plugin.cpp +++ b/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_validator_plugin.cpp @@ -12,16 +12,16 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_validator/validator_interface.hpp" +#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" #include #include #include -namespace autoware::trajectory_validator::plugin +namespace autoware::trajectory_safety_filter::plugin { -class DummyFilter : public ValidatorInterface +class DummyFilter : public SafetyFilterInterface { struct DummyFilterParam { @@ -29,7 +29,7 @@ class DummyFilter : public ValidatorInterface }; public: - DummyFilter() : ValidatorInterface("DummyFilter") {} + DummyFilter() : SafetyFilterInterface("DummyFilter") {} tl::expected is_feasible( const TrajectoryPoints & traj_points, const FilterContext & /*context*/) final @@ -62,8 +62,8 @@ class DummyFilter : public ValidatorInterface private: DummyFilterParam params_; }; -} // namespace autoware::trajectory_validator::plugin +} // namespace autoware::trajectory_safety_filter::plugin PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_validator::plugin::DummyFilter, - autoware::trajectory_validator::plugin::ValidatorInterface) + autoware::trajectory_safety_filter::plugin::DummyFilter, + autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) diff --git a/planning/autoware_trajectory_validator/test/node/test_trajectory_validator_node.cpp b/planning/autoware_trajectory_validator/test/node/test_trajectory_validator_node.cpp index 3d5dd66dda4af..d16afb1fcd40e 100644 --- a/planning/autoware_trajectory_validator/test/node/test_trajectory_validator_node.cpp +++ b/planning/autoware_trajectory_validator/test/node/test_trajectory_validator_node.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_validator/trajectory_validator_node.hpp" +#include "autoware/trajectory_safety_filter/trajectory_safety_filter_node.hpp" #include #include @@ -23,10 +23,10 @@ #include #include -namespace autoware::trajectory_validator +namespace autoware::trajectory_safety_filter { -class TrajectoryValidatorNodeTest : public ::testing::Test +class TrajectorySafetyFilterNodeTest : public ::testing::Test { protected: void SetUp() override @@ -34,7 +34,7 @@ class TrajectoryValidatorNodeTest : public ::testing::Test rclcpp::init(0, nullptr); node_options_.append_parameter_override( "filter_names", - std::vector{"autoware::trajectory_validator::plugin::DummyFilter"}); + std::vector{"autoware::trajectory_safety_filter::plugin::DummyFilter"}); node_options_.append_parameter_override("dummy.dummy_param", 0.0); const auto test_pkg_share = ament_index_cpp::get_package_share_directory("autoware_test_utils"); @@ -43,25 +43,25 @@ class TrajectoryValidatorNodeTest : public ::testing::Test autoware::test_utils::updateNodeOptions(node_options_, {vehicle_info_param_path}); - node_under_test_ = std::make_shared(node_options_); + node_under_test_ = std::make_shared(node_options_); test_node_ = std::make_shared("test_helper_node"); map_pub_ = test_node_->create_publisher( - "/trajectory_validator_node/input/lanelet2_map", rclcpp::QoS{1}.transient_local()); + "/trajectory_safety_filter_node/input/lanelet2_map", rclcpp::QoS{1}.transient_local()); odom_pub_ = test_node_->create_publisher( - "/trajectory_validator_node/input/odometry", 1); + "/trajectory_safety_filter_node/input/odometry", 1); accel_pub_ = test_node_->create_publisher( - "/trajectory_validator_node/input/acceleration", 1); + "/trajectory_safety_filter_node/input/acceleration", 1); obj_pub_ = test_node_->create_publisher( - "/trajectory_validator_node/input/objects", 1); + "/trajectory_safety_filter_node/input/objects", 1); traj_pub_ = test_node_->create_publisher( - "/trajectory_validator_node/input/trajectories", 1); + "/trajectory_safety_filter_node/input/trajectories", 1); output_sub_ = test_node_->create_subscription( - "/trajectory_validator_node/output/trajectories", 1, + "/trajectory_safety_filter_node/output/trajectories", 1, [this]( const autoware_internal_planning_msgs::msg::CandidateTrajectories::ConstSharedPtr msg) { last_output_ = msg; @@ -126,7 +126,7 @@ class TrajectoryValidatorNodeTest : public ::testing::Test rclcpp::NodeOptions node_options_; rclcpp::Node::SharedPtr test_node_; - std::shared_ptr node_under_test_; + std::shared_ptr node_under_test_; rclcpp::Publisher::SharedPtr map_pub_; rclcpp::Publisher::SharedPtr odom_pub_; @@ -140,7 +140,7 @@ class TrajectoryValidatorNodeTest : public ::testing::Test autoware_internal_planning_msgs::msg::CandidateTrajectories::ConstSharedPtr last_output_; }; -TEST_F(TrajectoryValidatorNodeTest, FiltersTrajectoriesViaPlugin) +TEST_F(TrajectorySafetyFilterNodeTest, FiltersTrajectoriesViaPlugin) { publish_context(); spin_until([] { return false; }, std::chrono::milliseconds(100)); @@ -160,7 +160,7 @@ TEST_F(TrajectoryValidatorNodeTest, FiltersTrajectoriesViaPlugin) EXPECT_EQ(last_output_->generator_info.front().generator_name.data, "SafePlanner"); } -TEST_F(TrajectoryValidatorNodeTest, UpdateParametersDynamically) +TEST_F(TrajectorySafetyFilterNodeTest, UpdateParametersDynamically) { publish_context(); spin_until([] { return false; }, std::chrono::milliseconds(100)); @@ -183,7 +183,7 @@ TEST_F(TrajectoryValidatorNodeTest, UpdateParametersDynamically) EXPECT_EQ(last_output_->candidate_trajectories.size(), 1u); } -TEST_F(TrajectoryValidatorNodeTest, HandlesPluginRejection) +TEST_F(TrajectorySafetyFilterNodeTest, HandlesPluginRejection) { publish_context(); spin_until([] { return false; }, std::chrono::milliseconds(100)); @@ -196,4 +196,4 @@ TEST_F(TrajectoryValidatorNodeTest, HandlesPluginRejection) ASSERT_TRUE(spin_until([this] { return last_output_ != nullptr; })); EXPECT_EQ(last_output_->candidate_trajectories.size(), 0u); } -} // namespace autoware::trajectory_validator +} // namespace autoware::trajectory_safety_filter diff --git a/planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp b/planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp index 8e813bf01795b..cd5526cf8f5c9 100644 --- a/planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp +++ b/planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp" +#include "autoware/trajectory_safety_filter/filters/vehicle_constraint_filter.hpp" #include @@ -36,7 +36,7 @@ autoware_planning_msgs::msg::TrajectoryPoint create_trajectory_point( } } // namespace -namespace autoware::trajectory_validator::plugin::testing +namespace autoware::trajectory_safety_filter::plugin::testing { TEST(VehicleConstraintFilterTest, FeasibleWhenAllConstraintsSatisfied) { @@ -308,4 +308,4 @@ TEST(IsSteeringRateOkTest, FalseWhenAnySteeringRateAboveMax) EXPECT_FALSE(is_steering_rate_ok(traj_points, vehicle_info, max_steering_rate)); } -} // namespace autoware::trajectory_validator::plugin::testing +} // namespace autoware::trajectory_safety_filter::plugin::testing From ea88cbbe152e39f6c0f0335eadcd30b8198ea3ae Mon Sep 17 00:00:00 2001 From: Zulfaqar Azmi Date: Mon, 9 Mar 2026 12:11:34 +0900 Subject: [PATCH 07/10] fix: rename in trajectory safety filter Signed-off-by: Zulfaqar Azmi --- .../CMakeLists.txt | 32 +++++++------- .../trajectory_validator/filter_context.hpp | 4 +- .../filters/collision_check_filter.hpp | 10 ++--- .../filters/collision_filter.hpp | 10 ++--- .../filters/out_of_lane_filter.hpp | 8 ++-- .../uncrossable_boundary_departure_filter.hpp | 10 ++--- .../filters/vehicle_constraint_filter.hpp | 8 ++-- .../trajectory_validator_node.hpp | 20 ++++----- .../validator_interface.hpp | 20 ++++----- .../launch/trajectory_validator.launch.xml | 6 +-- .../autoware_trajectory_validator/package.xml | 4 +- .../param/parameter_struct.yaml | 2 +- .../src/filters/collision_check_filter.cpp | 10 ++--- .../src/filters/collision_filter.cpp | 10 ++--- .../src/filters/out_of_lane_filter.cpp | 12 ++--- .../uncrossable_boundary_departure_filter.cpp | 10 ++--- .../src/filters/vehicle_constraint_filter.cpp | 12 ++--- .../src/trajectory_validator_node.cpp | 44 +++++++++---------- .../collision_check_filter/test_collision.cpp | 4 +- .../test_constant_curvature_predictor.cpp | 6 +-- .../collision_check_filter/test_motion.cpp | 6 +-- .../collision_check_filter/test_polygon.cpp | 6 +-- .../dummy_plugin/dummy_validator_plugin.cpp | 14 +++--- .../node/test_trajectory_validator_node.cpp | 32 +++++++------- .../test_vehicle_constraint_filter.cpp | 6 +-- 25 files changed, 153 insertions(+), 153 deletions(-) diff --git a/planning/autoware_trajectory_validator/CMakeLists.txt b/planning/autoware_trajectory_validator/CMakeLists.txt index 640b41cca92a9..19cde55922c45 100644 --- a/planning/autoware_trajectory_validator/CMakeLists.txt +++ b/planning/autoware_trajectory_validator/CMakeLists.txt @@ -1,9 +1,9 @@ cmake_minimum_required(VERSION 3.14) -project(autoware_trajectory_safety_filter) +project(autoware_trajectory_validator) find_package(autoware_cmake REQUIRED) autoware_package() -pluginlib_export_plugin_description_file(autoware_trajectory_safety_filter plugins.xml) +pluginlib_export_plugin_description_file(autoware_trajectory_validator plugins.xml) generate_parameter_library(${PROJECT_NAME}_param param/parameter_struct.yaml @@ -14,7 +14,7 @@ include_directories( ) ament_auto_add_library(${PROJECT_NAME} SHARED - src/trajectory_safety_filter_node.cpp + src/trajectory_validator_node.cpp ) target_link_libraries(${PROJECT_NAME} @@ -26,11 +26,11 @@ target_compile_options(${PROJECT_NAME} PUBLIC ) rclcpp_components_register_node(${PROJECT_NAME} - PLUGIN "autoware::trajectory_safety_filter::TrajectorySafetyFilter" + PLUGIN "autoware::trajectory_validator::TrajectoryValidator" EXECUTABLE ${PROJECT_NAME}_node ) -ament_auto_add_library(autoware_trajectory_safety_filter_plugins SHARED +ament_auto_add_library(autoware_trajectory_validator_plugins SHARED src/filters/out_of_lane_filter.cpp src/filters/collision_filter.cpp src/filters/uncrossable_boundary_departure_filter.cpp @@ -38,7 +38,7 @@ ament_auto_add_library(autoware_trajectory_safety_filter_plugins SHARED src/filters/collision_check_filter.cpp ) -target_link_libraries(autoware_trajectory_safety_filter_plugins +target_link_libraries(autoware_trajectory_validator_plugins ${PROJECT_NAME} ) @@ -54,7 +54,7 @@ if(BUILD_TESTING) test/plugins/test_vehicle_constraint_filter.cpp ) target_link_libraries(test_vehicle_constraint_filter - autoware_trajectory_safety_filter_plugins + autoware_trajectory_validator_plugins ) ament_add_ros_isolated_gtest(test_constant_curvature @@ -80,31 +80,31 @@ if(BUILD_TESTING) # ========================================== # 2. Dummy Plugin (Test Utility) # ========================================== - pluginlib_export_plugin_description_file(autoware_trajectory_safety_filter + pluginlib_export_plugin_description_file(autoware_trajectory_validator test/dummy_plugin/dummy_plugins.xml ) - ament_auto_add_library(dummy_safety_filter_plugin SHARED - test/dummy_plugin/dummy_safety_filter_plugin.cpp + ament_auto_add_library(dummy_validator_plugin SHARED + test/dummy_plugin/dummy_validator_plugin.cpp ) - target_link_libraries(dummy_safety_filter_plugin + target_link_libraries(dummy_validator_plugin ${PROJECT_NAME} ) # ========================================== # 3. Node Integration/Unit Tests # ========================================== - ament_add_ros_isolated_gtest(test_trajectory_safety_filter_node - test/node/test_trajectory_safety_filter_node.cpp + ament_add_ros_isolated_gtest(test_trajectory_validator_node + test/node/test_trajectory_validator_node.cpp ) - target_link_libraries(test_trajectory_safety_filter_node + target_link_libraries(test_trajectory_validator_node ${PROJECT_NAME} - dummy_safety_filter_plugin + dummy_validator_plugin ) - ament_target_dependencies(test_trajectory_safety_filter_node + ament_target_dependencies(test_trajectory_validator_node autoware_test_utils ) endif() diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp index 2cb3548ce32e8..265b1df8ea3a6 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp @@ -29,7 +29,7 @@ #include #include -namespace autoware::trajectory_safety_filter +namespace autoware::trajectory_validator { // Base context that all filters can access @@ -40,6 +40,6 @@ struct FilterContext std::shared_ptr lanelet_map; autoware_perception_msgs::msg::PredictedObjects::ConstSharedPtr predicted_objects; }; -} // namespace autoware::trajectory_safety_filter +} // namespace autoware::trajectory_validator #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTER_CONTEXT_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_check_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_check_filter.hpp index dbbbc7c904fb7..a9fc8b9db7005 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_check_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_check_filter.hpp @@ -15,7 +15,7 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_CHECK_FILTER_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_CHECK_FILTER_HPP_ -#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" +#include "autoware/trajectory_validator/validator_interface.hpp" #include #include @@ -33,7 +33,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { using autoware_utils_geometry::Box2d; using autoware_utils_geometry::MultiPoint2d; @@ -130,10 +130,10 @@ PoseTrajectory compute_pose_trajectory( return pose_trajectory; } -class CollisionCheckFilter : public SafetyFilterInterface +class CollisionCheckFilter : public ValidatorInterface { public: - CollisionCheckFilter() : SafetyFilterInterface("CollisionCheckFilter") {} + CollisionCheckFilter() : ValidatorInterface("CollisionCheckFilter") {} tl::expected is_feasible( const TrajectoryPoints & traj_points, const FilterContext & context) override; @@ -151,6 +151,6 @@ class CollisionCheckFilter : public SafetyFilterInterface } pet_collision_params_; }; -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_CHECK_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_filter.hpp index 23aa77db8defe..f4c9c8d4180c5 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_filter.hpp @@ -15,7 +15,7 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_FILTER_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_FILTER_HPP_ -#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" +#include "autoware/trajectory_validator/validator_interface.hpp" #include @@ -26,7 +26,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { // Parameters for CollisionFilter @@ -36,10 +36,10 @@ struct CollisionParams double min_ttc = 2.0; // seconds - minimum acceptable time to collision }; -class CollisionFilter : public SafetyFilterInterface +class CollisionFilter : public ValidatorInterface { public: - CollisionFilter() : SafetyFilterInterface("CollisionFilter") {} + CollisionFilter() : ValidatorInterface("CollisionFilter") {} tl::expected is_feasible( const TrajectoryPoints & traj_points, const FilterContext & context) final; @@ -71,6 +71,6 @@ class CollisionFilter : public SafetyFilterInterface double time_from_start) const; }; -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/out_of_lane_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/out_of_lane_filter.hpp index da0b2fb6b98a4..957570ee247ec 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/out_of_lane_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/out_of_lane_filter.hpp @@ -15,7 +15,7 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__OUT_OF_LANE_FILTER_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__OUT_OF_LANE_FILTER_HPP_ -#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" +#include "autoware/trajectory_validator/validator_interface.hpp" #include #include @@ -28,7 +28,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { // Parameters for OutOfLaneFilter @@ -38,7 +38,7 @@ struct OutOfLaneParams double min_value = 0.0; // meters - minimum distance to lane boundary }; -class OutOfLaneFilter : public SafetyFilterInterface +class OutOfLaneFilter : public ValidatorInterface { public: OutOfLaneFilter(); @@ -55,6 +55,6 @@ class OutOfLaneFilter : public SafetyFilterInterface std::unique_ptr boundary_departure_checker_; }; -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__OUT_OF_LANE_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp index 2fe8e46889cf2..2e76b8ddb8bfd 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp @@ -15,7 +15,7 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__UNCROSSABLE_BOUNDARY_DEPARTURE_FILTER_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__UNCROSSABLE_BOUNDARY_DEPARTURE_FILTER_HPP_ -#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" +#include "autoware/trajectory_validator/validator_interface.hpp" #include #include @@ -24,12 +24,12 @@ #include #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { -class UncrossableBoundaryDepartureFilter : public SafetyFilterInterface +class UncrossableBoundaryDepartureFilter : public ValidatorInterface { public: - UncrossableBoundaryDepartureFilter() : SafetyFilterInterface("UncrossableBoundaryDepartureFilter") + UncrossableBoundaryDepartureFilter() : ValidatorInterface("UncrossableBoundaryDepartureFilter") { } @@ -65,6 +65,6 @@ class UncrossableBoundaryDepartureFilter : public SafetyFilterInterface RCLCPP_WARN_THROTTLE(log_, *clock_, 5000, fmt, args...); } }; -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__UNCROSSABLE_BOUNDARY_DEPARTURE_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp index 457c8868355b2..d662e5fcdb3a5 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp @@ -15,19 +15,19 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__VEHICLE_CONSTRAINT_FILTER_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__VEHICLE_CONSTRAINT_FILTER_HPP_ -#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" +#include "autoware/trajectory_validator/validator_interface.hpp" #include #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { /** * @brief VehicleConstraintFilter class - checks if the trajectory respects vehicle constraints * (e.g., max speed, max acceleration/deceleration). */ -class VehicleConstraintFilter final : public SafetyFilterInterface +class VehicleConstraintFilter final : public ValidatorInterface { public: using result_t = tl::expected; @@ -122,5 +122,5 @@ bool is_steering_angle_ok( */ bool is_steering_rate_ok( const TrajectoryPoints & traj_points, const VehicleInfo & vehicle_info, double max_steering_rate); -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__VEHICLE_CONSTRAINT_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp index 420fb793d041e..416d212186acd 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp @@ -15,10 +15,10 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__TRAJECTORY_SAFETY_FILTER_NODE_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__TRAJECTORY_SAFETY_FILTER_NODE_HPP_ -#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" +#include "autoware/trajectory_validator/validator_interface.hpp" #include -#include +#include #include #include #include @@ -39,7 +39,7 @@ #include #include -namespace autoware::trajectory_safety_filter +namespace autoware::trajectory_validator { using autoware_internal_planning_msgs::msg::CandidateTrajectories; using autoware_internal_planning_msgs::msg::CandidateTrajectory; @@ -50,10 +50,10 @@ using autoware_utils_diagnostics::DiagnosticsInterface; using geometry_msgs::msg::AccelWithCovarianceStamped; using nav_msgs::msg::Odometry; -class TrajectorySafetyFilter : public rclcpp::Node +class TrajectoryValidator : public rclcpp::Node { public: - explicit TrajectorySafetyFilter(const rclcpp::NodeOptions & node_options); + explicit TrajectoryValidator(const rclcpp::NodeOptions & node_options); private: void process(const CandidateTrajectories::ConstSharedPtr msg); @@ -74,7 +74,7 @@ class TrajectorySafetyFilter : public rclcpp::Node rcl_interfaces::msg::SetParametersResult on_parameter( const std::vector & parameters); - std::unique_ptr listener_; + std::unique_ptr listener_; rclcpp::Publisher::SharedPtr debug_processing_time_detail_pub_; @@ -96,14 +96,14 @@ class TrajectorySafetyFilter : public rclcpp::Node rclcpp::node_interfaces::OnSetParametersCallbackHandle::SharedPtr set_param_res_; - pluginlib::ClassLoader plugin_loader_; + pluginlib::ClassLoader plugin_loader_; - std::vector> plugins_; + std::vector> plugins_; autoware::vehicle_info_utils::VehicleInfo vehicle_info_; - DiagnosticsInterface diagnostics_interface_{this, "trajectory_safety_filter"}; + DiagnosticsInterface diagnostics_interface_{this, "trajectory_validator"}; }; -} // namespace autoware::trajectory_safety_filter +} // namespace autoware::trajectory_validator #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__TRAJECTORY_SAFETY_FILTER_NODE_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp index d641062d6d94f..6dd99fe83e349 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp @@ -15,7 +15,7 @@ #ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__SAFETY_FILTER_INTERFACE_HPP_ #define AUTOWARE__TRAJECTORY_SAFETY_FILTER__SAFETY_FILTER_INTERFACE_HPP_ -#include "autoware/trajectory_safety_filter/filter_context.hpp" +#include "autoware/trajectory_validator/filter_context.hpp" #include #include @@ -29,22 +29,22 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { using autoware_planning_msgs::msg::TrajectoryPoint; using TrajectoryPoints = std::vector; using VehicleInfo = autoware::vehicle_info_utils::VehicleInfo; -class SafetyFilterInterface +class ValidatorInterface { public: - explicit SafetyFilterInterface(std::string name) : name_(std::move(name)) {} + explicit ValidatorInterface(std::string name) : name_(std::move(name)) {} - virtual ~SafetyFilterInterface() = default; - SafetyFilterInterface(const SafetyFilterInterface &) = delete; - SafetyFilterInterface & operator=(const SafetyFilterInterface &) = delete; - SafetyFilterInterface(SafetyFilterInterface &&) = delete; - SafetyFilterInterface & operator=(SafetyFilterInterface &&) = delete; + virtual ~ValidatorInterface() = default; + ValidatorInterface(const ValidatorInterface &) = delete; + ValidatorInterface & operator=(const ValidatorInterface &) = delete; + ValidatorInterface(ValidatorInterface &&) = delete; + ValidatorInterface & operator=(ValidatorInterface &&) = delete; // Main filter method with context for plugin-specific data virtual tl::expected is_feasible( @@ -68,7 +68,7 @@ class SafetyFilterInterface std::string name_; std::shared_ptr vehicle_info_ptr_; }; -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin // NOLINTNEXTLINE #endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__SAFETY_FILTER_INTERFACE_HPP_ diff --git a/planning/autoware_trajectory_validator/launch/trajectory_validator.launch.xml b/planning/autoware_trajectory_validator/launch/trajectory_validator.launch.xml index 88ac22e05a5af..eade3d9b9ebe2 100644 --- a/planning/autoware_trajectory_validator/launch/trajectory_validator.launch.xml +++ b/planning/autoware_trajectory_validator/launch/trajectory_validator.launch.xml @@ -1,6 +1,6 @@ - + @@ -8,8 +8,8 @@ - - + + diff --git a/planning/autoware_trajectory_validator/package.xml b/planning/autoware_trajectory_validator/package.xml index e2cf4d9022bbd..81caf758cd213 100644 --- a/planning/autoware_trajectory_validator/package.xml +++ b/planning/autoware_trajectory_validator/package.xml @@ -1,9 +1,9 @@ - autoware_trajectory_safety_filter + autoware_trajectory_validator 0.1.0 - The autoware_trajectory_safety_filter package + The autoware_trajectory_validator package Daniel Sanchez Yukihiro Saito diff --git a/planning/autoware_trajectory_validator/param/parameter_struct.yaml b/planning/autoware_trajectory_validator/param/parameter_struct.yaml index 1e9a4446a9017..0751ee163a555 100644 --- a/planning/autoware_trajectory_validator/param/parameter_struct.yaml +++ b/planning/autoware_trajectory_validator/param/parameter_struct.yaml @@ -1,4 +1,4 @@ -safety_filter: +validator: filter_names: type: string_array default_value: [] diff --git a/planning/autoware_trajectory_validator/src/filters/collision_check_filter.cpp b/planning/autoware_trajectory_validator/src/filters/collision_check_filter.cpp index f79a4474854b9..8d0e06494f75b 100644 --- a/planning/autoware_trajectory_validator/src/filters/collision_check_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/collision_check_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/filters/collision_check_filter.hpp" +#include "autoware/trajectory_validator/filters/collision_check_filter.hpp" #include #include @@ -31,7 +31,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { namespace motion @@ -420,9 +420,9 @@ tl::expected CollisionCheckFilter::is_feasible( return {}; } -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #include PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_safety_filter::plugin::CollisionCheckFilter, - autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) + autoware::trajectory_validator::plugin::CollisionCheckFilter, + autoware::trajectory_validator::plugin::ValidatorInterface) diff --git a/planning/autoware_trajectory_validator/src/filters/collision_filter.cpp b/planning/autoware_trajectory_validator/src/filters/collision_filter.cpp index de8dda6503123..c3c3780e9be2a 100644 --- a/planning/autoware_trajectory_validator/src/filters/collision_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/collision_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/filters/collision_filter.hpp" +#include "autoware/trajectory_validator/filters/collision_filter.hpp" #include @@ -27,7 +27,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { namespace @@ -283,9 +283,9 @@ void CollisionFilter::update_parameters(const std::vector & p update_param(parameters, "collision.time", params_.max_check_time); update_param(parameters, "collision.min_value", params_.min_ttc); } -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #include PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_safety_filter::plugin::CollisionFilter, - autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) + autoware::trajectory_validator::plugin::CollisionFilter, + autoware::trajectory_validator::plugin::ValidatorInterface) diff --git a/planning/autoware_trajectory_validator/src/filters/out_of_lane_filter.cpp b/planning/autoware_trajectory_validator/src/filters/out_of_lane_filter.cpp index 98b7c1136ed3c..ddb915720bb0f 100644 --- a/planning/autoware_trajectory_validator/src/filters/out_of_lane_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/out_of_lane_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/filters/out_of_lane_filter.hpp" +#include "autoware/trajectory_validator/filters/out_of_lane_filter.hpp" #include @@ -24,7 +24,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { namespace @@ -60,7 +60,7 @@ autoware_internal_planning_msgs::msg::PathWithLaneId convert_to_path_with_lane_i } } // namespace -OutOfLaneFilter::OutOfLaneFilter() : SafetyFilterInterface("OutOfLaneFilter") +OutOfLaneFilter::OutOfLaneFilter() : ValidatorInterface("OutOfLaneFilter") { // BoundaryDepartureChecker will be initialized when vehicle_info is set } @@ -109,9 +109,9 @@ tl::expected OutOfLaneFilter::is_feasible( return {}; } -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #include PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_safety_filter::plugin::OutOfLaneFilter, - autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) + autoware::trajectory_validator::plugin::OutOfLaneFilter, + autoware::trajectory_validator::plugin::ValidatorInterface) diff --git a/planning/autoware_trajectory_validator/src/filters/uncrossable_boundary_departure_filter.cpp b/planning/autoware_trajectory_validator/src/filters/uncrossable_boundary_departure_filter.cpp index 387219c5aefa0..694085ddfbfca 100644 --- a/planning/autoware_trajectory_validator/src/filters/uncrossable_boundary_departure_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/uncrossable_boundary_departure_filter.cpp @@ -12,12 +12,12 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/filters/uncrossable_boundary_departure_filter.hpp" +#include "autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp" #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { tl::expected UncrossableBoundaryDepartureFilter::is_feasible( const TrajectoryPoints & traj_points, const FilterContext & context) @@ -64,9 +64,9 @@ std::optional UncrossableBoundaryDepartureFilter::is_invalid_input( return std::nullopt; } -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #include PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_safety_filter::plugin::UncrossableBoundaryDepartureFilter, - autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) + autoware::trajectory_validator::plugin::UncrossableBoundaryDepartureFilter, + autoware::trajectory_validator::plugin::ValidatorInterface) diff --git a/planning/autoware_trajectory_validator/src/filters/vehicle_constraint_filter.cpp b/planning/autoware_trajectory_validator/src/filters/vehicle_constraint_filter.cpp index 80686c5df6416..e42976ddeac0a 100644 --- a/planning/autoware_trajectory_validator/src/filters/vehicle_constraint_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/vehicle_constraint_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/filters/vehicle_constraint_filter.hpp" +#include "autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp" #include #include @@ -20,7 +20,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { namespace { @@ -90,7 +90,7 @@ double to_steering_rate( } // namespace VehicleConstraintFilter::VehicleConstraintFilter() -: SafetyFilterInterface("VehicleConstraintFilter") +: ValidatorInterface("VehicleConstraintFilter") { } @@ -260,9 +260,9 @@ bool is_steering_rate_ok( } return true; } -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin #include PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_safety_filter::plugin::VehicleConstraintFilter, - autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) + autoware::trajectory_validator::plugin::VehicleConstraintFilter, + autoware::trajectory_validator::plugin::ValidatorInterface) diff --git a/planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp b/planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp index a4e334a8ad93c..b59c2daabc312 100644 --- a/planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp +++ b/planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp @@ -12,10 +12,10 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/trajectory_safety_filter_node.hpp" +#include "autoware/trajectory_validator/trajectory_validator_node.hpp" -#include "autoware/trajectory_safety_filter/filter_context.hpp" -#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" +#include "autoware/trajectory_validator/filter_context.hpp" +#include "autoware/trajectory_validator/validator_interface.hpp" #include @@ -61,15 +61,15 @@ bool has_trajectory_from_generator( } } // namespace -namespace autoware::trajectory_safety_filter +namespace autoware::trajectory_validator { -TrajectorySafetyFilter::TrajectorySafetyFilter(const rclcpp::NodeOptions & options) -: Node{"trajectory_safety_filter_node", options}, - listener_{std::make_unique(get_node_parameters_interface())}, +TrajectoryValidator::TrajectoryValidator(const rclcpp::NodeOptions & options) +: Node{"trajectory_validator_node", options}, + listener_{std::make_unique(get_node_parameters_interface())}, plugin_loader_( - "autoware_trajectory_safety_filter", - "autoware::trajectory_safety_filter::plugin::SafetyFilterInterface"), + "autoware_trajectory_validator", + "autoware::trajectory_validator::plugin::ValidatorInterface"), vehicle_info_(autoware::vehicle_info_utils::VehicleInfoUtils(*this).getVehicleInfo()) { const auto filters = listener_->get_params().filter_names; @@ -79,11 +79,11 @@ TrajectorySafetyFilter::TrajectorySafetyFilter(const rclcpp::NodeOptions & optio sub_map_ = create_subscription( "~/input/lanelet2_map", rclcpp::QoS{1}.transient_local(), - std::bind(&TrajectorySafetyFilter::map_callback, this, std::placeholders::_1)); + std::bind(&TrajectoryValidator::map_callback, this, std::placeholders::_1)); sub_trajectories_ = create_subscription( "~/input/trajectories", 1, - std::bind(&TrajectorySafetyFilter::process, this, std::placeholders::_1)); + std::bind(&TrajectoryValidator::process, this, std::placeholders::_1)); pub_trajectories_ = create_publisher("~/output/trajectories", 1); @@ -93,10 +93,10 @@ TrajectorySafetyFilter::TrajectorySafetyFilter(const rclcpp::NodeOptions & optio std::make_shared(debug_processing_time_detail_pub_); set_param_res_ = this->add_on_set_parameters_callback( - std::bind(&TrajectorySafetyFilter::on_parameter, this, std::placeholders::_1)); + std::bind(&TrajectoryValidator::on_parameter, this, std::placeholders::_1)); } -void TrajectorySafetyFilter::process(const CandidateTrajectories::ConstSharedPtr msg) +void TrajectoryValidator::process(const CandidateTrajectories::ConstSharedPtr msg) { autoware_utils_debug::ScopedTimeTrack st(__func__, *time_keeper_); @@ -161,7 +161,7 @@ void TrajectorySafetyFilter::process(const CandidateTrajectories::ConstSharedPtr pub_trajectories_->publish(*filtered_msg); } -void TrajectorySafetyFilter::map_callback(const LaneletMapBin::ConstSharedPtr msg) +void TrajectoryValidator::map_callback(const LaneletMapBin::ConstSharedPtr msg) { autoware_utils_debug::ScopedTimeTrack st(__func__, *time_keeper_); @@ -169,7 +169,7 @@ void TrajectorySafetyFilter::map_callback(const LaneletMapBin::ConstSharedPtr ms lanelet::utils::conversion::fromBinMsg(*msg, lanelet_map_ptr_); } -void TrajectorySafetyFilter::load_metric(const std::string & name) +void TrajectoryValidator::load_metric(const std::string & name) { if (name == "") return; @@ -193,18 +193,18 @@ void TrajectorySafetyFilter::load_metric(const std::string & name) } catch (const pluginlib::CreateClassException & e) { RCLCPP_ERROR_STREAM( get_logger(), - "[safety_filter] createSharedInstance failed for '" << name << "': " << e.what()); + "[validator] createSharedInstance failed for '" << name << "': " << e.what()); } catch (const std::exception & e) { RCLCPP_ERROR_STREAM( - get_logger(), "[safety_filter] unexpected exception for '" << name << "': " << e.what()); + get_logger(), "[validator] unexpected exception for '" << name << "': " << e.what()); } } -void TrajectorySafetyFilter::unload_metric(const std::string & name) +void TrajectoryValidator::unload_metric(const std::string & name) { auto it = std::remove_if( plugins_.begin(), plugins_.end(), - [&](const std::shared_ptr & plugin) { + [&](const std::shared_ptr & plugin) { return plugin->get_name() == name; }); @@ -242,7 +242,7 @@ void TrajectoryValidator::update_diagnostic( diagnostics_interface_.publish(this->get_clock()->now()); } -rcl_interfaces::msg::SetParametersResult TrajectorySafetyFilter::on_parameter( +rcl_interfaces::msg::SetParametersResult TrajectoryValidator::on_parameter( const std::vector & parameters) { rcl_interfaces::msg::SetParametersResult result; @@ -262,7 +262,7 @@ rcl_interfaces::msg::SetParametersResult TrajectorySafetyFilter::on_parameter( return result; } -} // namespace autoware::trajectory_safety_filter +} // namespace autoware::trajectory_validator #include -RCLCPP_COMPONENTS_REGISTER_NODE(autoware::trajectory_safety_filter::TrajectorySafetyFilter) +RCLCPP_COMPONENTS_REGISTER_NODE(autoware::trajectory_validator::TrajectoryValidator) diff --git a/planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp index d4066c8d08e03..e96447032c30b 100644 --- a/planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp +++ b/planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp @@ -20,7 +20,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { class CollisionCheckFilterTest : public ::testing::Test @@ -227,4 +227,4 @@ TEST_F(CollisionCheckFilterTest, ObjectWillEnterPath) << "Error string did not contain 'constant_curvature_path'. Actual: " << error_msg; } -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin diff --git a/planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp index f0f8a304110f5..55255c0562538 100644 --- a/planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp +++ b/planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -// #include "autoware/trajectory_safety_filter/filters/collision_check_filter.cpp" +// #include "autoware/trajectory_validator/filters/collision_check_filter.cpp" #include "../..//src/filters/collision_check_filter.cpp" #include @@ -23,7 +23,7 @@ #include -namespace autoware::trajectory_safety_filter::plugin::constant_curvature_predictor +namespace autoware::trajectory_validator::plugin::constant_curvature_predictor { TEST(ConstantCurvaturePoseTrajectoryCalculatorTest, PoseToIsometry) @@ -216,4 +216,4 @@ TEST(ConstantCurvaturePoseTrajectoryCalculatorTest, ComputeTrajectory) } } -} // namespace autoware::trajectory_safety_filter::plugin::constant_curvature_predictor +} // namespace autoware::trajectory_validator::plugin::constant_curvature_predictor diff --git a/planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp index d56ace55c074c..5ba98e0502741 100644 --- a/planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp +++ b/planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -// #include "autoware/trajectory_safety_filter/filters/collision_check_filter.hpp" +// #include "autoware/trajectory_validator/filters/collision_check_filter.hpp" #include "../../src/filters/collision_check_filter.cpp" #include @@ -20,7 +20,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin::motion +namespace autoware::trajectory_validator::plugin::motion { class ComputeMotionProfile1dTest : public ::testing::Test { @@ -127,4 +127,4 @@ TEST_F(ComputeMotionProfile1dTest, LagLongerThanMaxTime) } } -} // namespace autoware::trajectory_safety_filter::plugin::motion +} // namespace autoware::trajectory_validator::plugin::motion diff --git a/planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp index c239f7e1b89f1..d88bb3deb4ed4 100644 --- a/planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp +++ b/planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -// #include "autoware/trajectory_safety_filter/filters/collision_check_filter.hpp" +// #include "autoware/trajectory_validator/filters/collision_check_filter.hpp" #include "../../src/filters/collision_check_filter.cpp" #include @@ -20,7 +20,7 @@ #include #include -namespace autoware::trajectory_safety_filter::plugin::polygon +namespace autoware::trajectory_validator::plugin::polygon { class PolygonCollisionTest : public ::testing::Test @@ -95,4 +95,4 @@ TEST_F(PolygonCollisionTest, CheckPathPolygonConvexCollision) EXPECT_TRUE(check_path_polygon_convex_collision(traj1_collide, traj2_collide)); } -} // namespace autoware::trajectory_safety_filter::plugin::polygon +} // namespace autoware::trajectory_validator::plugin::polygon diff --git a/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_validator_plugin.cpp b/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_validator_plugin.cpp index 11f4284c4824a..f5da10a814e9c 100644 --- a/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_validator_plugin.cpp +++ b/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_validator_plugin.cpp @@ -12,16 +12,16 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/safety_filter_interface.hpp" +#include "autoware/trajectory_validator/validator_interface.hpp" #include #include #include -namespace autoware::trajectory_safety_filter::plugin +namespace autoware::trajectory_validator::plugin { -class DummyFilter : public SafetyFilterInterface +class DummyFilter : public ValidatorInterface { struct DummyFilterParam { @@ -29,7 +29,7 @@ class DummyFilter : public SafetyFilterInterface }; public: - DummyFilter() : SafetyFilterInterface("DummyFilter") {} + DummyFilter() : ValidatorInterface("DummyFilter") {} tl::expected is_feasible( const TrajectoryPoints & traj_points, const FilterContext & /*context*/) final @@ -62,8 +62,8 @@ class DummyFilter : public SafetyFilterInterface private: DummyFilterParam params_; }; -} // namespace autoware::trajectory_safety_filter::plugin +} // namespace autoware::trajectory_validator::plugin PLUGINLIB_EXPORT_CLASS( - autoware::trajectory_safety_filter::plugin::DummyFilter, - autoware::trajectory_safety_filter::plugin::SafetyFilterInterface) + autoware::trajectory_validator::plugin::DummyFilter, + autoware::trajectory_validator::plugin::ValidatorInterface) diff --git a/planning/autoware_trajectory_validator/test/node/test_trajectory_validator_node.cpp b/planning/autoware_trajectory_validator/test/node/test_trajectory_validator_node.cpp index d16afb1fcd40e..3d5dd66dda4af 100644 --- a/planning/autoware_trajectory_validator/test/node/test_trajectory_validator_node.cpp +++ b/planning/autoware_trajectory_validator/test/node/test_trajectory_validator_node.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/trajectory_safety_filter_node.hpp" +#include "autoware/trajectory_validator/trajectory_validator_node.hpp" #include #include @@ -23,10 +23,10 @@ #include #include -namespace autoware::trajectory_safety_filter +namespace autoware::trajectory_validator { -class TrajectorySafetyFilterNodeTest : public ::testing::Test +class TrajectoryValidatorNodeTest : public ::testing::Test { protected: void SetUp() override @@ -34,7 +34,7 @@ class TrajectorySafetyFilterNodeTest : public ::testing::Test rclcpp::init(0, nullptr); node_options_.append_parameter_override( "filter_names", - std::vector{"autoware::trajectory_safety_filter::plugin::DummyFilter"}); + std::vector{"autoware::trajectory_validator::plugin::DummyFilter"}); node_options_.append_parameter_override("dummy.dummy_param", 0.0); const auto test_pkg_share = ament_index_cpp::get_package_share_directory("autoware_test_utils"); @@ -43,25 +43,25 @@ class TrajectorySafetyFilterNodeTest : public ::testing::Test autoware::test_utils::updateNodeOptions(node_options_, {vehicle_info_param_path}); - node_under_test_ = std::make_shared(node_options_); + node_under_test_ = std::make_shared(node_options_); test_node_ = std::make_shared("test_helper_node"); map_pub_ = test_node_->create_publisher( - "/trajectory_safety_filter_node/input/lanelet2_map", rclcpp::QoS{1}.transient_local()); + "/trajectory_validator_node/input/lanelet2_map", rclcpp::QoS{1}.transient_local()); odom_pub_ = test_node_->create_publisher( - "/trajectory_safety_filter_node/input/odometry", 1); + "/trajectory_validator_node/input/odometry", 1); accel_pub_ = test_node_->create_publisher( - "/trajectory_safety_filter_node/input/acceleration", 1); + "/trajectory_validator_node/input/acceleration", 1); obj_pub_ = test_node_->create_publisher( - "/trajectory_safety_filter_node/input/objects", 1); + "/trajectory_validator_node/input/objects", 1); traj_pub_ = test_node_->create_publisher( - "/trajectory_safety_filter_node/input/trajectories", 1); + "/trajectory_validator_node/input/trajectories", 1); output_sub_ = test_node_->create_subscription( - "/trajectory_safety_filter_node/output/trajectories", 1, + "/trajectory_validator_node/output/trajectories", 1, [this]( const autoware_internal_planning_msgs::msg::CandidateTrajectories::ConstSharedPtr msg) { last_output_ = msg; @@ -126,7 +126,7 @@ class TrajectorySafetyFilterNodeTest : public ::testing::Test rclcpp::NodeOptions node_options_; rclcpp::Node::SharedPtr test_node_; - std::shared_ptr node_under_test_; + std::shared_ptr node_under_test_; rclcpp::Publisher::SharedPtr map_pub_; rclcpp::Publisher::SharedPtr odom_pub_; @@ -140,7 +140,7 @@ class TrajectorySafetyFilterNodeTest : public ::testing::Test autoware_internal_planning_msgs::msg::CandidateTrajectories::ConstSharedPtr last_output_; }; -TEST_F(TrajectorySafetyFilterNodeTest, FiltersTrajectoriesViaPlugin) +TEST_F(TrajectoryValidatorNodeTest, FiltersTrajectoriesViaPlugin) { publish_context(); spin_until([] { return false; }, std::chrono::milliseconds(100)); @@ -160,7 +160,7 @@ TEST_F(TrajectorySafetyFilterNodeTest, FiltersTrajectoriesViaPlugin) EXPECT_EQ(last_output_->generator_info.front().generator_name.data, "SafePlanner"); } -TEST_F(TrajectorySafetyFilterNodeTest, UpdateParametersDynamically) +TEST_F(TrajectoryValidatorNodeTest, UpdateParametersDynamically) { publish_context(); spin_until([] { return false; }, std::chrono::milliseconds(100)); @@ -183,7 +183,7 @@ TEST_F(TrajectorySafetyFilterNodeTest, UpdateParametersDynamically) EXPECT_EQ(last_output_->candidate_trajectories.size(), 1u); } -TEST_F(TrajectorySafetyFilterNodeTest, HandlesPluginRejection) +TEST_F(TrajectoryValidatorNodeTest, HandlesPluginRejection) { publish_context(); spin_until([] { return false; }, std::chrono::milliseconds(100)); @@ -196,4 +196,4 @@ TEST_F(TrajectorySafetyFilterNodeTest, HandlesPluginRejection) ASSERT_TRUE(spin_until([this] { return last_output_ != nullptr; })); EXPECT_EQ(last_output_->candidate_trajectories.size(), 0u); } -} // namespace autoware::trajectory_safety_filter +} // namespace autoware::trajectory_validator diff --git a/planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp b/planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp index cd5526cf8f5c9..8e813bf01795b 100644 --- a/planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp +++ b/planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_safety_filter/filters/vehicle_constraint_filter.hpp" +#include "autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp" #include @@ -36,7 +36,7 @@ autoware_planning_msgs::msg::TrajectoryPoint create_trajectory_point( } } // namespace -namespace autoware::trajectory_safety_filter::plugin::testing +namespace autoware::trajectory_validator::plugin::testing { TEST(VehicleConstraintFilterTest, FeasibleWhenAllConstraintsSatisfied) { @@ -308,4 +308,4 @@ TEST(IsSteeringRateOkTest, FalseWhenAnySteeringRateAboveMax) EXPECT_FALSE(is_steering_rate_ok(traj_points, vehicle_info, max_steering_rate)); } -} // namespace autoware::trajectory_safety_filter::plugin::testing +} // namespace autoware::trajectory_validator::plugin::testing From 2a2d21c9adca9aaa8b53f3a06dc12a7d92cd3639 Mon Sep 17 00:00:00 2001 From: Zulfaqar Azmi Date: Mon, 9 Mar 2026 12:12:49 +0900 Subject: [PATCH 08/10] fix: rename in trajectory safety filter (remainder) Signed-off-by: Zulfaqar Azmi --- .../config/trajectory_validator.param.yaml | 20 ++++++++--------- .../autoware_trajectory_validator/plugins.xml | 22 +++++++++---------- .../test/dummy_plugin/dummy_plugins.xml | 6 ++--- 3 files changed, 24 insertions(+), 24 deletions(-) diff --git a/planning/autoware_trajectory_validator/config/trajectory_validator.param.yaml b/planning/autoware_trajectory_validator/config/trajectory_validator.param.yaml index 93f21ca3b651a..3aa30ee67a935 100644 --- a/planning/autoware_trajectory_validator/config/trajectory_validator.param.yaml +++ b/planning/autoware_trajectory_validator/config/trajectory_validator.param.yaml @@ -2,18 +2,18 @@ ros__parameters: filter_names: [ - "autoware::trajectory_safety_filter::plugin::OutOfLaneFilter", - "autoware::trajectory_safety_filter::plugin::CollisionFilter", - "autoware::trajectory_safety_filter::plugin::CollisionCheckFilter", - "autoware::trajectory_safety_filter::plugin::UncrossableBoundaryDepartureFilter", - "autoware::trajectory_safety_filter::plugin::VehicleConstraintFilter", + "autoware::trajectory_validator::plugin::OutOfLaneFilter", + "autoware::trajectory_validator::plugin::CollisionFilter", + "autoware::trajectory_validator::plugin::CollisionCheckFilter", + "autoware::trajectory_validator::plugin::UncrossableBoundaryDepartureFilter", + "autoware::trajectory_validator::plugin::VehicleConstraintFilter", ] # available filters: - # "autoware::trajectory_safety_filter::plugin::OutOfLaneFilter" - # "autoware::trajectory_safety_filter::plugin::CollisionFilter" - # "autoware::trajectory_safety_filter::plugin::CollisionCheckFilter" - # "autoware::trajectory_safety_filter::plugin::UncrossableBoundaryDepartureFilter" - # "autoware::trajectory_safety_filter::plugin::VehicleConstraintFilter" + # "autoware::trajectory_validator::plugin::OutOfLaneFilter" + # "autoware::trajectory_validator::plugin::CollisionFilter" + # "autoware::trajectory_validator::plugin::CollisionCheckFilter" + # "autoware::trajectory_validator::plugin::UncrossableBoundaryDepartureFilter" + # "autoware::trajectory_validator::plugin::VehicleConstraintFilter" out_of_lane: time: 2.0 diff --git a/planning/autoware_trajectory_validator/plugins.xml b/planning/autoware_trajectory_validator/plugins.xml index a9197d4e71735..5e4d6492012ce 100644 --- a/planning/autoware_trajectory_validator/plugins.xml +++ b/planning/autoware_trajectory_validator/plugins.xml @@ -1,31 +1,31 @@ - - + + Filters trajectories that go out of lane boundaries - + Filters trajectories based on Time To Collision (TTC) with predicted objects - + Filters trajectories that cross uncrossable boundaries - + Filters trajectories that violate vehicle constraints such as maximum speed, acceleration, and steering angle - + Filters trajectories based on collision checks with predicted objects diff --git a/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_plugins.xml b/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_plugins.xml index 433397d5eed61..15f5b710dd034 100644 --- a/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_plugins.xml +++ b/planning/autoware_trajectory_validator/test/dummy_plugin/dummy_plugins.xml @@ -1,7 +1,7 @@ - - + + A predictable dummy filter for testing the main node From 85977b6434a768e499cdf20927de505665b4d2ea Mon Sep 17 00:00:00 2001 From: Zulfaqar Azmi Date: Mon, 9 Mar 2026 13:34:29 +0900 Subject: [PATCH 09/10] fix: add folder Signed-off-by: Zulfaqar Azmi --- planning/autoware_trajectory_validator/CMakeLists.txt | 10 +++++----- .../filters/{ => safety}/collision_check_filter.hpp | 0 .../filters/{ => safety}/collision_filter.hpp | 0 .../filters/{ => safety}/out_of_lane_filter.hpp | 0 .../uncrossable_boundary_departure_filter.hpp | 0 .../filters/{ => safety}/vehicle_constraint_filter.hpp | 0 .../filters/{ => safety}/collision_check_filter.cpp | 2 +- .../src/filters/{ => safety}/collision_filter.cpp | 2 +- .../src/filters/{ => safety}/out_of_lane_filter.cpp | 2 +- .../uncrossable_boundary_departure_filter.cpp | 2 +- .../filters/{ => safety}/vehicle_constraint_filter.cpp | 2 +- .../test/collision_check_filter/test_collision.cpp | 2 +- .../test_constant_curvature_predictor.cpp | 4 ++-- .../test/collision_check_filter/test_motion.cpp | 4 ++-- .../test/collision_check_filter/test_polygon.cpp | 4 ++-- .../test/plugins/test_vehicle_constraint_filter.cpp | 2 +- 16 files changed, 18 insertions(+), 18 deletions(-) rename planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/{ => safety}/collision_check_filter.hpp (100%) rename planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/{ => safety}/collision_filter.hpp (100%) rename planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/{ => safety}/out_of_lane_filter.hpp (100%) rename planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/{ => safety}/uncrossable_boundary_departure_filter.hpp (100%) rename planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/{ => safety}/vehicle_constraint_filter.hpp (100%) rename planning/autoware_trajectory_validator/src/filters/{ => safety}/collision_check_filter.cpp (99%) rename planning/autoware_trajectory_validator/src/filters/{ => safety}/collision_filter.cpp (99%) rename planning/autoware_trajectory_validator/src/filters/{ => safety}/out_of_lane_filter.cpp (98%) rename planning/autoware_trajectory_validator/src/filters/{ => safety}/uncrossable_boundary_departure_filter.cpp (96%) rename planning/autoware_trajectory_validator/src/filters/{ => safety}/vehicle_constraint_filter.cpp (99%) diff --git a/planning/autoware_trajectory_validator/CMakeLists.txt b/planning/autoware_trajectory_validator/CMakeLists.txt index 19cde55922c45..943b98b2293b0 100644 --- a/planning/autoware_trajectory_validator/CMakeLists.txt +++ b/planning/autoware_trajectory_validator/CMakeLists.txt @@ -31,11 +31,11 @@ rclcpp_components_register_node(${PROJECT_NAME} ) ament_auto_add_library(autoware_trajectory_validator_plugins SHARED - src/filters/out_of_lane_filter.cpp - src/filters/collision_filter.cpp - src/filters/uncrossable_boundary_departure_filter.cpp - src/filters/vehicle_constraint_filter.cpp - src/filters/collision_check_filter.cpp + src/filters/safety/out_of_lane_filter.cpp + src/filters/safety/collision_filter.cpp + src/filters/safety/uncrossable_boundary_departure_filter.cpp + src/filters/safety/vehicle_constraint_filter.cpp + src/filters/safety/collision_check_filter.cpp ) target_link_libraries(autoware_trajectory_validator_plugins diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_check_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/collision_check_filter.hpp similarity index 100% rename from planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_check_filter.hpp rename to planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/collision_check_filter.hpp diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/collision_filter.hpp similarity index 100% rename from planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/collision_filter.hpp rename to planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/collision_filter.hpp diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/out_of_lane_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/out_of_lane_filter.hpp similarity index 100% rename from planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/out_of_lane_filter.hpp rename to planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/out_of_lane_filter.hpp diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/uncrossable_boundary_departure_filter.hpp similarity index 100% rename from planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp rename to planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/uncrossable_boundary_departure_filter.hpp diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/vehicle_constraint_filter.hpp similarity index 100% rename from planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp rename to planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/vehicle_constraint_filter.hpp diff --git a/planning/autoware_trajectory_validator/src/filters/collision_check_filter.cpp b/planning/autoware_trajectory_validator/src/filters/safety/collision_check_filter.cpp similarity index 99% rename from planning/autoware_trajectory_validator/src/filters/collision_check_filter.cpp rename to planning/autoware_trajectory_validator/src/filters/safety/collision_check_filter.cpp index 8d0e06494f75b..2ba975d35acc3 100644 --- a/planning/autoware_trajectory_validator/src/filters/collision_check_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/safety/collision_check_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_validator/filters/collision_check_filter.hpp" +#include "autoware/trajectory_validator/filters/safety/collision_check_filter.hpp" #include #include diff --git a/planning/autoware_trajectory_validator/src/filters/collision_filter.cpp b/planning/autoware_trajectory_validator/src/filters/safety/collision_filter.cpp similarity index 99% rename from planning/autoware_trajectory_validator/src/filters/collision_filter.cpp rename to planning/autoware_trajectory_validator/src/filters/safety/collision_filter.cpp index c3c3780e9be2a..f5b381a234366 100644 --- a/planning/autoware_trajectory_validator/src/filters/collision_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/safety/collision_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_validator/filters/collision_filter.hpp" +#include "autoware/trajectory_validator/filters/safety/collision_filter.hpp" #include diff --git a/planning/autoware_trajectory_validator/src/filters/out_of_lane_filter.cpp b/planning/autoware_trajectory_validator/src/filters/safety/out_of_lane_filter.cpp similarity index 98% rename from planning/autoware_trajectory_validator/src/filters/out_of_lane_filter.cpp rename to planning/autoware_trajectory_validator/src/filters/safety/out_of_lane_filter.cpp index ddb915720bb0f..9810ef7b3392a 100644 --- a/planning/autoware_trajectory_validator/src/filters/out_of_lane_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/safety/out_of_lane_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_validator/filters/out_of_lane_filter.hpp" +#include "autoware/trajectory_validator/filters/safety/out_of_lane_filter.hpp" #include diff --git a/planning/autoware_trajectory_validator/src/filters/uncrossable_boundary_departure_filter.cpp b/planning/autoware_trajectory_validator/src/filters/safety/uncrossable_boundary_departure_filter.cpp similarity index 96% rename from planning/autoware_trajectory_validator/src/filters/uncrossable_boundary_departure_filter.cpp rename to planning/autoware_trajectory_validator/src/filters/safety/uncrossable_boundary_departure_filter.cpp index 694085ddfbfca..68687b0354bdc 100644 --- a/planning/autoware_trajectory_validator/src/filters/uncrossable_boundary_departure_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/safety/uncrossable_boundary_departure_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_validator/filters/uncrossable_boundary_departure_filter.hpp" +#include "autoware/trajectory_validator/filters/safety/uncrossable_boundary_departure_filter.hpp" #include #include diff --git a/planning/autoware_trajectory_validator/src/filters/vehicle_constraint_filter.cpp b/planning/autoware_trajectory_validator/src/filters/safety/vehicle_constraint_filter.cpp similarity index 99% rename from planning/autoware_trajectory_validator/src/filters/vehicle_constraint_filter.cpp rename to planning/autoware_trajectory_validator/src/filters/safety/vehicle_constraint_filter.cpp index e42976ddeac0a..727142d1290b5 100644 --- a/planning/autoware_trajectory_validator/src/filters/vehicle_constraint_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/safety/vehicle_constraint_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp" +#include "autoware/trajectory_validator/filters/safety/vehicle_constraint_filter.hpp" #include #include diff --git a/planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp index e96447032c30b..872d0f516b5a4 100644 --- a/planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp +++ b/planning/autoware_trajectory_validator/test/collision_check_filter/test_collision.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "../..//src/filters/collision_check_filter.cpp" +#include "../..//src/filters/safety/collision_check_filter.cpp" #include diff --git a/planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp index 55255c0562538..0e956a59ab3e9 100644 --- a/planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp +++ b/planning/autoware_trajectory_validator/test/collision_check_filter/test_constant_curvature_predictor.cpp @@ -12,8 +12,8 @@ // See the License for the specific language governing permissions and // limitations under the License. -// #include "autoware/trajectory_validator/filters/collision_check_filter.cpp" -#include "../..//src/filters/collision_check_filter.cpp" +// #include "autoware/trajectory_validator/filters/safety/collision_check_filter.cpp" +#include "../..//src/filters/safety/collision_check_filter.cpp" #include diff --git a/planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp index 5ba98e0502741..d1e1a16a5fa60 100644 --- a/planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp +++ b/planning/autoware_trajectory_validator/test/collision_check_filter/test_motion.cpp @@ -12,8 +12,8 @@ // See the License for the specific language governing permissions and // limitations under the License. -// #include "autoware/trajectory_validator/filters/collision_check_filter.hpp" -#include "../../src/filters/collision_check_filter.cpp" +// #include "autoware/trajectory_validator/filters/safety/collision_check_filter.hpp" +#include "../../src/filters/safety/collision_check_filter.cpp" #include diff --git a/planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp b/planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp index d88bb3deb4ed4..978dcfba4a81c 100644 --- a/planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp +++ b/planning/autoware_trajectory_validator/test/collision_check_filter/test_polygon.cpp @@ -12,8 +12,8 @@ // See the License for the specific language governing permissions and // limitations under the License. -// #include "autoware/trajectory_validator/filters/collision_check_filter.hpp" -#include "../../src/filters/collision_check_filter.cpp" +// #include "autoware/trajectory_validator/filters/safety/collision_check_filter.hpp" +#include "../../src/filters/safety/collision_check_filter.cpp" #include diff --git a/planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp b/planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp index 8e813bf01795b..fb275c961b9df 100644 --- a/planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp +++ b/planning/autoware_trajectory_validator/test/plugins/test_vehicle_constraint_filter.cpp @@ -12,7 +12,7 @@ // See the License for the specific language governing permissions and // limitations under the License. -#include "autoware/trajectory_validator/filters/vehicle_constraint_filter.hpp" +#include "autoware/trajectory_validator/filters/safety/vehicle_constraint_filter.hpp" #include From 6436f8ddadf604651d6214f2ffb7566b1e39cd8a Mon Sep 17 00:00:00 2001 From: Zulfaqar Azmi Date: Mon, 9 Mar 2026 13:35:30 +0900 Subject: [PATCH 10/10] chore: precommit Signed-off-by: Zulfaqar Azmi --- .../autoware/trajectory_validator/filter_context.hpp | 6 +++--- .../filters/safety/collision_check_filter.hpp | 6 +++--- .../filters/safety/collision_filter.hpp | 6 +++--- .../filters/safety/out_of_lane_filter.hpp | 6 +++--- .../safety/uncrossable_boundary_departure_filter.hpp | 10 ++++------ .../filters/safety/vehicle_constraint_filter.hpp | 6 +++--- .../trajectory_validator/trajectory_validator_node.hpp | 6 +++--- .../trajectory_validator/validator_interface.hpp | 6 +++--- .../src/filters/safety/vehicle_constraint_filter.cpp | 3 +-- .../src/trajectory_validator_node.cpp | 6 ++---- 10 files changed, 28 insertions(+), 33 deletions(-) diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp index 265b1df8ea3a6..f6e8d088fe3b7 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filter_context.hpp @@ -12,8 +12,8 @@ // See the License for the specific language governing permissions and // limitations under the License. -#ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTER_CONTEXT_HPP_ -#define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTER_CONTEXT_HPP_ +#ifndef AUTOWARE__TRAJECTORY_VALIDATOR__FILTER_CONTEXT_HPP_ +#define AUTOWARE__TRAJECTORY_VALIDATOR__FILTER_CONTEXT_HPP_ #include #include @@ -42,4 +42,4 @@ struct FilterContext }; } // namespace autoware::trajectory_validator -#endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTER_CONTEXT_HPP_ +#endif // AUTOWARE__TRAJECTORY_VALIDATOR__FILTER_CONTEXT_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/collision_check_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/collision_check_filter.hpp index a9fc8b9db7005..126e7829388e2 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/collision_check_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/collision_check_filter.hpp @@ -12,8 +12,8 @@ // See the License for the specific language governing permissions and // limitations under the License. -#ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_CHECK_FILTER_HPP_ -#define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_CHECK_FILTER_HPP_ +#ifndef AUTOWARE__TRAJECTORY_VALIDATOR__FILTERS__SAFETY__COLLISION_CHECK_FILTER_HPP_ +#define AUTOWARE__TRAJECTORY_VALIDATOR__FILTERS__SAFETY__COLLISION_CHECK_FILTER_HPP_ #include "autoware/trajectory_validator/validator_interface.hpp" @@ -153,4 +153,4 @@ class CollisionCheckFilter : public ValidatorInterface } // namespace autoware::trajectory_validator::plugin -#endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_CHECK_FILTER_HPP_ +#endif // AUTOWARE__TRAJECTORY_VALIDATOR__FILTERS__SAFETY__COLLISION_CHECK_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/collision_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/collision_filter.hpp index f4c9c8d4180c5..fc36855a80f28 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/collision_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/collision_filter.hpp @@ -12,8 +12,8 @@ // See the License for the specific language governing permissions and // limitations under the License. -#ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_FILTER_HPP_ -#define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_FILTER_HPP_ +#ifndef AUTOWARE__TRAJECTORY_VALIDATOR__FILTERS__SAFETY__COLLISION_FILTER_HPP_ +#define AUTOWARE__TRAJECTORY_VALIDATOR__FILTERS__SAFETY__COLLISION_FILTER_HPP_ #include "autoware/trajectory_validator/validator_interface.hpp" @@ -73,4 +73,4 @@ class CollisionFilter : public ValidatorInterface } // namespace autoware::trajectory_validator::plugin -#endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__COLLISION_FILTER_HPP_ +#endif // AUTOWARE__TRAJECTORY_VALIDATOR__FILTERS__SAFETY__COLLISION_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/out_of_lane_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/out_of_lane_filter.hpp index 957570ee247ec..d3c0f4f6d9221 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/out_of_lane_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/out_of_lane_filter.hpp @@ -12,8 +12,8 @@ // See the License for the specific language governing permissions and // limitations under the License. -#ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__OUT_OF_LANE_FILTER_HPP_ -#define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__OUT_OF_LANE_FILTER_HPP_ +#ifndef AUTOWARE__TRAJECTORY_VALIDATOR__FILTERS__SAFETY__OUT_OF_LANE_FILTER_HPP_ +#define AUTOWARE__TRAJECTORY_VALIDATOR__FILTERS__SAFETY__OUT_OF_LANE_FILTER_HPP_ #include "autoware/trajectory_validator/validator_interface.hpp" @@ -57,4 +57,4 @@ class OutOfLaneFilter : public ValidatorInterface }; } // namespace autoware::trajectory_validator::plugin -#endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__OUT_OF_LANE_FILTER_HPP_ +#endif // AUTOWARE__TRAJECTORY_VALIDATOR__FILTERS__SAFETY__OUT_OF_LANE_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/uncrossable_boundary_departure_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/uncrossable_boundary_departure_filter.hpp index 2e76b8ddb8bfd..074536b05061f 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/uncrossable_boundary_departure_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/uncrossable_boundary_departure_filter.hpp @@ -12,8 +12,8 @@ // See the License for the specific language governing permissions and // limitations under the License. -#ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__UNCROSSABLE_BOUNDARY_DEPARTURE_FILTER_HPP_ -#define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__UNCROSSABLE_BOUNDARY_DEPARTURE_FILTER_HPP_ +#ifndef AUTOWARE__TRAJECTORY_VALIDATOR__FILTERS__SAFETY__UNCROSSABLE_BOUNDARY_DEPARTURE_FILTER_HPP_ +#define AUTOWARE__TRAJECTORY_VALIDATOR__FILTERS__SAFETY__UNCROSSABLE_BOUNDARY_DEPARTURE_FILTER_HPP_ #include "autoware/trajectory_validator/validator_interface.hpp" @@ -29,9 +29,7 @@ namespace autoware::trajectory_validator::plugin class UncrossableBoundaryDepartureFilter : public ValidatorInterface { public: - UncrossableBoundaryDepartureFilter() : ValidatorInterface("UncrossableBoundaryDepartureFilter") - { - } + UncrossableBoundaryDepartureFilter() : ValidatorInterface("UncrossableBoundaryDepartureFilter") {} tl::expected is_feasible( const TrajectoryPoints & traj_points, const FilterContext & context) final; @@ -67,4 +65,4 @@ class UncrossableBoundaryDepartureFilter : public ValidatorInterface }; } // namespace autoware::trajectory_validator::plugin -#endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__UNCROSSABLE_BOUNDARY_DEPARTURE_FILTER_HPP_ +#endif // AUTOWARE__TRAJECTORY_VALIDATOR__FILTERS__SAFETY__UNCROSSABLE_BOUNDARY_DEPARTURE_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/vehicle_constraint_filter.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/vehicle_constraint_filter.hpp index d662e5fcdb3a5..20d73042a6fee 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/vehicle_constraint_filter.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/filters/safety/vehicle_constraint_filter.hpp @@ -12,8 +12,8 @@ // See the License for the specific language governing permissions and // limitations under the License. -#ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__VEHICLE_CONSTRAINT_FILTER_HPP_ -#define AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__VEHICLE_CONSTRAINT_FILTER_HPP_ +#ifndef AUTOWARE__TRAJECTORY_VALIDATOR__FILTERS__SAFETY__VEHICLE_CONSTRAINT_FILTER_HPP_ +#define AUTOWARE__TRAJECTORY_VALIDATOR__FILTERS__SAFETY__VEHICLE_CONSTRAINT_FILTER_HPP_ #include "autoware/trajectory_validator/validator_interface.hpp" @@ -123,4 +123,4 @@ bool is_steering_angle_ok( bool is_steering_rate_ok( const TrajectoryPoints & traj_points, const VehicleInfo & vehicle_info, double max_steering_rate); } // namespace autoware::trajectory_validator::plugin -#endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__FILTERS__VEHICLE_CONSTRAINT_FILTER_HPP_ +#endif // AUTOWARE__TRAJECTORY_VALIDATOR__FILTERS__SAFETY__VEHICLE_CONSTRAINT_FILTER_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp index 416d212186acd..ce8a5407ea06d 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/trajectory_validator_node.hpp @@ -12,8 +12,8 @@ // See the License for the specific language governing permissions and // limitations under the License. -#ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__TRAJECTORY_SAFETY_FILTER_NODE_HPP_ -#define AUTOWARE__TRAJECTORY_SAFETY_FILTER__TRAJECTORY_SAFETY_FILTER_NODE_HPP_ +#ifndef AUTOWARE__TRAJECTORY_VALIDATOR__TRAJECTORY_VALIDATOR_NODE_HPP_ +#define AUTOWARE__TRAJECTORY_VALIDATOR__TRAJECTORY_VALIDATOR_NODE_HPP_ #include "autoware/trajectory_validator/validator_interface.hpp" @@ -106,4 +106,4 @@ class TrajectoryValidator : public rclcpp::Node } // namespace autoware::trajectory_validator -#endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__TRAJECTORY_SAFETY_FILTER_NODE_HPP_ +#endif // AUTOWARE__TRAJECTORY_VALIDATOR__TRAJECTORY_VALIDATOR_NODE_HPP_ diff --git a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp index 6dd99fe83e349..fe7e6aa2b22b9 100644 --- a/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp +++ b/planning/autoware_trajectory_validator/include/autoware/trajectory_validator/validator_interface.hpp @@ -12,8 +12,8 @@ // See the License for the specific language governing permissions and // limitations under the License. -#ifndef AUTOWARE__TRAJECTORY_SAFETY_FILTER__SAFETY_FILTER_INTERFACE_HPP_ -#define AUTOWARE__TRAJECTORY_SAFETY_FILTER__SAFETY_FILTER_INTERFACE_HPP_ +#ifndef AUTOWARE__TRAJECTORY_VALIDATOR__VALIDATOR_INTERFACE_HPP_ +#define AUTOWARE__TRAJECTORY_VALIDATOR__VALIDATOR_INTERFACE_HPP_ #include "autoware/trajectory_validator/filter_context.hpp" @@ -71,4 +71,4 @@ class ValidatorInterface } // namespace autoware::trajectory_validator::plugin // NOLINTNEXTLINE -#endif // AUTOWARE__TRAJECTORY_SAFETY_FILTER__SAFETY_FILTER_INTERFACE_HPP_ +#endif // AUTOWARE__TRAJECTORY_VALIDATOR__VALIDATOR_INTERFACE_HPP_ diff --git a/planning/autoware_trajectory_validator/src/filters/safety/vehicle_constraint_filter.cpp b/planning/autoware_trajectory_validator/src/filters/safety/vehicle_constraint_filter.cpp index 727142d1290b5..c73924a17f264 100644 --- a/planning/autoware_trajectory_validator/src/filters/safety/vehicle_constraint_filter.cpp +++ b/planning/autoware_trajectory_validator/src/filters/safety/vehicle_constraint_filter.cpp @@ -89,8 +89,7 @@ double to_steering_rate( } } // namespace -VehicleConstraintFilter::VehicleConstraintFilter() -: ValidatorInterface("VehicleConstraintFilter") +VehicleConstraintFilter::VehicleConstraintFilter() : ValidatorInterface("VehicleConstraintFilter") { } diff --git a/planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp b/planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp index b59c2daabc312..08d143983295e 100644 --- a/planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp +++ b/planning/autoware_trajectory_validator/src/trajectory_validator_node.cpp @@ -68,8 +68,7 @@ TrajectoryValidator::TrajectoryValidator(const rclcpp::NodeOptions & options) : Node{"trajectory_validator_node", options}, listener_{std::make_unique(get_node_parameters_interface())}, plugin_loader_( - "autoware_trajectory_validator", - "autoware::trajectory_validator::plugin::ValidatorInterface"), + "autoware_trajectory_validator", "autoware::trajectory_validator::plugin::ValidatorInterface"), vehicle_info_(autoware::vehicle_info_utils::VehicleInfoUtils(*this).getVehicleInfo()) { const auto filters = listener_->get_params().filter_names; @@ -192,8 +191,7 @@ void TrajectoryValidator::load_metric(const std::string & name) get_logger(), "The scene plugin '" << name << "' is loaded and initialized."); } catch (const pluginlib::CreateClassException & e) { RCLCPP_ERROR_STREAM( - get_logger(), - "[validator] createSharedInstance failed for '" << name << "': " << e.what()); + get_logger(), "[validator] createSharedInstance failed for '" << name << "': " << e.what()); } catch (const std::exception & e) { RCLCPP_ERROR_STREAM( get_logger(), "[validator] unexpected exception for '" << name << "': " << e.what());