waterplus_map_tools/launch/wpb_ai_nav_test.launch
2024-04-04 12:01:37 +08:00

66 lines
3.0 KiB
XML

<launch>
<master auto="start"/>
<!-- wpb_ai core-->
<node pkg="wpb_ai_bringup" type="wpb_ai_core" name="wpb_ai_core" output="screen">
<param name="serial_port" type="string" value="/dev/ftdi"/>
<rosparam file="$(find wpb_ai_bringup)/config/wpb_ai.yaml" command="load" />
</node>
<!--- Run Rplidar -->
<node name="rplidarNode" pkg="rplidar_ros" type="rplidarNode" output="screen">
<param name="serial_port" type="string" value="/dev/rplidar"/>
<param name="serial_baudrate" type="int" value="115200"/>
<param name="frame_id" type="string" value="laser"/>
<param name="inverted" type="bool" value="false"/>
<param name="angle_compensate" type="bool" value="true"/>
<remap from="scan" to="scan_raw"/>
</node>
<!-- Run lidar filter -->
<node pkg="wpb_ai_bringup" type="wpb_ai_lidar_filter" name="wpb_ai_lidar_filter">
<param name="pub_topic" value="/scan"/>
</node>
<!-- Run the map server -->
<node name="map_server" pkg="map_server" type="map_server" args="$(find wpb_ai_tutorials)/maps/map.yaml"/>
<!--- Run AMCL -->
<include file="$(find wpb_ai_tutorials)/nav_lidar/amcl_omni.launch" />
<!--- Run move base -->
<node pkg="move_base" type="move_base" respawn="false" name="move_base" output="screen">
<rosparam file="$(find wpb_ai_tutorials)/nav_lidar/costmap_common_params.yaml" command="load" ns="global_costmap" />
<rosparam file="$(find wpb_ai_tutorials)/nav_lidar/costmap_common_params.yaml" command="load" ns="local_costmap" />
<rosparam file="$(find wpb_ai_tutorials)/nav_lidar/local_costmap_params.yaml" command="load" />
<rosparam file="$(find wpb_ai_tutorials)/nav_lidar/global_costmap_params.yaml" command="load" />
<param name="base_global_planner" value="global_planner/GlobalPlanner" />
<param name="use_dijkstra" value="true"/>
<param name="base_local_planner" value="wpb_local_planner/WpbLocalPlanner" />
<param name= "controller_frequency" value="10" type="double"/>
<param name= "oscillation_timeout" value="8" type="double"/>
<param name= "oscillation_distance" value="0.2" type="double"/>
</node>
<!-- RViz and TF tree -->
<arg name="model" default="$(find wpb_ai_bringup)/urdf/wpb_ai_mani.urdf"/>
<arg name="gui" default="true" />
<arg name="rvizconfig" default="$(find waterplus_map_tools)/rviz/nav.rviz" />
<param name="robot_description" command="$(find xacro)/xacro $(arg model)" />
<param name="use_gui" value="$(arg gui)"/>
<node name="robot_state_publisher" pkg="robot_state_publisher" type="robot_state_publisher"/>
<node name="rviz" pkg="rviz" type="rviz" args="-d $(arg rvizconfig)" required="true" />
<!-- Map tools -->
<node pkg="waterplus_map_tools" type="wp_manager" name="wp_manager" output="screen">
<param name="load" type="string" value="/home/nvidia/waypoints.xml"/>
</node>
<!-- WP_navi_server -->
<node pkg="waterplus_map_tools" type="wp_navi_server" name="wp_navi_server" output="screen"/>
</launch>