|
<launch>
|
|
|
|
<arg name="rviz" default="true" doc="whether to show Rviz" />
|
|
<arg name="map_yaml" default="''" doc="previously captured FUNMAP map (optional)" />
|
|
<arg name="debug_directory" default="$(env HELLO_FLEET_PATH)/debug/" doc="directory where debug imagery is saved" />
|
|
|
|
<!-- 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="false"/>
|
|
<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"/>
|
|
<!-- -->
|
|
|
|
<!-- FUNMAP -->
|
|
<node name="funmap" pkg="stretch_funmap" type="funmap" output="screen" args="--load_map $(arg map_yaml)">
|
|
<param name="debug_directory" type="string" value="$(arg debug_directory)"/>
|
|
</node>
|
|
<!-- -->
|
|
|
|
<!-- IMU FILTER -->
|
|
<include file="$(find stretch_core)/launch/imu_filter.launch" />
|
|
<!-- -->
|
|
|
|
<!-- ROBOT LOCALIZATION FILTER -->
|
|
<include file="$(find stretch_core)/launch/stretch_ekf.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" />
|
|
<!-- -->
|
|
|
|
<!-- KEYBOARD TELEOP -->
|
|
<node name="keyboard_teleop" pkg="stretch_core" type="keyboard_teleop" output="screen" args='--mapping_on' />
|
|
<!-- -->
|
|
|
|
<!-- VISUALIZE -->
|
|
<node name="rviz" pkg="rviz" type="rviz" output="screen" args="-d $(find stretch_funmap)/rviz/stretch_mapping.rviz" if="$(arg rviz)" />
|
|
<!-- -->
|
|
|
|
</launch>
|