15 """選択可能なcoverage server、bridge、RVizのlaunch記述を返す。"""
16 mirs_share = FindPackageShare(
'mirs')
17 coverage_share = FindPackageShare(
'coverage')
18 default_map = PathJoinSubstitution([mirs_share,
'maps',
'youkanato.yaml'])
19 nav2_params = PathJoinSubstitution(
20 [mirs_share,
'config',
'navigation',
'nav2_params.yaml'])
21 ekf_config_file = PathJoinSubstitution(
22 [mirs_share,
'config',
'ekf',
'ekf_params.yaml'])
23 default_behavior_tree = PathJoinSubstitution(
24 [coverage_share,
'behavior_trees',
'navigate_coverage_w_recovery.xml'])
25 rviz_config = PathJoinSubstitution([coverage_share,
'rviz',
'coverage.rviz'])
26 return LaunchDescription([
27 DeclareLaunchArgument(
'zone_topic', default_value=
'/cleaning_zone'),
28 DeclareLaunchArgument(
'state_topic', default_value=
'/coverage/state'),
29 DeclareLaunchArgument(
'enable_monitor', default_value=
'true'),
30 DeclareLaunchArgument(
'monitor_profile', default_value=
'2d'),
31 DeclareLaunchArgument(
'behavior_tree', default_value=default_behavior_tree),
32 DeclareLaunchArgument(
'use_sim_time', default_value=
'false'),
33 DeclareLaunchArgument(
'map', default_value=default_map),
34 DeclareLaunchArgument(
'nav2_params_file', default_value=nav2_params),
35 DeclareLaunchArgument(
36 'enable_mirs', default_value=
'false',
37 description=
'Start mirs hardware and base nodes',
39 DeclareLaunchArgument(
'esp_port', default_value=
'/dev/ttyUSB1'),
40 DeclareLaunchArgument(
'lidar_port', default_value=
'/dev/ttyUSB0'),
41 DeclareLaunchArgument(
'lidar_baudrate', default_value=
'256000'),
42 DeclareLaunchArgument(
'lidar_frame', default_value=
'laser'),
43 DeclareLaunchArgument(
'enable_lidar', default_value=
'true'),
44 DeclareLaunchArgument(
'enable_micro_ros', default_value=
'true'),
45 DeclareLaunchArgument(
'enable_ekf_local', default_value=
'true'),
46 DeclareLaunchArgument(
'ekf_config_file', default_value=ekf_config_file),
47 DeclareLaunchArgument(
'enable_static_base_link_to_laser_tf', default_value=
'true'),
48 DeclareLaunchArgument(
49 'enable_static_base_footprint_to_base_link_tf', default_value=
'true'),
50 DeclareLaunchArgument(
'enable_static_base_link_to_imu_link_tf', default_value=
'false'),
51 DeclareLaunchArgument(
52 'enable_coverage_server', default_value=
'true',
53 description=
'Start opennav_coverage server (falseでbridge単体起動)',
55 DeclareLaunchArgument(
56 'enable_ble', default_value=
'false',
57 description=
'Start the same BlueZ JSON receiver as production',
59 DeclareLaunchArgument(
60 'use_rviz', default_value=
'true',
61 description=
'Whether to start RViz with coverage.rviz',
63 LogInfo(msg=
'[coverage] starting coverage_server + BLE + bridge...'),
65 IncludeLaunchDescription(
66 PythonLaunchDescriptionSource(
67 PathJoinSubstitution([mirs_share,
'launch',
'mirs_launch.py'])
70 'esp_port': LaunchConfiguration(
'esp_port'),
71 'lidar_port': LaunchConfiguration(
'lidar_port'),
72 'lidar_baudrate': LaunchConfiguration(
'lidar_baudrate'),
73 'lidar_frame': LaunchConfiguration(
'lidar_frame'),
74 'use_sim_time': LaunchConfiguration(
'use_sim_time'),
75 'enable_lidar': LaunchConfiguration(
'enable_lidar'),
76 'enable_micro_ros': LaunchConfiguration(
'enable_micro_ros'),
77 'enable_ekf_local': LaunchConfiguration(
'enable_ekf_local'),
78 'ekf_config_file': LaunchConfiguration(
'ekf_config_file'),
79 'enable_static_base_link_to_laser_tf':
80 LaunchConfiguration(
'enable_static_base_link_to_laser_tf'),
81 'enable_static_base_footprint_to_base_link_tf':
82 LaunchConfiguration(
'enable_static_base_footprint_to_base_link_tf'),
83 'enable_static_base_link_to_imu_link_tf':
84 LaunchConfiguration(
'enable_static_base_link_to_imu_link_tf'),
85 'map': LaunchConfiguration(
'map'),
86 'nav2_params_file': LaunchConfiguration(
'nav2_params_file'),
87 'enable_rviz':
'false',
88 'enable_nav2':
'true',
89 'enable_slam_toolbox':
'false',
91 condition=IfCondition(LaunchConfiguration(
'enable_mirs')),
95 package=
'opennav_coverage',
96 executable=
'opennav_coverage',
97 name=
'coverage_server',
100 LaunchConfiguration(
'nav2_params_file'),
101 {
'use_sim_time': LaunchConfiguration(
'use_sim_time')},
103 condition=IfCondition(LaunchConfiguration(
'enable_coverage_server')),
107 package=
'nav2_lifecycle_manager',
108 executable=
'lifecycle_manager',
109 name=
'lifecycle_manager_coverage',
112 'use_sim_time': LaunchConfiguration(
'use_sim_time'),
114 'node_names': [
'coverage_server'],
115 'bond_timeout': 10.0,
117 condition=IfCondition(LaunchConfiguration(
'enable_coverage_server')),
119 IncludeLaunchDescription(
120 PythonLaunchDescriptionSource(
121 PathJoinSubstitution([
122 FindPackageShare(
'ble_server'),
'launch',
123 'ble_receiver.launch.py',
128 'default_frame_id':
'map',
129 'cleaning_zone_topic': LaunchConfiguration(
'zone_topic'),
130 'initial_pose_topic':
'/initialpose',
131 'use_sim_time': LaunchConfiguration(
'use_sim_time'),
133 condition=IfCondition(LaunchConfiguration(
'enable_ble')),
137 executable=
'coverage_bridge',
138 name=
'coverage_bridge',
141 'zone_topic': LaunchConfiguration(
'zone_topic'),
142 'state_topic': LaunchConfiguration(
'state_topic'),
143 'behavior_tree': LaunchConfiguration(
'behavior_tree'),
145 'use_sim_time': LaunchConfiguration(
'use_sim_time'),
151 executable=
'coverage_monitor',
152 name=
'coverage_monitor',
155 'profile': LaunchConfiguration(
'monitor_profile'),
156 'zone_topic': LaunchConfiguration(
'zone_topic'),
157 'use_sim_time': LaunchConfiguration(
'use_sim_time'),
159 condition=IfCondition(LaunchConfiguration(
'enable_monitor')),
166 arguments=[
'-d', rviz_config],
167 parameters=[{
'use_sim_time': LaunchConfiguration(
'use_sim_time')}],
168 condition=IfCondition(LaunchConfiguration(
'use_rviz')),