feat(radar_static_pointcloud_filter): add radar_static_pointcloud_filter package

sensing/radar_static_pointcloud_filter/CMakeLists.txt

@@ -0,0 +1,41 @@
+cmake_minimum_required(VERSION 3.5)
+project(radar_static_pointcloud_filter)
+
+# Compile options
+if(NOT CMAKE_CXX_STANDARD)
+  set(CMAKE_CXX_STANDARD 17)
+  set(CMAKE_CXX_STANDARD_REQUIRED ON)
+  set(CMAKE_CXX_EXTENSIONS OFF)
+endif()
+
+if(CMAKE_COMPILER_IS_GNUCXX OR CMAKE_CXX_COMPILER_ID MATCHES "Clang")
+  add_compile_options(-Wall -Wextra -Wpedantic)
+endif()
+
+# Dependencies
+find_package(ament_cmake_auto REQUIRED)
+ament_auto_find_build_dependencies()
+
+# Targets
+ament_auto_add_library(radar_static_pointcloud_filter_node_component SHARED
+  src/radar_static_pointcloud_filter_node/radar_static_pointcloud_filter_node.cpp
+)
+
+rclcpp_components_register_node(radar_static_pointcloud_filter_node_component
+  PLUGIN "radar_static_pointcloud_filter::RadarStaticPointcloudFilterNode"
+  EXECUTABLE radar_static_pointcloud_filter_node
+)
+
+# Tests
+if(BUILD_TESTING)
+  list(APPEND AMENT_LINT_AUTO_EXCLUDE ament_cmake_uncrustify)
+
+  find_package(ament_lint_auto REQUIRED)
+  ament_lint_auto_find_test_dependencies()
+endif()
+
+# Package
+ament_auto_package(
+  INSTALL_TO_SHARE
+  launch
+)

sensing/radar_static_pointcloud_filter/README.md

@@ -0,0 +1,36 @@
+# radar_static_pointcloud_filter
+
+## radar_static_pointcloud_filter_node
+
+Extract static/dynamic radar pointcloud by using doppler velocity and ego motion.
+Calculation cost is O(n). `n` is the number of radar pointcloud.
+
+### Input topics
+
+| Name           | Type                       | Description                |
+| -------------- | -------------------------- | -------------------------- |
+| input/radar    | radar_msgs::msg::RadarScan | RadarScan                  |
+| input/odometry | nav_msgs::msg::Odometry    | Ego vehicle odometry topic |
+
+### Output topics
+
+| Name                      | Type                       | Description              |
+| ------------------------- | -------------------------- | ------------------------ |
+| output/static_radar_scan  | radar_msgs::msg::RadarScan | static radar pointcloud  |
+| output/dynamic_radar_scan | radar_msgs::msg::RadarScan | dynamic radar pointcloud |
+
+### Parameters
+
+| Name                | Type   | Description                                          |
+| ------------------- | ------ | ---------------------------------------------------- |
+| doppler_velocity_sd | double | Standard deviation for radar doppler velocity. [m/s] |
+
+### How to launch
+
+```sh
+ros2 launch radar_static_pointcloud_filter radar_static_pointcloud_filter.launch
+```
+
+### Algorithm
+
+![algorithm](docs/radar_static_pointcloud_filter.drawio.svg)