@@ -48,7 +48,6 @@ def fusion_config_sanity_check(fusion_config: dict):
48
48
listed_param_names = [
49
49
"raw_pointcloud_topics" ,
50
50
"fusion_input_ogm_topics" ,
51
- # "each_ogm_sensor_frames",
52
51
"input_ogm_reliabilities" ,
53
52
]
54
53
param_length_list = []
@@ -112,7 +111,12 @@ def launch_setup(context, *args, **kwargs):
112
111
gridmap_generation_composable_nodes = []
113
112
114
113
number_of_nodes = len (fusion_config ["raw_pointcloud_topics" ])
115
- print (number_of_nodes )
114
+ print (
115
+ "launching multi_lidar_pointcloud_based occupancy grid map" ,
116
+ number_of_nodes ,
117
+ "nodes in the container named" ,
118
+ LaunchConfiguration ("pointcloud_container_name" ).perform (context ),
119
+ )
116
120
117
121
for i in range (number_of_nodes ):
118
122
# load parameter file
@@ -151,7 +155,7 @@ def launch_setup(context, *args, **kwargs):
151
155
152
156
# 3. launch setting
153
157
occupancy_grid_map_container = ComposableNodeContainer (
154
- name = LaunchConfiguration ("container_name " ),
158
+ name = LaunchConfiguration ("pointcloud_container_name " ),
155
159
namespace = "" ,
156
160
package = "rclcpp_components" ,
157
161
executable = LaunchConfiguration ("container_executable" ),
@@ -162,7 +166,7 @@ def launch_setup(context, *args, **kwargs):
162
166
163
167
load_composable_nodes = LoadComposableNodes (
164
168
composable_node_descriptions = gridmap_generation_composable_nodes + gridmap_fusion_node ,
165
- target_container = LaunchConfiguration ("container_name " ),
169
+ target_container = LaunchConfiguration ("pointcloud_container_name " ),
166
170
condition = IfCondition (LaunchConfiguration ("use_pointcloud_container" )),
167
171
)
168
172
@@ -190,7 +194,7 @@ def add_launch_arg(name: str, default_value=None):
190
194
add_launch_arg ("use_multithread" , "false" ),
191
195
add_launch_arg ("use_intra_process" , "true" ),
192
196
add_launch_arg ("use_pointcloud_container" , "false" ),
193
- add_launch_arg ("container_name " , "occupancy_grid_map_container" ),
197
+ add_launch_arg ("pointcloud_container_name " , "occupancy_grid_map_container" ),
194
198
add_launch_arg ("input/obstacle_pointcloud" , "no_ground/oneshot/pointcloud" ),
195
199
add_launch_arg ("output" , "occupancy_grid" ),
196
200
add_launch_arg (
0 commit comments