Last week I wrote about problems with SLAM and odometrics measure, and next I added an upgrade to use IMU information to minimize the position error.
The first step is to fuse all data from IMU and from odometry with the Unscented Kalman filter. I have used the “robot_localization” node in ROS.
The new information “imu/data” (from RAZOR IMU sensor) and “unav_velocity_controller/odom” (from uNAV) was muxed in a new topic called “odometry/filtered”.
SLAM map built
The new file configuration is in my repository about 4UDE and the file configuration are in config folder.
To start the node estimator you must start the node with all information about all sensors:
<node pkg="robot_localization" type="ekf_localization_node" name="ekf_localization">
<rosparam command="load" file="$(find dude_control)/config/localization.yaml" />
Copyright © 2015. All Rights Reserved.