@@ -71,6 +71,18 @@ def get_vehicle_mirror_info(self):
71
71
return p
72
72
73
73
def create_additional_pipeline (self , lidar_name ):
74
+ max_z = (
75
+ self .vehicle_info ["max_height_offset" ]
76
+ + self .ground_segmentation_param [f"{ lidar_name } _crop_box_filter" ]["parameters" ][
77
+ "margin_max_z"
78
+ ]
79
+ )
80
+ min_z = (
81
+ self .vehicle_info ["min_height_offset" ]
82
+ + self .ground_segmentation_param [f"{ lidar_name } _crop_box_filter" ]["parameters" ][
83
+ "margin_min_z"
84
+ ]
85
+ )
74
86
components = []
75
87
components .append (
76
88
ComposableNode (
@@ -85,6 +97,8 @@ def create_additional_pipeline(self, lidar_name):
85
97
{
86
98
"input_frame" : LaunchConfiguration ("base_frame" ),
87
99
"output_frame" : LaunchConfiguration ("base_frame" ),
100
+ "max_z" : max_z ,
101
+ "min_z" : min_z ,
88
102
},
89
103
self .ground_segmentation_param [f"{ lidar_name } _crop_box_filter" ]["parameters" ],
90
104
],
@@ -207,6 +221,14 @@ def create_ransac_pipeline(self):
207
221
return components
208
222
209
223
def create_common_pipeline (self , input_topic , output_topic ):
224
+ max_z = (
225
+ self .vehicle_info ["max_height_offset" ]
226
+ + self .ground_segmentation_param ["common_crop_box_filter" ]["parameters" ]["margin_max_z" ]
227
+ )
228
+ min_z = (
229
+ self .vehicle_info ["min_height_offset" ]
230
+ + self .ground_segmentation_param ["common_crop_box_filter" ]["parameters" ]["margin_min_z" ]
231
+ )
210
232
components = []
211
233
components .append (
212
234
ComposableNode (
@@ -221,6 +243,8 @@ def create_common_pipeline(self, input_topic, output_topic):
221
243
{
222
244
"input_frame" : LaunchConfiguration ("base_frame" ),
223
245
"output_frame" : LaunchConfiguration ("base_frame" ),
246
+ "max_z" : max_z ,
247
+ "min_z" : min_z ,
224
248
},
225
249
self .ground_segmentation_param ["common_crop_box_filter" ]["parameters" ],
226
250
],
0 commit comments