23from launch.actions
import DeclareLaunchArgument, ExecuteProcess, IncludeLaunchDescription, TimerAction
37 mirs_pkg = FindPackageShare(
'mirs')
38 nav2_bringup_pkg = FindPackageShare(
'nav2_bringup')
40 return LaunchDescription([
43 DeclareLaunchArgument(
45 default_value=PathJoinSubstitution([mirs_pkg,
'maps',
'youkanato.yaml'])
47 DeclareLaunchArgument(
49 default_value=PathJoinSubstitution([mirs_pkg,
'config',
'ekf',
'ekf_params.yaml'])
51 DeclareLaunchArgument(
53 default_value=PathJoinSubstitution([mirs_pkg,
'config',
'rviz',
'default.rviz'])
55 DeclareLaunchArgument(
57 default_value=PathJoinSubstitution(
58 [mirs_pkg,
'config',
'navigation',
'nav2_params.yaml'])
60 DeclareLaunchArgument(
61 'slam_toolbox_config_file',
62 default_value=PathJoinSubstitution(
63 [mirs_pkg,
'config',
'slam',
'slam_toolbox_config.yaml'])
66 DeclareLaunchArgument(
'esp_port', default_value=
'/dev/ttyUSB1'),
67 DeclareLaunchArgument(
'lidar_port', default_value=
'/dev/ttyUSB0'),
68 DeclareLaunchArgument(
'lidar_baudrate', default_value=
'256000'),
69 DeclareLaunchArgument(
'lidar_frame', default_value=
'laser'),
70 DeclareLaunchArgument(
'foxglove_address', default_value=
'0.0.0.0'),
71 DeclareLaunchArgument(
'foxglove_port', default_value=
'8765'),
75 DeclareLaunchArgument(
'use_sim_time', default_value=
'false'),
77 DeclareLaunchArgument(
'enable_lidar', default_value=
'true'),
78 DeclareLaunchArgument(
'scan_safety_stop_distance', default_value=
'0.35'),
79 DeclareLaunchArgument(
'scan_safety_resume_distance', default_value=
'0.50'),
80 DeclareLaunchArgument(
'scan_safety_forward_angle', default_value=
'30.0'),
81 DeclareLaunchArgument(
'enable_parameter_publisher', default_value=
'true'),
82 DeclareLaunchArgument(
'enable_micro_ros', default_value=
'true'),
83 DeclareLaunchArgument(
'enable_ekf_local', default_value=
'false'),
84 DeclareLaunchArgument(
'enable_rviz', default_value=
'false'),
85 DeclareLaunchArgument(
'enable_nav2', default_value=
'false'),
86 DeclareLaunchArgument(
'enable_slam_toolbox', default_value=
'false'),
87 DeclareLaunchArgument(
'autostart', default_value=
'true'),
88 DeclareLaunchArgument(
'slam', default_value=
'False'),
89 DeclareLaunchArgument(
90 'enable_auto_global_localization', default_value=
'true',
91 description=
'AMCLを地図全体から自動初期化する'),
93 DeclareLaunchArgument(
'enable_static_base_link_to_laser_tf', default_value=
'true'),
94 DeclareLaunchArgument(
'enable_static_base_footprint_to_base_link_tf',
95 default_value=
'true'),
96 DeclareLaunchArgument(
'enable_static_base_link_to_imu_link_tf', default_value=
'false'),
97 DeclareLaunchArgument(
'enable_slam_toolbox', default_value=
'false'),
98 DeclareLaunchArgument(
'enable_foxglove_bridge', default_value=
'true'),
102 executable=
'parameter_publisher',
103 name=
'parameter_publisher',
105 parameters=[PathJoinSubstitution([mirs_pkg,
'config',
'config.yaml']), {
106 'use_sim_time': LaunchConfiguration(
'use_sim_time')}],
107 condition=IfCondition(LaunchConfiguration(
'enable_parameter_publisher')),
111 package=
'micro_ros_agent',
112 executable=
'micro_ros_agent',
113 name=
'micro_ros_agent',
115 arguments=[
'serial',
'--dev', LaunchConfiguration(
'esp_port'),
'-v6'],
116 condition=IfCondition(LaunchConfiguration(
'enable_micro_ros')),
120 package=
'robot_localization',
121 executable=
'ekf_node',
122 name=
'ekf_filter_node_local',
124 parameters=[LaunchConfiguration(
'ekf_config_file'), {
125 'use_sim_time': LaunchConfiguration(
'use_sim_time')}],
126 remappings=[(
'/odometry/filtered',
'/odometry/local')],
127 condition=IfCondition(LaunchConfiguration(
'enable_ekf_local')),
132 executable=
'static_transform_publisher',
133 name=
'enable_static_base_link_to_laser_tf',
135 arguments=[
'--x',
'0',
'--y',
'0',
'--z',
'0.1745',
'--roll',
'0',
'--pitch',
136 '0',
'--yaw',
'0',
'--frame-id',
'base_link',
137 '--child-frame-id', LaunchConfiguration(
'lidar_frame')],
138 condition=IfCondition(LaunchConfiguration(
'enable_static_base_link_to_laser_tf')),
143 executable=
'static_transform_publisher',
144 name=
'enable_static_base_footprint_to_base_link_tf',
147 '--x',
'0',
'--y',
'0',
'--z',
'0.242',
'--roll',
'0',
'--pitch',
'0',
148 '--yaw',
'0',
'--frame-id',
'base_footprint',
'--child-frame-id',
'base_link',
150 condition=IfCondition(LaunchConfiguration(
151 'enable_static_base_footprint_to_base_link_tf')),
156 executable=
'static_transform_publisher',
157 name=
'base_link_to_imu_link',
160 '--x',
'0',
'--y',
'0',
'--z',
'0.05',
'--roll',
'0',
'--pitch',
161 '0',
'--yaw',
'0',
'--frame-id',
'base_link',
'--child-frame-id',
'imu_link',
163 condition=IfCondition(LaunchConfiguration(
'enable_static_base_link_to_imu_link_tf')),
170 arguments=[
'-d', LaunchConfiguration(
'rviz_config_file')],
172 {
'use_sim_time': LaunchConfiguration(
'use_sim_time')}
174 condition=IfCondition(LaunchConfiguration(
'enable_rviz'))
177 IncludeLaunchDescription(
178 PythonLaunchDescriptionSource(
179 PathJoinSubstitution(
180 [FindPackageShare(
'sllidar_ros2'),
'launch',
'sllidar_s1_launch.py'])
183 'serial_port': LaunchConfiguration(
'lidar_port'),
184 'serial_baudrate': LaunchConfiguration(
'lidar_baudrate'),
185 'frame_id': LaunchConfiguration(
'lidar_frame'),
187 condition=IfCondition(LaunchConfiguration(
'enable_lidar')),
191 executable=
'scan_safety_guard',
192 name=
'scan_safety_guard',
195 'scan_topic':
'/scan',
196 'input_cmd_vel_topic':
'/cmd_vel_nav',
197 'output_cmd_vel_topic':
'/cmd_vel',
198 'stop_distance': ParameterValue(
199 LaunchConfiguration(
'scan_safety_stop_distance'), value_type=float),
200 'resume_distance': ParameterValue(
201 LaunchConfiguration(
'scan_safety_resume_distance'), value_type=float),
202 'forward_angle_deg': ParameterValue(
203 LaunchConfiguration(
'scan_safety_forward_angle'), value_type=float),
204 'use_sim_time': LaunchConfiguration(
'use_sim_time'),
206 condition=IfCondition(PythonExpression([
207 "'", LaunchConfiguration(
'enable_lidar'),
"'.lower() == 'true' and '",
208 LaunchConfiguration(
'enable_nav2'),
"'.lower() == 'true'",
212 IncludeLaunchDescription(
213 PythonLaunchDescriptionSource(
214 PathJoinSubstitution([nav2_bringup_pkg,
'launch',
'bringup_launch.py'])
217 'map': LaunchConfiguration(
'map'),
218 'use_sim_time': LaunchConfiguration(
'use_sim_time'),
219 'autostart': LaunchConfiguration(
'autostart'),
220 'slam': LaunchConfiguration(
'slam'),
221 'params_file': RewrittenYaml(
222 source_file=LaunchConfiguration(
'nav2_params_file'),
224 'bt_navigator.ros__parameters.navigate_complete_coverage.plugin':
225 'nav2_bt_navigator::NavigateToPoseNavigator',
230 condition=IfCondition(LaunchConfiguration(
'enable_nav2'))
237 actions=[ExecuteProcess(
239 'ros2',
'service',
'call',
240 '/reinitialize_global_localization',
241 'std_srvs/srv/Empty',
'{}',
245 condition=IfCondition(PythonExpression([
246 "'", LaunchConfiguration(
'enable_nav2'),
247 "'.lower() == 'true' and '",
248 LaunchConfiguration(
'slam'),
249 "'.lower() == 'false' and '",
250 LaunchConfiguration(
'enable_auto_global_localization'),
251 "'.lower() == 'true'",
256 IncludeLaunchDescription(
257 PythonLaunchDescriptionSource(
258 PathJoinSubstitution(
259 [FindPackageShare(
'slam_toolbox'),
'launch',
'online_async_launch.py'])
262 'slam_params_file': LaunchConfiguration(
'slam_toolbox_config_file'),
263 'use_sim_time': LaunchConfiguration(
'use_sim_time'),
266 condition=IfCondition(LaunchConfiguration(
'enable_slam_toolbox'))
270 IncludeLaunchDescription(
271 AnyLaunchDescriptionSource(
272 PathJoinSubstitution([
273 FindPackageShare(
'foxglove_bridge'),
'launch',
274 'foxglove_bridge_launch.xml']),
277 'address': LaunchConfiguration(
'foxglove_address'),
278 'port': LaunchConfiguration(
'foxglove_port'),
280 condition=IfCondition(LaunchConfiguration(
'enable_foxglove_bridge'))