0
$\begingroup$

Rosanswers logo

I'm building a simple differential drive robot with the kinect+fake laser setup from the tutorials, and now I'm trying to do some navigation with move_base.

my transforms look like this, except instead of IMU I'm combining wheel encoder odometry and visual odometry from RTAB-map.

image description http://answers.ros.org/upfiles/14550571761943305.jpg

when visual odometry is used alone, it's mostly fine until the robot gets close to a wall or something. I'm trying to use robot_localization to combine the two odometries and feed it into RTAB-map as /odom_filtered.

en<node pkg="robot_localization" type="ekf_localization_node" name="ekf_localization" clear_params="true">
 <param name="frequency" value="20"/>
 <param name="sensor_timeout" value="1.5"/>
 <param name="two_d_mode" value="true"/>
 <param name="map_frame" value="map"/>
 <param name="odom_frame" value="odom"/>
 <param name="base_link_frame" value="base_link"/>
 <param name="world_frame" value="odom"/>
 <param name="transform_time_offset" value="0.0"/>

 <param name="odom0" value="/fake_odom"/>

 <rosparam param="odom0_config">[false, false, false,
                              false, false, false,
                              true, true, false,
                              false, false, true,
                              false, false, false]</rosparam>
 <param name="odom0_differential" value="true"/>

 <param name="odom1" value="/rtabmap/visual_odom"/>

 <rosparam param="odom1_config">[true, true, false,
                              false, false, true,
                              false, false, false,
                              false, false, false,
                              false, false, false]</rosparam>
 <param name="odom1_differential" value="false"/>

With robot_localization, after a while the map looks like this: image description

the 3d and 2d map becomes chaotic and shifts around each frame.

my view_frames looks like this: image description

any idea what I'm doing wrong? The visual odometry is only published at around 1hz, could that be a problem?


Originally posted by Jack000 on ROS Answers with karma: 40 on 2016-04-05

Post score: 0


Original comments

Comment by Tom Moore on 2016-05-09:
Can you post sample input messages, as well as your covariance matrices in your r_l config?

$\endgroup$

1 Answer 1

0
$\begingroup$

Rosanswers logo

I think it was just due to dropped frames. Kinectv2 has problems with certain usb hardware apparently and it starts to drop frames after about 30 seconds on my laptop..


Originally posted by Jack000 with karma: 40 on 2016-05-17

This answer was ACCEPTED on the original site

Post score: 0

$\endgroup$

Your Answer

By clicking “Post Your Answer”, you agree to our terms of service and acknowledge you have read our privacy policy.