Quantcast
Channel: ROS Answers: Open Source Q&A Forum - RSS feed
Viewing all articles
Browse latest Browse all 222

Problem while integrating GPS data into robot_localization

$
0
0
Hi to Tom and everybody, I'm currently making some experiments with robot_localization, and I'm having some problems with the integration of GPS data for global localization of a non-holonomic mobile robot constrained to a 2D plane (no Z coordinate and no roll/pitch). Here is the overview of my setup for odometry which is very similar to the one described in [this section](http://docs.ros.org/kinetic/api/robot_localization/html/integrating_gps.html#notes-on-fusing-gps-data) of the wiki where the use of a dual EKF node is discussed. ![Odometry overview](https://photos-3.dropbox.com/t/2/AABgo1qbTgRsWn1QWJffRDG9YHi0WDSC6Z3Bovu5KxLIpA/12/524218/jpeg/32x32/1/_/1/2/odometry.jpg/EO3iShis6LTcBCACKAI/72hNxdqa8RZf80ozkx0Wv21v2aVjDTdHloNmpXWcT8w?size_mode=5) - X and Y are bidimensional coordinates - Vx and Vy are linear velocities - H*, X** and Y** are angular velocity and linear accelerations, respectively - The topic name is inside parentheses - The provided TF transformation is inside square brackets This is my **launch file** (only the part relevant to replay the bag file): [ false, false, false, false, false, false, true, true, false, false, false, false, false, false, false ] [ false, false, false, false, false, false, false, false, false, false, false, true, true, true, false ][43.542883, 11.571365, 0] [ false, false, false, false, false, false, true, true, false, false, false, false, false, false, false ] [ true, true, false, false, false, false, false, false, false, false, false, false, false, false, false ] [ false, false, false, false, false, false, false, false, false, false, false, true, true, true, false ] And below there is the output of `rqt_graph` which I suppose it's correct, except I don't know why "navsat_transform" is not subscribed to topic "/odometry/imu" even if I specified it with a remap. ![image description](http://i67.tinypic.com/2wgw3h1.jpg) [This](https://www.dropbox.com/s/bljxrfje7xgmp52/data.bag?dl=0) is the link to download the **bag file** that can be used with the above launch file. When launched, this is the TF tree I'm seeing with `rosrun rqt_tf_tree rqt_tf_tree` that makes sense to me. ![TF](http://i68.tinypic.com/iy0ob5.jpg) [Here](https://www.dropbox.com/s/6yguf9f9779inja/odometry.rviz?dl=0) you can download the RVIZ config file to obtain the same visualization I'm using. While replaying the bag file, the `odom_link-->base_link` transformation is correctly calculated by the Kalman filter (I'm having pretty good accuracy, too!), but it seems there are problems with the `map-->odom` transformation, because I see these warnings multiple times: [ WARN] [1485356716.681560393]: Transform from odom_link to map_link was unavailable for the time requested. Using latest instead. [ WARN] [1485356718.683456544]: Transform from map_link to base_link was unavailable for the time requested. Using latest instead. Other than that, the estimated global pose start diverging after a few seconds and the coordinates become huge, it is not so clear in the following image, but this is what I see in RVIZ after setting "map" as the fixed frame. ![Map](http://i67.tinypic.com/281zqya.jpg) I would like to obtain something similar to what was presented by Tom here, but the GPS data is giving a really unpredictable behavior. Does anybody having these kind of issues with a similar setup? Many thanks, Guido

Viewing all articles
Browse latest Browse all 222


<script src="https://jsc.adskeeper.com/r/s/rssing.com.1596347.js" async> </script>