mirror of
https://github.com/introlab/rtabmap_ros.git
synced 2026-10-04 00:37:46 +08:00
matlabbeandBorong Yuan
c956e3780f
* Fixed odometry latency
* Fixed node ID=0 issues as msgs may not have seq. (#1202)
(cherry picked from commit 097cab0667)
* Odom: removed long processing from ros callbacks (decreasing delay, also making delay independent of the message filters topic_queue_size and sync_queue_size parameters)
* Changed a log from info->debug
* Changed a log from info->debug
* Updated default topic and sync queue_size inside nodes. Exposing topic and sync queue size params in warning when cannot synchronize. Added zed and depthai examples. Odom: Fixed imu callback group, added multi-threaded executors for all odometry nodes.
* fixed merge
* Include everything needed in example launch files for simple launch. Small fixes.
---------
Co-authored-by: Borong Yuan <[email protected]>
58 lines
2.0 KiB
Python
58 lines
2.0 KiB
Python
# Requirements:
|
|
# A realsense D400 series
|
|
# Install realsense2 ros2 package (make sure you have this patch: https://github.com/IntelRealSense/realsense-ros/issues/2564#issuecomment-1336288238)
|
|
# Example:
|
|
# $ ros2 launch rtabmap_examples realsense_d400.launch.py
|
|
|
|
import os
|
|
|
|
from ament_index_python.packages import get_package_share_directory
|
|
|
|
from launch import LaunchDescription
|
|
from launch_ros.actions import Node, SetParameter
|
|
from launch.actions import IncludeLaunchDescription
|
|
from launch.launch_description_sources import PythonLaunchDescriptionSource
|
|
|
|
def generate_launch_description():
|
|
parameters=[{
|
|
'frame_id':'camera_link',
|
|
'subscribe_depth':True,
|
|
'subscribe_odom_info':True,
|
|
'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(),
|
|
),
|
|
|
|
Node(
|
|
package='rtabmap_odom', executable='rgbd_odometry', output='screen',
|
|
parameters=parameters,
|
|
remappings=remappings),
|
|
|
|
Node(
|
|
package='rtabmap_slam', executable='rtabmap', output='screen',
|
|
parameters=parameters,
|
|
remappings=remappings,
|
|
arguments=['-d']),
|
|
|
|
Node(
|
|
package='rtabmap_viz', executable='rtabmap_viz', output='screen',
|
|
parameters=parameters,
|
|
remappings=remappings),
|
|
])
|