Skip to content

Commit 401289e

Browse files
committed
update launch files
Signed-off-by: Yamato Ando <yamato.ando@tier4.jp>
1 parent 670f070 commit 401289e

File tree

4 files changed

+55
-69
lines changed

4 files changed

+55
-69
lines changed

launch/tier4_localization_launch/launch/localization.launch.xml

+5
Original file line numberDiff line numberDiff line change
@@ -14,6 +14,11 @@
1414
<arg name="pose_initializer_param_path"/>
1515
<arg name="eagleye_param_path"/>
1616

17+
<!-- parameter paths for lidar_marker_localizer -->
18+
<arg name="lidar_marker_localizer/lidar_marker_localizer_param_path"/>
19+
<arg name="lidar_marker_localizer/pointcloud_preprocessor/crop_box_filter_measurement_range_param_path"/>
20+
<arg name="lidar_marker_localizer/pointcloud_preprocessor/ring_filter_param_path"/>
21+
1722
<arg name="input_pointcloud" default="/sensing/lidar/top/pointcloud"/>
1823
<arg name="lidar_container_name" default="/sensing/lidar/top/pointcloud_preprocessor/pointcloud_container"/>
1924

Original file line numberDiff line numberDiff line change
@@ -1,11 +1,47 @@
11
<?xml version="1.0"?>
22
<launch>
3+
4+
<!-- input pointcloud topic/container -->
5+
<arg name="input_pointcloud"/>
6+
<arg name="lidar_container_name"/>
7+
8+
<!-- whether use intra-process -->
9+
<arg name="use_intra_process" default="true" description="use ROS 2 component container communication"/>
10+
311
<group>
12+
<push-ros-namespace namespace="lidar_marker_localizer"/>
13+
14+
<!-- pointcloud preprocess -->
15+
<group>
16+
<push-ros-namespace namespace="pointcloud_preprocessor"/>
17+
<load_composable_node target="$(var lidar_container_name)">
18+
<composable_node pkg="pointcloud_preprocessor" plugin="pointcloud_preprocessor::CropBoxFilterComponent" name="crop_box_filter_measurement_range">
19+
<remap from="input" to="$(var input_pointcloud)"/>
20+
<remap from="output" to="measurement_range/pointcloud_ex"/>
21+
<param from="$(var lidar_marker_localizer/pointcloud_preprocessor/crop_box_filter_measurement_range_param_path)"/>
22+
<extra_arg name="use_intra_process_comms" value="$(var use_intra_process)"/>
23+
</composable_node>
24+
25+
<composable_node pkg="pointcloud_preprocessor" plugin="pointcloud_preprocessor::PassThroughFilterUInt16Component" name="ring_filter">
26+
<remap from="input" to="measurement_range/pointcloud_ex"/>
27+
<remap from="output" to="ring_filter/pointcloud_ex"/>
28+
<param from="$(var lidar_marker_localizer/pointcloud_preprocessor/ring_filter_param_path)"/>
29+
<extra_arg name="use_intra_process_comms" value="$(var use_intra_process)"/>
30+
</composable_node>
31+
32+
</load_composable_node>
33+
</group>
34+
35+
36+
<!-- lidar_marker_localizer -->
437
<include file="$(find-pkg-share lidar_marker_localizer)/launch/lidar_marker_localizer.launch.xml">
538
<arg name="input_lanelet2_map" value="/map/vector_map"/>
639
<arg name="input_ekf_pose" value="/localization/pose_twist_fusion_filter/biased_pose_with_covariance"/>
7-
<arg name="input_pointcloud" value="/sensing/lidar/top/rectified/pointcloud_ex"/>
40+
<arg name="input_pointcloud" value="pointcloud_preprocessor/ring_filter/pointcloud_ex"/>
841
<arg name="output_pose_with_covariance" value="/localization/pose_estimator/pose_with_covariance"/>
42+
<arg name="service_trigger_node_srv" value="trigger_node_srv"/>
43+
<arg name="param_file" value="$(var lidar_marker_localizer/lidar_marker_localizer_param_path)"/>
944
</include>
45+
1046
</group>
1147
</launch>

launch/tier4_localization_launch/launch/pose_twist_estimator/pose_twist_estimator.launch.xml

+12-29
Original file line numberDiff line numberDiff line change
@@ -8,7 +8,7 @@
88
<arg name="gnss_enabled" default="true" description="gnss availability for initial position estimation"/>
99

1010
<!-- split string with underscores -->
11-
<let name="available_args" value="[\'ndt\',\'yabloc\',\'eagleye\',\'artag\']"/>
11+
<let name="available_args" value="[\'ndt\',\'yabloc\',\'eagleye\',\'artag\',\'lidarmarker\']"/>
1212
<let name="split_function" value="list(set('$(var pose_source)'.split('_')).intersection($(var available_args)))"/>
1313
<let name="pose_sources" value="$(eval $(var split_function))"/>
1414
<let name="multi_localizer_mode" value="$(eval &quot;len($(var pose_sources))> 1&quot;)"/>
@@ -17,6 +17,7 @@
1717
<let name="use_ndt_pose" value="$(eval &quot;'ndt' in $(var pose_sources)&quot;)"/>
1818
<let name="use_yabloc_pose" value="$(eval &quot;'yabloc' in $(var pose_sources)&quot;)"/>
1919
<let name="use_artag_pose" value="$(eval &quot;'artag' in $(var pose_sources)&quot;)"/>
20+
<let name="use_lidar_marker_pose" value="$(eval &quot;'lidarmarker' in $(var pose_sources)&quot;)"/>
2021
<let name="use_eagleye_pose" value="$(eval &quot;'eagleye' in $(var pose_sources)&quot;)"/>
2122
<let name="use_eagleye_twist" value="$(eval &quot;'eagleye' == '$(var twist_source)'&quot;)"/>
2223
<let name="use_gyro_odom_twist" value="$(eval &quot;'gyro_odom' == '$(var twist_source)'&quot;)"/>
@@ -72,6 +73,16 @@
7273
</include>
7374
</group>
7475

76+
<!-- LiDAR Marker Localizer (as pose estimator) -->
77+
<group if="$(var use_lidar_marker_pose)">
78+
<push-ros-namespace namespace="pose_estimator"/>
79+
<!-- TODO multi_localizer_mode -->
80+
<include file="$(find-pkg-share tier4_localization_launch)/launch/pose_twist_estimator/lidar_marker_localizer.launch.xml">
81+
<arg name="lidar_container_name" value="/sensing/lidar/top/pointcloud_preprocessor/pointcloud_container"/>
82+
<arg name="input_pointcloud" value="/sensing/lidar/top/rectified/pointcloud_ex"/>
83+
</include>
84+
</group>
85+
7586
<!-- Pose Estimator Arbiter Launch -->
7687
<group if="$(var multi_localizer_mode)">
7788
<include file="$(find-pkg-share pose_estimator_arbiter)/launch/pose_estimator_arbiter.launch.xml">
@@ -114,32 +125,4 @@
114125
</include>
115126
</group>
116127

117-
<!-- LiDAR Marker Localizer (as pose estimator) -->
118-
<group if="$(eval &quot;'$(var pose_source)'=='lidarmarker'&quot;)">
119-
<group>
120-
<push-ros-namespace namespace="pose_estimator"/>
121-
<include file="$(find-pkg-share tier4_localization_launch)/launch/pose_twist_estimator/lidar_marker_localizer.launch.xml"/>
122-
</group>
123-
124-
<group>
125-
<push-ros-namespace namespace="pose_estimator"/>
126-
<include file="$(find-pkg-share tier4_localization_launch)/launch/pose_twist_estimator/ndt_scan_matcher.launch.xml"/>
127-
</group>
128-
<group>
129-
<push-ros-namespace namespace="util"/>
130-
<include file="$(find-pkg-share pose_initializer)/launch/pose_initializer.launch.xml">
131-
<arg name="ndt_enabled" value="true"/>
132-
<arg name="gnss_enabled" value="true"/>
133-
<arg name="ekf_enabled" value="true"/>
134-
<arg name="yabloc_enabled" value="false"/>
135-
<arg name="stop_check_enabled" value="$(var stop_check_enabled)"/>
136-
<arg name="config_file" value="$(var pose_initializer_param_path)"/>
137-
<arg name="sub_gnss_pose_cov" value="/sensing/gnss/pose_with_covariance"/>
138-
</include>
139-
<group if="$(var gnss_enabled)">
140-
<include file="$(find-pkg-share automatic_pose_initializer)/launch/automatic_pose_initializer.launch.xml"/>
141-
</group>
142-
<include file="$(find-pkg-share tier4_localization_launch)/launch/util/util.launch.py"/>
143-
</group>
144-
</group>
145128
</launch>

localization/landmark_based_localizer/lidar_marker_localizer/launch/lidar_marker_localizer.launch.xml

+1-39
Original file line numberDiff line numberDiff line change
@@ -10,46 +10,8 @@
1010

1111
<arg name="service_trigger_node_srv" default="~/service/trigger_node_srv"/>
1212

13-
<!-- container -->
14-
<arg name="pointcloud_container_name" default="/pointcloud_container" description="container name"/>
15-
16-
<!-- whether use intra-process -->
17-
<arg name="use_intra_process" default="true" description="use ROS 2 component container communication"/>
18-
19-
20-
<load_composable_node target="$(var pointcloud_container_name)">
21-
<composable_node pkg="pointcloud_preprocessor" plugin="pointcloud_preprocessor::CropBoxFilterComponent" name="crop_box_filter_measurement_range">
22-
<param name="input_frame" value="base_link"/>
23-
<param name="output_frame" value="base_link"/>
24-
<param name="min_x" value="-10.0"/>
25-
<param name="max_x" value="10.0"/>
26-
<param name="min_y" value="0.0"/>
27-
<param name="max_y" value="7.5"/>
28-
<param name="min_z" value="-5.0"/>
29-
<param name="max_z" value="5.0"/>
30-
<param name="negative" value="False"/>
31-
<remap from="input" to="$(var input_pointcloud)"/>
32-
<remap from="output" to="measurement_range/pointcloud_ex"/>
33-
<extra_arg name="use_intra_process_comms" value="$(var use_intra_process)"/>
34-
</composable_node>
35-
36-
<composable_node pkg="pointcloud_preprocessor" plugin="pointcloud_preprocessor::PassThroughFilterUInt16Component" name="ring_filter">
37-
<param name="input_frame" value="base_link"/>
38-
<param name="output_frame" value="base_link"/>
39-
<param name="filter_field_name" value="ring"/>
40-
<param name="filter_limit_min" value="5"/>
41-
<param name="filter_limit_max" value="45"/>
42-
<param name="filter_limit_negative" value="False"/>
43-
<param name="keep_organized" value="False"/>
44-
<remap from="input" to="measurement_range/pointcloud_ex"/>
45-
<remap from="output" to="ring_filter/pointcloud_ex"/>
46-
<extra_arg name="use_intra_process_comms" value="$(var use_intra_process)"/>
47-
</composable_node>
48-
49-
</load_composable_node>
50-
5113
<node pkg="lidar_marker_localizer" exec="lidar_marker_localizer" name="lidar_marker_localizer" output="log">
52-
<remap from="~/input/pointcloud_ex" to="ring_filter/pointcloud_ex"/>
14+
<remap from="~/input/pointcloud_ex" to="$(var input_pointcloud)"/>
5315
<remap from="~/input/ekf_pose" to="$(var input_ekf_pose)"/>
5416
<remap from="~/input/lanelet2_map" to="$(var input_lanelet2_map)"/>
5517

0 commit comments

Comments
 (0)