coverage
読み取り中…
検索中…
一致する文字列を見つけられません
coverage.launch.py
[詳解]
1"""Nav2本体起動済み環境でcoverage_server、BLE受信、bridge、RVizを起動する。
2
3``enable_coverage_server:=false`` はaction serverを起動せずbridge単体で試す場合に使う。
4"""
5from launch import LaunchDescription
6from launch.actions import DeclareLaunchArgument, IncludeLaunchDescription, LogInfo
7from launch.conditions import IfCondition
8from launch.launch_description_sources import PythonLaunchDescriptionSource
9from launch.substitutions import LaunchConfiguration, PathJoinSubstitution
10from launch_ros.actions import Node
11from launch_ros.substitutions import FindPackageShare
12
13
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',
38 ),
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単体起動)',
54 ),
55 DeclareLaunchArgument(
56 'enable_ble', default_value='false',
57 description='Start the same BlueZ JSON receiver as production',
58 ),
59 DeclareLaunchArgument(
60 'use_rviz', default_value='true',
61 description='Whether to start RViz with coverage.rviz',
62 ),
63 LogInfo(msg='[coverage] starting coverage_server + BLE + bridge...'),
64 # mirs_launchは機体・センサー・TFを起動し、Nav2/SLAM/RVizは起動しない。
65 IncludeLaunchDescription(
66 PythonLaunchDescriptionSource(
67 PathJoinSubstitution([mirs_share, 'launch', 'mirs_launch.py'])
68 ),
69 launch_arguments={
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',
90 }.items(),
91 condition=IfCondition(LaunchConfiguration('enable_mirs')),
92 ),
93 # enable_coverage_server=trueのときcoverage task serverを起動する。
94 Node(
95 package='opennav_coverage',
96 executable='opennav_coverage',
97 name='coverage_server',
98 output='screen',
99 parameters=[
100 LaunchConfiguration('nav2_params_file'),
101 {'use_sim_time': LaunchConfiguration('use_sim_time')},
102 ],
103 condition=IfCondition(LaunchConfiguration('enable_coverage_server')),
104 ),
105 # task serverを起動するときだけlifecycle管理対象へ登録する。
106 Node(
107 package='nav2_lifecycle_manager',
108 executable='lifecycle_manager',
109 name='lifecycle_manager_coverage',
110 output='screen',
111 parameters=[{
112 'use_sim_time': LaunchConfiguration('use_sim_time'),
113 'autostart': True,
114 'node_names': ['coverage_server'],
115 'bond_timeout': 10.0,
116 }],
117 condition=IfCondition(LaunchConfiguration('enable_coverage_server')),
118 ),
119 IncludeLaunchDescription(
120 PythonLaunchDescriptionSource(
121 PathJoinSubstitution([
122 FindPackageShare('ble_server'), 'launch',
123 'ble_receiver.launch.py',
124 ])
125 ),
126 launch_arguments={
127 'enabled': 'true',
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'),
132 }.items(),
133 condition=IfCondition(LaunchConfiguration('enable_ble')),
134 ),
135 Node(
136 package='coverage',
137 executable='coverage_bridge',
138 name='coverage_bridge',
139 output='screen',
140 parameters=[{
141 'zone_topic': LaunchConfiguration('zone_topic'),
142 'state_topic': LaunchConfiguration('state_topic'),
143 'behavior_tree': LaunchConfiguration('behavior_tree'),
144 'frame_id': 'map',
145 'use_sim_time': LaunchConfiguration('use_sim_time'),
146 }],
147 ),
148 # enable_monitor=trueのとき1.0s周期でtopic・TF診断を発行する。
149 Node(
150 package='coverage',
151 executable='coverage_monitor',
152 name='coverage_monitor',
153 output='screen',
154 parameters=[{
155 'profile': LaunchConfiguration('monitor_profile'),
156 'zone_topic': LaunchConfiguration('zone_topic'),
157 'use_sim_time': LaunchConfiguration('use_sim_time'),
158 }],
159 condition=IfCondition(LaunchConfiguration('enable_monitor')),
160 ),
161 # use_rviz=trueのときcoverage確認用設定でRVizを起動する。
162 Node(
163 package='rviz2',
164 executable='rviz2',
165 name='rviz2',
166 arguments=['-d', rviz_config],
167 parameters=[{'use_sim_time': LaunchConfiguration('use_sim_time')}],
168 condition=IfCondition(LaunchConfiguration('use_rviz')),
169 output='screen',
170 ),
171 ])
generate_launch_description()
選択可能なcoverage server、bridge、RVizのlaunch記述を返す。