Robotics StackExchange | Archived questions

how to use robot_pose_ekf together with amcl

Hello everyone,

I have a carlike robot simulated in gazebo with a lidar and an imu sensor. I want to combine the odom delivered by hector slam and imu data with robotposeekf and use odom_combined for amcl. The following are my launch files:

AMCL:

<?xml version="1.0"?>
<launch>
<node pkg="amcl" type="amcl" name="amcl" output="screen">

  <!-- remap from="scan" to="hokuyo_laser_topic" / -->  
  <remap from="cmd_vel" to="/cmd_vel" />  
  <remap from="scan" to="/scan" />  

  <!-- Publish scans from best pose at a max of 10 Hz -->
  <param name="odom_model_type" value="diff-corrected"/>
  <param name="odom_alpha5" value="0.003"/>
  <param name="gui_publish_rate" value="10.0"/>
  <param name="laser_max_beams" value="30"/>
  <param name="min_particles" value="500"/>
  <param name="max_particles" value="5000"/>
  <param name="kld_err" value="0.05"/>
  <param name="kld_z" value="0.99"/>
  <param name="odom_alpha1" value="0.005"/>
  <param name="odom_alpha2" value="0.005"/>
  <!-- translation std dev, m -->
  <param name="odom_alpha3" value="0.010"/>
  <param name="odom_alpha4" value="0.005"/>
  <param name="laser_z_hit" value="0.5"/>
  <param name="laser_z_short" value="0.05"/>
  <param name="laser_z_max" value="0.05"/>
  <param name="laser_z_rand" value="0.5"/>
  <param name="laser_sigma_hit" value="0.2"/>
  <param name="laser_lambda_short" value="0.1"/>
  <param name="laser_lambda_short" value="0.1"/>
  <param name="laser_model_type" value="likelihood_field"/>
  <!-- <param name="laser_model_type" value="beam"/> -->
  <param name="laser_likelihood_max_dist" value="2.0"/>
  <param name="update_min_d" value="0.1"/>
  <param name="update_min_a" value="0.1"/>
  <param name="odom_frame_id" value="/odom_combined"/>
  <param name="base_frame_id" value="base_footprint"/>
  <param name="global_frame_id" value="map"/>
  <param name="resample_interval" value="1"/>
  <param name="transform_tolerance" value="0.1"/>
  <param name="recovery_alpha_slow" value="0.01"/>
  <param name="recovery_alpha_fast" value="1"/>
  <param name="initial_pose_x" value ="0"/>
  <param name="initial_pose_y" value ="0"/>
  <param name="initial_pose_a" value ="0"/>

</node>
</launch>

Hector_SLAM:

<?xml version="1.0"?>

<!--node pkg="tf" type="static_transform_publisher" name="odom_to_base_link" args="0 0 0 0.0 0.0 0.0 /odom /base_link 50" /-->
<node name="hector_mapping" pkg="hector_mapping" type="hector_mapping" output="screen">
    <remap from="map" to="/mapcurrent" />
    <param name="map_frame" value="/mapcurrent" />
    <param name="base_frame" value="/base_footprint" />
    <param name="odom_frame" value="/odom" />
    <param name="pub_odometry" value="true" />
    <param name="use_tf_scan_transformation" value="true"/>
    <param name="use_tf_pose_start_estimate" value="false"/>
    <param name="pub_map_odom_transform" value="false" />

    <param name="map_resolution" value="0.025"/>
    <param name="map_size" value="2048"/>
    <param name="map_start_x" value="0.5"/>
    <param name="map_start_y" value="0.5" />
    <param name="map_multi_res_levels" value="2" />

    <param name="update_factor_free" value="0.4" />
    <param name="update_factor_occupied" value="0.9" />    
    <param name="map_update_distance_thresh" value="0.4" />
    <param name="map_update_angle_thresh" value="0.06" />
    <param name="laser_z_min_value" value = "-1.0" />
    <param name="laser_z_max_value" value = "1.0" />

    <param name="advertise_map_service" value="true" />

    <param name="scan_subscriber_queue_size" value="5"/>
    <param name="scan_topic" value="/scan"/>
    <param name="pub_map_scanmatch_transform" value="false" />
    <param name="tf_map_scanmatch_transform_frame_name" value="scanmatcher_frame" />
</node>

<node name="odomtransformer" pkg="rbcar_navigation" type="odomtransformer.py" output="screen">
    <param name="odom_input" value="/scanmatch_odom" />
    <param name="tf_output" value="/base_footprint" />
</node>

Move_base:

    <?xml version="1.0"?>
<launch>

  <node name="map_server" pkg="map_server" type="map_server" args="$(find rbcar_navigation)/maps/hector.yaml"/>

  <!-- Run AMCL -->
  <include file="$(find rbcar_navigation)/launch/navigation_amcl/amcl.launch" />

  <!-- Run move_base -->
  <node pkg="move_base" type="move_base" respawn="false" name="move_base" output="screen">
    <rosparam file="$(find rbcar_navigation)/config_navigation/diff_drive/costmap_common_params.yaml" command="load" ns="global_costmap" />
    <rosparam file="$(find rbcar_navigation)/config_navigation/diff_drive/costmap_common_params.yaml" command="load" ns="local_costmap" />
    <rosparam file="$(find rbcar_navigation)/config_navigation/diff_drive/local_costmap_params.yaml" command="load" />
        <rosparam file="$(find rbcar_navigation)/config_navigation/diff_drive/global_costmap_params.yaml" command="load" />
        <rosparam file="$(find rbcar_navigation)/config_navigation/diff_drive/teb_local_planner_params.yaml" command="load" />

        <param name="base_global_planner" value="SBPLLatticePlanner"/>
        <param name="SBPLLatticePlanner/primitive_filename" value="$(find sbpl)/matlab/mprim/carlike.mprim" />
        <param name="planner_frequency" value="1.0" />
        <param name="planner_patience" value="5.0" />

    <param name="base_local_planner" value="teb_local_planner/TebLocalPlannerROS" />
    <param name="controller_frequency" value="5.0" />
        <param name="controller_patience" value="15.0" />

        <param name="clearing_rotation_allowed" value="false" />
  </node>

  <!-- robot_pose_ekf -->
  <node pkg="robot_pose_ekf" type="robot_pose_ekf" name="robot_pose_ekf">
    <param name="output_frame" value="odom_combined"/>
    <param name="base_footprint_frame" value="base_footprint"/>
    <param name="freq" value="30.0"/>
    <param name="sensor_timeout" value="1.0"/>
    <param name="odom_used" value="true"/>
    <param name="imu_used" value="true"/>
    <param name="vo_used" value="true"/>
    <param name="debug" value="false"/>
    <param name="self_diagnose" value="false"/>
  </node>

  <!-- Hector SLAM -->
  <include file="$(find chassis_gazebo)/launch/hector_slam.launch" />

  <!-- Rviz -->
  <node pkg="rviz" type="rviz" name="rviz" args="-d $(find rbcar_navigation)/config_rviz/chassis_navigation.rviz"/>

  <node pkg="rbcar_twist2ack" type="cmd_vel_to_ackermann_drive.py" name="cmd_vel_to_ackermann_drive"/>

</launch>

When I run my launch files I get a tf error though. I am missing a tf from map link to odomcombined and from odomcombined to base_footprint. Can you please help me solve this problem. Thank you very much

Asked by gleb on 2016-09-28 09:10:27 UTC

Comments

hello, you got any solution, I am facing the same issue

Asked by Karim Ahmt on 2018-09-21 22:43:50 UTC

Answers