@ -1,61 +0,0 @@ | |||||
<launch> | |||||
<arg name="database_path" default="rtabmap.db"/> | |||||
<arg name="args" default=""/> | |||||
<arg name="wait_for_transform" default="0.2"/> | |||||
<arg name="move_base_config" value="2d" /> | |||||
<arg name="pointcloud_topic" default="/camera/depth/color/points"/> | |||||
<arg name="cmd_vel_topic" default="/stretch_diff_drive_controller/cmd_vel"/> | |||||
<arg name="odom_topic" default="/stretch_diff_drive_controller/odom"/> | |||||
<!-- Navigation stuff (move_base) --> | |||||
<include file="$(find stretch_navigation)/launch/navigation/move_base.launch"> | |||||
<arg name="config" value="$(arg move_base_config)" /> | |||||
<arg name="cmd_vel_topic" value="$(arg cmd_vel_topic)" /> | |||||
<arg name="odom_topic" value="$(arg odom_topic)" /> | |||||
</include> | |||||
<!-- Mapping --> | |||||
<group ns="rtabmap"> | |||||
<node name="rtabmap" pkg="rtabmap_ros" type="rtabmap" output="screen" args="$(arg args)"> | |||||
<param name="database_path" type="string" value="$(arg database_path)"/> | |||||
<param name="frame_id" type="string" value="base_link"/> | |||||
<param name="odom_frame_id" type="string" value="odom"/> | |||||
<param name="wait_for_transform_duration" type="double" value="$(arg wait_for_transform)"/> | |||||
<param name="subscribe_depth" type="bool" value="true"/> | |||||
<param name="subscribe_scan" type="bool" value="true"/> | |||||
<!-- inputs --> | |||||
<remap from="scan" to="/scan"/> | |||||
<remap from="rgb/image" to="/camera/color/image_raw"/> | |||||
<remap from="depth/image" to="/camera/depth/image_raw"/> | |||||
<remap from="rgb/camera_info" to="/camera/color/camera_info"/> | |||||
<!-- output --> | |||||
<remap from="grid_map" to="/map"/> | |||||
<!-- RTAB-Map's parameters: do "rosrun rtabmap rtabmap (double-dash)params" to see the list of available parameters. --> | |||||
<param name="RGBD/ProximityBySpace" type="string" value="true"/> | |||||
<param name="RGBD/OptimizeFromGraphEnd" type="string" value="false"/> | |||||
<param name="Kp/MaxDepth" type="string" value="4.0"/> | |||||
<param name="Reg/Strategy" type="string" value="1"/> | |||||
<param name="Icp/CoprrespondenceRatio" type="string" value="0.3"/> | |||||
<param name="Vis/MinInliers" type="string" value="6"/> | |||||
<param name="Vis/InlierDistance" type="string" value="0.1"/> | |||||
<param name="RGBD/AngularUpdate" type="string" value="0.1"/> | |||||
<param name="RGBD/LinearUpdate" type="string" value="0.1"/> | |||||
<param name="Rtabmap/TimeThr" type="string" value="700"/> | |||||
<param name="Mem/RehearsalSimilarity" type="string" value="0.30"/> | |||||
<param name="Optimizer/Slam2D" type="string" value="true"/> | |||||
<param name="Reg/Force3DoF" type="string" value="true"/> | |||||
</node> | |||||
<param if="$(arg localization)" name="Mem/IncrementalMemory" type="string" value="false"/> | |||||
<param unless="$(arg localization)" name="Mem/IncrementalMemory" type="string" value="true"/> | |||||
<param name="Mem/InitWMWithAllNodes" type="string" value="$(arg localization)"/> | |||||
</group> | |||||
</launch> |
@ -1,36 +0,0 @@ | |||||
<launch> | |||||
<!-- REALSENSE D435i --> | |||||
<include file="$(find stretch_core)/launch/d435i_high_resolution.launch"></include> | |||||
<node name="d435i_configure" pkg="stretch_core" type="d435i_configure" output="screen"> | |||||
<!--<param name="initial_mode" type="string" value="Default"/>--> | |||||
<param name="initial_mode" type="string" value="High Accuracy"/> | |||||
</node> | |||||
<!-- --> | |||||
<!-- FRUSTUM FIELD OF VIEW VISUALIZATION --> | |||||
<node name="d435i_frustum_visualizer" pkg="stretch_core" type="d435i_frustum_visualizer" output="screen" /> | |||||
<!-- --> | |||||
<!-- STRETCH DRIVER --> | |||||
<param name="/stretch_driver/broadcast_odom_tf" type="bool" value="true"/> | |||||
<param name="/stretch_driver/mode" type="string" value="navigation" /> | |||||
<param name="/stretch_driver/fail_out_of_range_goal" type="bool" value="false"/> | |||||
<include file="$(find stretch_core)/launch/stretch_driver.launch" pass_all_args="true"/> | |||||
<!-- --> | |||||
<!-- IMU FILTER --> | |||||
<!-- <include file="$(find stretch_core)/launch/imu_filter.launch" /> --> | |||||
<!-- --> | |||||
<!-- LASER RANGE FINDER --> | |||||
<include file="$(find stretch_core)/launch/rplidar.launch" /> | |||||
<!-- --> | |||||
<!-- LASER SCAN MATCHER FOR ODOMETRY --> | |||||
<include file="$(find stretch_core)/launch/stretch_scan_matcher.launch" /> | |||||
<!-- --> | |||||
<!-- ROBOT LOCALIZATION FILTER --> | |||||
<include file="$(find stretch_core)/launch/stretch_ekf.launch" /> | |||||
<!-- --> | |||||
</launch> |
@ -1,57 +0,0 @@ | |||||
<launch> | |||||
<arg name="localization"/> | |||||
<arg name="args"/> | |||||
<arg name="database_path"/> | |||||
<arg name="wait_for_transform"/> | |||||
<arg name="pointcloud_topic"/> | |||||
<arg name="cmd_vel_topic"/> | |||||
<arg name="odom_topic"/> | |||||
<arg name="scan"/> | |||||
<arg name="rgb_topic"/> | |||||
<arg name="rgb_camera_info"/> | |||||
<!-- Mapping --> | |||||
<group ns="rtabmap"> | |||||
<node name="rtabmap" pkg="rtabmap_ros" type="rtabmap" output="screen" args="$(arg args)"> | |||||
<param name="database_path" type="string" value="$(arg database_path)"/> | |||||
<param name="frame_id" type="string" value="base_link"/> | |||||
<param name="odom_frame_id" type="string" value="odom"/> | |||||
<param name="odom_tf_angular_variance" type="double" value="0.005"/> | |||||
<param name="odom_tf_linear_variance" type="double" value="0.005"/> | |||||
<param name="wait_for_transform_duration" type="double" value="$(arg wait_for_transform)"/> | |||||
<param name="subscribe_depth" type="bool" value="true"/> | |||||
<param name="subscribe_scan" type="bool" value="true"/> | |||||
<!-- inputs --> | |||||
<remap from="scan" to="$(arg scan)"/> | |||||
<remap from="rgb/image" to="$(arg rgb_topic)"/> | |||||
<remap from="depth/image" to="$(arg pointcloud_topic)"/> | |||||
<remap from="rgb/camera_info" to="$(arg rgb_camera_info)"/> | |||||
<!-- output --> | |||||
<remap from="grid_map" to="/map"/> | |||||
<!-- RTAB-Map's parameters: do "rosrun rtabmap rtabmap (double-dash)params" to see the list of available parameters. --> | |||||
<param name="RGBD/ProximityBySpace" type="string" value="true"/> | |||||
<param name="RGBD/OptimizeFromGraphEnd" type="string" value="false"/> | |||||
<param name="Kp/MaxDepth" type="string" value="4.0"/> | |||||
<param name="Reg/Strategy" type="string" value="1"/> | |||||
<param name="Icp/CoprrespondenceRatio" type="string" value="0.3"/> | |||||
<param name="Vis/MinInliers" type="string" value="6"/> | |||||
<param name="Vis/InlierDistance" type="string" value="0.1"/> | |||||
<param name="RGBD/AngularUpdate" type="string" value="0.1"/> | |||||
<param name="RGBD/LinearUpdate" type="string" value="0.1"/> | |||||
<param name="Rtabmap/TimeThr" type="string" value="700"/> | |||||
<param name="Mem/RehearsalSimilarity" type="string" value="0.30"/> | |||||
<param name="Reg/Force3DoF" type="string" value="true"/> | |||||
<param name="Grid/FromDepth" type="string" value="true"/> | |||||
<param name="RGBD/ProximityPathMaxNeighbors" type="string" value="10"/> | |||||
</node> | |||||
<param if="$(arg localization)" name="Mem/IncrementalMemory" type="string" value="false"/> | |||||
<param unless="$(arg localization)" name="Mem/IncrementalMemory" type="string" value="true"/> | |||||
<param name="Mem/InitWMWithAllNodes" type="string" value="$(arg localization)"/> | |||||
</group> | |||||
</launch> |
@ -1,65 +0,0 @@ | |||||
<launch> | |||||
<arg name="sim" /> | |||||
<arg name="localization" default="false" /> | |||||
<arg name="database_path" default="rtabmap.db"/> | |||||
<arg name="args" default=""/> | |||||
<arg name="wait_for_transform" default="0.2"/> | |||||
<arg name="move_base_config" value="2d" /> | |||||
<group if="$(arg sim)"> | |||||
<arg name="pointcloud_topic" default="/camera/depth/image_raw"/> | |||||
<arg name="cmd_vel_topic" value="/stretch_diff_drive_controller/cmd_vel"/> | |||||
<arg name="odom_topic" default="/stretch_diff_drive_controller/odom"/> | |||||
<arg name="scan_topic" default="/scan"/> | |||||
<arg name="rgb_topic" default="/camera/color/image_raw"/> | |||||
<arg name="rgb_camera_info" default="/camera/color/camera_info"/> | |||||
<include file="$(find stretch_navigation)/launch/navigation/move_base.launch"> | |||||
<arg name="config" value="$(arg move_base_config)" /> | |||||
<arg name="cmd_vel_topic" value="$(arg cmd_vel_topic)"/> | |||||
<arg name="odom_topic" value="$(arg odom_topic)"/> | |||||
</include> | |||||
<include file="$(find stretch_navigation)/launch/rtab/rtab.launch"> | |||||
<arg name="localization" value="$(arg localization)"/> | |||||
<arg name="args" value="$(arg args)"/> | |||||
<arg name="database_path" default="$(arg database_path)"/> | |||||
<arg name="wait_for_transform" default="$(arg wait_for_transform)"/> | |||||
<arg name="pointcloud_topic" value="$(arg pointcloud_topic)"/> | |||||
<arg name="cmd_vel_topic" value="/stretch/cmd_vel"/> | |||||
<arg name="odom_topic" default="$(arg odom_topic)"/> | |||||
<arg name="scan" default="$(arg scan_topic)"/> | |||||
<arg name="rgb_topic" default="$(arg rgb_topic)"/> | |||||
<arg name="rgb_camera_info" default="$(arg rgb_camera_info)"/> | |||||
</include> | |||||
</group> | |||||
<group unless="$(arg sim)"> | |||||
<arg name="pointcloud_topic" value="/camera/aligned_depth_to_color/image_raw"/> | |||||
<arg name="cmd_vel_topic" value="/stretch/cmd_vel"/> | |||||
<arg name="odom_topic" default="/stretch_diff_drive_controller/odom"/> | |||||
<arg name="scan_topic" default="/scan"/> | |||||
<arg name="rgb_topic" default="/camera/color/image_raw"/> | |||||
<arg name="rgb_camera_info" default="/camera/color/camera_info"/> | |||||
<include file="$(find stretch_navigation)/launch/rtab/robot.launch"/> | |||||
<include file="$(find stretch_navigation)/launch/navigation/move_base.launch"> | |||||
<arg name="config" value="$(arg move_base_config)" /> | |||||
<arg name="cmd_vel_topic" value="$(arg cmd_vel_topic)"/> | |||||
<arg name="odom_topic" value="$(arg odom_topic)"/> | |||||
</include> | |||||
<include file="$(find stretch_navigation)/launch/rtab/rtab.launch"> | |||||
<arg name="localization" value="$(arg localization)"/> | |||||
<arg name="args" value="$(arg args)"/> | |||||
<arg name="database_path" default="$(arg database_path)"/> | |||||
<arg name="wait_for_transform" default="$(arg wait_for_transform)"/> | |||||
<arg name="pointcloud_topic" value="$(arg pointcloud_topic)"/> | |||||
<arg name="cmd_vel_topic" value="/stretch/cmd_vel"/> | |||||
<arg name="odom_topic" default="$(arg odom_topic)"/> | |||||
<arg name="scan" default="$(arg scan_topic)"/> | |||||
<arg name="rgb_topic" default="$(arg rgb_topic)"/> | |||||
<arg name="rgb_camera_info" default="$(arg rgb_camera_info)"/> | |||||
</include> | |||||
</group> | |||||
</launch> |
@ -1,51 +0,0 @@ | |||||
<launch> | |||||
<arg name="sim" /> | |||||
<arg name="localization" default="false" /> | |||||
<arg name="database_path" default="rtabmap.db"/> | |||||
<arg name="args" default=""/> | |||||
<arg name="wait_for_transform" default="0.2"/> | |||||
<arg name="move_base_config" value="2d" /> | |||||
<group if="$(arg sim)"> | |||||
<arg name="pointcloud_topic" default="/camera/depth/color/points"/> | |||||
<arg name="cmd_vel_topic" value="/stretch_diff_drive_controller/cmd_vel"/> | |||||
<arg name="odom_topic" default="/stretch_diff_drive_controller/odom"/> | |||||
<arg name="scan_topic" default="/scan"/> | |||||
<arg name="rgb_topic" default="/camera/color/image_raw"/> | |||||
<arg name="rgb_camera_info" default="/camera/color/camera_info"/> | |||||
<include file="$(find stretch_navigation)/launch/rtab/move_base.launch"> | |||||
<arg name="move_base_config" value="$(arg move_base_config)" /> | |||||
</include> | |||||
<include file="$(find stretch_navigation)/launch/rtab/rtab.launch"> | |||||
<arg name="localization" value="$(arg localization)"/> | |||||
</include> | |||||
</group> | |||||
<group unless="$(arg sim)"> | |||||
<arg name="pointcloud_topic" value="/camera/aligned_depth_to_color/image_raw"/> | |||||
<arg name="cmd_vel_topic" value="/stretch/cmd_vel"/> | |||||
<arg name="odom_topic" default="/stretch_diff_drive_controller/odom"/> | |||||
<arg name="scan_topic" default="/scan"/> | |||||
<arg name="rgb_topic" default="/camera/color/image_raw"/> | |||||
<arg name="rgb_camera_info" default="/camera/color/camera_info"/> | |||||
<include file="$(find stretch_navigation)/launch/rtab/robot.launch"/> | |||||
<include file="$(find stretch_navigation)/launch/rtab/move_base.launch"> | |||||
<arg name="move_base_config" value="$(arg move_base_config)" /> | |||||
<arg name="cmd_vel_topic" value="$(arg cmd_vel_topic)"/> | |||||
<arg name="odom_topic" value="$(arg odom_topic)"/> | |||||
</include> | |||||
<include file="$(find stretch_navigation)/launch/rtab/rtab.launch"> | |||||
<arg name="localization" value="$(arg localization)"/> | |||||
<arg name="pointcloud_topic" value="/camera/aligned_depth_to_color/image_raw"/> | |||||
<arg name="cmd_vel_topic" value="/stretch/cmd_vel"/> | |||||
<arg name="odom_topic" default="/stretch_diff_drive_controller/odom"/> | |||||
<arg name="scan_topic" default="/scan"/> | |||||
<arg name="rgb_topic" default="/camera/color/image_raw"/> | |||||
<arg name="rgb_camera_info" default="/camera/color/camera_info"/> | |||||
</include> | |||||
</group> | |||||
</launch> |
@ -1,3 +0,0 @@ | |||||
<launch> | |||||
<node pkg="rviz" type="rviz" name="rviz" args="-d $(find stretch_navigation)/rviz/rtab_mapping.rviz"/> | |||||
</launch> |
@ -1,7 +0,0 @@ | |||||
<launch> | |||||
<node name="teleop_twist_keyboard" pkg="teleop_twist_keyboard" type="teleop_twist_keyboard.py" output="screen" > | |||||
<param name="speed" type="double" value="0.04" /> | |||||
<param name="turn" type="double" value="0.1" /> | |||||
<remap from="/cmd_vel" to="/stretch/cmd_vel" /> | |||||
</node> | |||||
</launch> |