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