Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

Sign up for GitHub

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

feat(tier4_perception_launch): add radar far object integration in tracking stage #5269

Merged
merged 11 commits into from
Oct 16, 2023
Merged

feat(tier4_perception_launch): add radar far object integration in tracking stage #5269

Show file tree
Hide file tree
Changes from 5 commits
Commits
Show all changes
11 commits
Select commit Hold shift + click to select a range
0ab2c2e
update tracking/perception launch
YoshiRi Jul 21, 2023
abf7925
switch tracker launcher mode with argument
YoshiRi Jul 23, 2023
e219860
update prediction to switch by radar_long_range_integration paramter
YoshiRi Oct 11, 2023
6116a99
make radar far object integration switchable between detection/tracking
YoshiRi Oct 11, 2023
08c305a
fix camera lidar radar fusion flow when 'tracking' is used.
YoshiRi Oct 11, 2023
5468d1e
fix spelling and appearance
YoshiRi Oct 12, 2023
4f8b63c
reconstruct topic flow when use tracking to merge far object detectio…
YoshiRi Oct 12, 2023
92b2897
fix input topic miss in tracking.launch
YoshiRi Oct 12, 2023
d3d5e3d
fix comment in camera_lidar_radar fusion
YoshiRi Oct 16, 2023
c1e95dc
refactor: rename and remove paramters in prediction.launch
YoshiRi Oct 16, 2023
d5445dc
refactor: rename merger control variable from string to bool
YoshiRi Oct 16, 2023
File filter

Filter by extension

Filter by extension
Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
31 changes: 19 additions & 12 deletions .../launch/object_recognition/detection/camera_lidar_radar_fusion_based_detection.launch.xml
View file
Open in desktop
Original file line number Diff line number Diff line change
Expand Up @@ -388,31 +388,38 @@
</include>
</group>

<!-- Switch filter output name by 'radar_long_range_integration' parameter defined in perception.launch -->
YoshiRi marked this conversation as resolved.
Show resolved Hide resolved
<let name="output_of_filtered_objects" value="$(var output/objects)" if="$(eval &quot; '$(var radar_long_range_integration)'=='tracking' &quot;)"/>
<let name="output_of_filtered_objects" value="near_objects" unless="$(eval &quot; '$(var radar_long_range_integration)'=='tracking' &quot;)"/>

<!-- Filter -->
<group if="$(eval &quot;'$(var objects_filter_method)'=='lanelet_filter'&quot;)">
<include file="$(find-pkg-share detected_object_validation)/launch/object_lanelet_filter.launch.xml" if="$(var use_object_filter)">
<arg name="input/object" value="objects_before_filter"/>
<arg name="output/object" value="near_objects"/>
<arg name="output/object" value="$(var output_of_filtered_objects)"/>
<arg name="filtering_range_param" value="$(var object_recognition_detection_object_lanelet_filter_param_path)"/>
</include>
</group>

<group if="$(eval &quot;'$(var objects_filter_method)'=='position_filter'&quot;)">
<include file="$(find-pkg-share detected_object_validation)/launch/object_position_filter.launch.xml" if="$(var use_object_filter)">
<arg name="input/object" value="objects_before_filter"/>
<arg name="output/object" value="near_objects"/>
<arg name="output/object" value="$(var output_of_filtered_objects)"/>
<arg name="filtering_range_param" value="$(var object_recognition_detection_object_position_filter_param_path)"/>
</include>
</group>

<!-- Merge far_objects and near_objects. This merger will be removed after tracking fusion operates stably. -->
<include file="$(find-pkg-share object_merger)/launch/object_association_merger.launch.xml">
<arg name="input/object0" value="near_objects"/>
<arg name="input/object1" value="radar/far_objects"/>
<arg name="output/object" value="$(var output/objects)"/>
<arg name="priority_mode" value="0"/>
<arg name="data_association_matrix_path" value="$(var object_recognition_detection_object_merger_data_association_matrix_param_path)"/>
<arg name="distance_threshold_list_path" value="$(var object_recognition_detection_object_merger_distance_threshold_list_path)"/>
<arg name="sync_queue_size" value="$(var far_object_merger_sync_queue_size)"/>
</include>
<!-- 'radar_long_range_integration' should defined in perception.launch -->
<group if="$(eval &quot;'$(var radar_long_range_integration)'=='detection'&quot;)">
<!-- Merge far_objects and near_objects. This merger will be removed after tracking fusion operates stably. -->
miursh marked this conversation as resolved.
Show resolved Hide resolved
<include file="$(find-pkg-share object_merger)/launch/object_association_merger.launch.xml">
<arg name="input/object0" value="near_objects"/>
<arg name="input/object1" value="radar/far_objects"/>
<arg name="output/object" value="$(var output/objects)"/>
<arg name="priority_mode" value="0"/>
<arg name="data_association_matrix_path" value="$(var object_recognition_detection_object_merger_data_association_matrix_param_path)"/>
<arg name="distance_threshold_list_path" value="$(var object_recognition_detection_object_merger_distance_threshold_list_path)"/>
<arg name="sync_queue_size" value="$(var far_object_merger_sync_queue_size)"/>
</include>
</group>
</launch>
9 changes: 9 additions & 0 deletions launch/tier4_perception_launch/launch/object_recognition/prediction/prediction.launch.xml
View file
Open in desktop
Original file line number Diff line number Diff line change
Expand Up @@ -3,10 +3,19 @@
<arg name="use_vector_map" default="false" description="use vector map in prediction"/>
<arg name="param_path" default="$(find-pkg-share map_based_prediction)/config/map_based_prediction.param.yaml"/>

<!-- "radar_long_range_integration" controls wheather to join radar far tracking objects to lidar tracking objects.

Check warning on line 6 in launch/tier4_perception_launch/launch/object_recognition/prediction/prediction.launch.xml

View workflow job for this annotation

GitHub Actions / spell-check-differential 

Unknown word (wheather)

Check warning on line 6 in launch/tier4_perception_launch/launch/object_recognition/prediction/prediction.launch.xml

View workflow job for this annotation

GitHub Actions / spell-check-partial 

Unknown word (wheather)
YoshiRi marked this conversation as resolved.
Show resolved Hide resolved
Prediction input will changed to merged tracking objects if "radar_long_range_integration" is 'tracking'. -->
<arg name="radar_long_range_integration" default="detection" description="integration method for radar long range information. Following args are used only if this parameter is set to tracking"/>
<arg name="default_tracking_objects" default="/perception/object_recognition/tracking/objects"/>
<arg name="merged_tracking_objects" default="/perception/object_recognition/tracking/merged/objects"/>
<let name="input_topic_to_prediction" value="$(var merged_tracking_objects)" if="$(eval &quot;'$(var radar_long_range_integration)'=='tracking'&quot;)"/>
<let name="input_topic_to_prediction" value="$(var default_tracking_objects)" unless="$(eval &quot;'$(var radar_long_range_integration)'=='tracking'&quot;)"/>

<group if="$(var use_vector_map)">
<set_remap from="objects" to="/perception/object_recognition/objects"/>
<include file="$(find-pkg-share map_based_prediction)/launch/map_based_prediction.launch.xml">
<arg name="output_topic" value="/perception/object_recognition/objects"/>
<arg name="input_topic" value="$(var input_topic_to_prediction)"/>
<arg name="param_path" value="$(var object_recognition_prediction_map_based_prediction_param_path)"/>
</include>
</group>
Expand Down
24 changes: 20 additions & 4 deletions launch/tier4_perception_launch/launch/object_recognition/tracking/tracking.launch.xml
View file
Open in desktop
Original file line number Diff line number Diff line change
Expand Up @@ -3,8 +3,16 @@
<arg name="mode" default="lidar" description="options: `camera_lidar_radar_fusion`, `camera_lidar_fusion`, `lidar_radar_fusion`, `lidar` or `radar`"/>
<arg name="publish_rate" default="10.0"/>
<arg name="enable_delay_compensation" default="true"/>

<!-- Radar Tracking and Merger parameters -->
<arg name="radar_long_range_integration" default="detection" description="integration method for radar long range information. Following args are used only if this parameter is set to 'tracking'"/>
<arg name="radar_tracker_input" default="/perception/object_recognition/detection/radar/far_objects"/>
<arg name="radar_tracker_output" default="/perception/object_recognition/tracking/radar/far_objects"/>
<arg name="object_recognition_tracking_radar_object_tracker_data_association_matrix_param_path" description="association param file for radar far object tracking"/>
<arg name="object_recognition_tracking_radar_object_tracker_tracking_setting_param_path" description="tracking setting param file for radar far object tracking"/>
<arg name="object_recognition_tracking_radar_object_tracker_node_param_path" description="node param file for radar far object tracking"/>
<arg name="object_recognition_tracking_object_merger_data_association_matrix_param_path" description="association param file for radar and lidar object merger"/>
<arg name="object_recognition_tracking_object_merger_node_param_path" description="node param file for radar and lidar object merger"/>

<group>
<!--multi object tracking-->
Expand All @@ -14,9 +22,9 @@
<arg name="enable_delay_compensation" value="$(var enable_delay_compensation)"/>
</include>

<!--radar long range dynamic object tracking if mode contains radar input-->
<!--
<group if="$(eval '&quot;$(var mode)&quot;==&quot;radar&quot; or &quot;$(var mode)&quot;==&quot;lidar_radar_fusion&quot; or &quot;$(var mode)&quot;==&quot;camera_lidar_radar_fusion&quot;')">
<!-- add radar long range tracking and merger node if integration parameter is set to tracking -->
<group if="$(eval &quot;'$(var radar_long_range_integration)'=='tracking'&quot;)">
<!--radar long range dynamic object tracking-->
<include file="$(find-pkg-share radar_object_tracker)/launch/radar_object_tracker.launch.xml">
<arg name="publish_rate" value="$(var publish_rate)"/>
<arg name="enable_delay_compensation" value="$(var enable_delay_compensation)"/>
Expand All @@ -25,7 +33,15 @@
<arg name="data_association_matrix_path" value="$(var object_recognition_tracking_radar_object_tracker_data_association_matrix_param_path)"/>
<arg name="tracker_setting_path" value="$(var object_recognition_tracking_radar_object_tracker_tracking_setting_param_path)"/>
</include>

<!--radar long range dynamic object tracking merger-->
<include file="$(find-pkg-share tracking_object_merger)/launch/decorative_tracker_merger.launch.xml">
<arg name="main_object" value="/perception/object_recognition/tracking/objects"/>
<arg name="sub_object" value="$(var radar_tracker_output)"/>
<arg name="output" value="/perception/object_recognition/tracking/merged/objects"/>
miursh marked this conversation as resolved.
Show resolved Hide resolved
<arg name="data_association_matrix_path" value="$(var object_recognition_tracking_object_merger_data_association_matrix_param_path)"/>
<arg name="node_param_file_path" value="$(var object_recognition_tracking_object_merger_node_param_path)"/>
</include>
</group>
-->
</group>
</launch>
16 changes: 16 additions & 0 deletions launch/tier4_perception_launch/launch/perception.launch.xml
View file
Open in desktop
Original file line number Diff line number Diff line change
Expand Up @@ -96,6 +96,14 @@
<arg name="fusion_distance" default="100.0"/>
<arg name="trust_object_distance" default="100.0"/>

<!-- Radar long range integration methods -->
<arg
name="radar_long_range_integration"
scepter914 marked this conversation as resolved.
Show resolved Hide resolved
default="detection"
description="integration method for radar long range information.
'detection' means radar information is merged in detection launch. 'tracking' means radar information is merged in tracking launch. 'none' means radar information is not merged."
/>

<!-- Perception module -->
<group>
<push-ros-namespace namespace="perception"/>
Expand Down Expand Up @@ -181,6 +189,14 @@
<push-ros-namespace namespace="tracking"/>
<include file="$(find-pkg-share tier4_perception_launch)/launch/object_recognition/tracking/tracking.launch.xml">
<arg name="mode" value="$(var mode)"/>
<arg
name="object_recognition_tracking_radar_object_tracker_data_association_matrix_param_path"
value="$(var object_recognition_tracking_radar_object_tracker_data_association_matrix_param_path)"
/>
<arg name="object_recognition_tracking_radar_object_tracker_tracking_setting_param_path" value="$(var object_recognition_tracking_radar_object_tracker_tracking_setting_param_path)"/>
<arg name="object_recognition_tracking_radar_object_tracker_node_param_path" value="$(var object_recognition_tracking_radar_object_tracker_node_param_path)"/>
<arg name="object_recognition_tracking_object_merger_data_association_matrix_param_path" value="$(var object_recognition_tracking_object_merger_data_association_matrix_param_path)"/>
<arg name="object_recognition_tracking_object_merger_node_param_path" value="$(var object_recognition_tracking_object_merger_node_param_path)"/>
</include>
</group>

Expand Down
Loading