Ask Your Question
0

/odom and /vo priority in robot_pose_ekf

asked 2013-07-26 05:37:56 -0600

boog gravatar image

updated 2014-01-28 17:17:26 -0600

ngrennan gravatar image

Hi, my setup currently is using ccny_rgbd to provide /vo data and then using this with gmapping. If I publish odometry transforms then the vo corrects the odometry too much, what is the best way to change odom so it has a higher priority and robot_pose_ekf takes into account odom more than vo?

edit retag flag offensive close merge delete

1 Answer

Sort by ยป oldest newest most voted
3

answered 2013-07-26 06:32:27 -0600

This is controlled by the covariance part of the of the nav_msgs/Odometry and sensor_msgs/Imu messages subscribed to by robot_pose_ekf. Larger values in the covariance will cause that source to be "trusted" less.

edit flag offensive delete link more

Comments

Do you have any idea what sort of number range to put them as or can you link to some theory about it? Thanks. This is how it is set up for the /vo; I don't understand covariance matrices, I found this code on an answer here. Can you explain why 3 of the numbers are the 9s? odom.pose.covariance = boost::assign::list_of(VISUAL_COVARIANCE)(0)(0)(0)(0)(0) + (0)(VISUAL_COVARIANCE)(0)(0)(0)(0) + (0)(0)(999999)(0)(0)(0) + (0)(0)(0)(999999)(0)(0) + (0)(0)(0)(0)(999999)(0) + (0)(0)(0)(0)(0)(VISUAL_COVARIANCE); From: http://answers.ros.org/question/66489/combine-visual-odometry-data-from-ccny_rgbd-with-encodersimu/

boog gravatar imageboog ( 2013-07-26 09:55:28 -0600 )edit

The 999s are just large values, signaling a large covariance and are probably there because there is no information for the specific values (they are probably at z, roll, pitch, leaving non-large values for x,y, yaw).

dornhege gravatar imagedornhege ( 2013-07-27 05:46:59 -0600 )edit

Are you able to point out to me which column is used for yaw? Thanks. Edit: I changed (6,6) and it seems to have worked, but if I have done it wrong please correct me, thanks.

boog gravatar imageboog ( 2013-07-27 08:39:58 -0600 )edit

Your Answer

Please start posting anonymously - your entry will be published after you log in or create a new account.

Add Answer

Question Tools

1 follower

Stats

Asked: 2013-07-26 05:37:56 -0600

Seen: 452 times

Last updated: Jul 26 '13