Add min depth and max depth limit in launch file

This commit is contained in:
Joe Dong
2024-07-17 10:45:57 +08:00
parent 08037f1289
commit a883f3de2b
@@ -1,21 +1,24 @@
import os
import yaml
from launch import LaunchDescription from launch import LaunchDescription
from launch.actions import DeclareLaunchArgument, OpaqueFunction, GroupAction from launch.actions import DeclareLaunchArgument, OpaqueFunction, GroupAction
from launch.substitutions import LaunchConfiguration from launch.substitutions import LaunchConfiguration
from launch_ros.actions import PushRosNamespace, ComposableNodeContainer, Node from launch_ros.actions import PushRosNamespace, ComposableNodeContainer, Node
from launch_ros.descriptions import ComposableNode from launch_ros.descriptions import ComposableNode
import os
import yaml
def load_yaml(file_path): def load_yaml(file_path):
with open(file_path, 'r') as f: with open(file_path, 'r') as f:
return yaml.safe_load(f) return yaml.safe_load(f)
def merge_params(default_params, yaml_params): def merge_params(default_params, yaml_params):
for key, value in yaml_params.items(): for key, value in yaml_params.items():
if key in default_params: if key in default_params:
default_params[key] = value default_params[key] = value
return default_params return default_params
def convert_value(value): def convert_value(value):
if isinstance(value, str): if isinstance(value, str):
try: try:
@@ -32,6 +35,7 @@ def convert_value(value):
return False return False
return value return value
def load_parameters(context, args): def load_parameters(context, args):
default_params = {arg.name: LaunchConfiguration(arg.name).perform(context) for arg in args} default_params = {arg.name: LaunchConfiguration(arg.name).perform(context) for arg in args}
config_file_path = LaunchConfiguration('config_file_path').perform(context) config_file_path = LaunchConfiguration('config_file_path').perform(context)
@@ -44,6 +48,7 @@ def load_parameters(context, args):
for key, value in default_params.items() for key, value in default_params.items()
} }
def generate_launch_description(): def generate_launch_description():
args = [ args = [
DeclareLaunchArgument('camera_name', default_value='camera'), DeclareLaunchArgument('camera_name', default_value='camera'),
@@ -155,6 +160,9 @@ def generate_launch_description():
DeclareLaunchArgument('retry_on_usb3_detection_failure', default_value='false'), DeclareLaunchArgument('retry_on_usb3_detection_failure', default_value='false'),
DeclareLaunchArgument('laser_energy_level', default_value='-1'), DeclareLaunchArgument('laser_energy_level', default_value='-1'),
DeclareLaunchArgument('enable_3d_reconstruction_mode', default_value='false'), DeclareLaunchArgument('enable_3d_reconstruction_mode', default_value='false'),
# If you want to use the depth_limit, you need to set the min_depth_limit and max_depth_limit to the desired values
DeclareLaunchArgument('min_depth_limit', default_value='0'),
DeclareLaunchArgument('max_depth_limit', default_value='0'),
DeclareLaunchArgument('config_file_path', default_value=''), DeclareLaunchArgument('config_file_path', default_value=''),
] ]