Files
rtabmap_ros/rtabmap_examples/launch/realsense_d400.launch.py
T

58 lines
2.0 KiB
Python
Raw Normal View History

2020-07-28 12:52:09 -04:00
# Requirements:
# A realsense D400 series
2022-12-03 16:43:50 -08:00
# Install realsense2 ros2 package (make sure you have this patch: https://github.com/IntelRealSense/realsense-ros/issues/2564#issuecomment-1336288238)
2020-07-28 12:52:09 -04:00
# Example:
2023-02-26 18:05:08 -08:00
# $ ros2 launch rtabmap_examples realsense_d400.launch.py
import os
from ament_index_python.packages import get_package_share_directory
2020-07-28 12:52:09 -04:00
from launch import LaunchDescription
from launch_ros.actions import Node, SetParameter
from launch.actions import IncludeLaunchDescription
from launch.launch_description_sources import PythonLaunchDescriptionSource
2020-07-28 12:52:09 -04:00
def generate_launch_description():
parameters=[{
'frame_id':'camera_link',
'subscribe_depth':True,
'subscribe_odom_info':True,
2020-07-28 12:52:09 -04:00
'approx_sync':False}]
remappings=[
('rgb/image', '/camera/color/image_raw'),
('rgb/camera_info', '/camera/color/camera_info'),
('depth/image', '/camera/aligned_depth_to_color/image_raw')]
return LaunchDescription([
# Make sure IR emitter is enabled
SetParameter(name='depth_module.emitter_enabled', value=1),
# Launch camera driver
IncludeLaunchDescription(
PythonLaunchDescriptionSource([os.path.join(
get_package_share_directory('realsense2_camera'), 'launch'),
'/rs_launch.py']),
launch_arguments={'align_depth.enable': 'true',
'rgb_camera.profile': '640x360x30'}.items(),
),
2020-07-28 12:52:09 -04:00
Node(
2023-02-26 18:05:08 -08:00
package='rtabmap_odom', executable='rgbd_odometry', output='screen',
2020-07-28 12:52:09 -04:00
parameters=parameters,
remappings=remappings),
2021-07-13 09:05:07 +02:00
2020-07-28 12:52:09 -04:00
Node(
2023-02-26 18:05:08 -08:00
package='rtabmap_slam', executable='rtabmap', output='screen',
2020-07-28 12:52:09 -04:00
parameters=parameters,
remappings=remappings,
arguments=['-d']),
Node(
2023-02-26 18:05:08 -08:00
package='rtabmap_viz', executable='rtabmap_viz', output='screen',
2020-07-28 12:52:09 -04:00
parameters=parameters,
remappings=remappings),
])