Ask Your Question
5

Looking for a reference use of PoseWithCovariance: any pkg using it?

asked 2012-03-30 23:45:40 -0600

updated 2014-01-28 17:11:35 -0600

ngrennan gravatar image

Hi all,

PoseWithCovariance has a 6x6 covariance matrix which, according to REP 103, corresponds to these variables in this order: (x, y, z, rotation about X axis, rotation about Y axis, rotation about Z axis). With rotation around fixed axes, not like in the "common" yaw/pitch/roll various conventions.

I'm working in a pkg for covariance transformations (pose_cov_ops) so it would be great if I could compare my numerical results with any other existing ROS packages that output PoseWithCovariance at present. Checks would go in the package unit tests.

More explicitly: I'm looking for some "stable" ROS package which computes covariances in 6D, so I can peek its source code and make sure I'm following the right convention.

Any recommendation?

If there're none, I'll assume the 3x3 rotation matrix is as follows:

R = R_x(roll) * R_y(pitch) * R_z(yaw)

R = R_z(yaw) * R_y(pitch) * R_x(roll)

where matrices are in the inverse same order than the non-global axis, yaw-pitch-roll convention.

PS: wouldn't it have made more sense to keep a 7x7 covariance for the unit quaternion form? In general, equations for uncertainty propagation in this form are far simpler than for Euler angles. Is there room for a PoseWith7x7CovarianceStamped yet?

edit retag flag offensive close merge delete

Comments

Just for the records: the numerical values of yaw/pitch/roll in the dynamic-axes (rotating) convention are exactly the same than those in the roll/pitch/yaw fixed-axes convention. So a conversion of covariance matrices between both formats becomes just a permutation. Hope it may help someone else.

Jose Luis Blanco gravatar imageJose Luis Blanco ( 2012-04-11 15:02:15 -0600 )edit

3 Answers

Sort by » oldest newest most voted
1

answered 2012-06-25 06:50:31 -0600

updated 2012-07-03 10:23:31 -0600

AFAIK there is no ROS package which make the transform between two poses with uncertainty (perhaps http://ros.org/wiki/bfl but I don't think so). Because of this the package pose_cov_ops seems unique. I belive that the MRPT ([[mrpt-ros-pkg]]) in which the pose_cov_ops package is based looks very powerful handling poses with uncertainty and ROS should take advantage of this fact.

I think that this package should be integrated in the generic http://ros.org/wiki/tf2 package as a plugin in a similar way that the kdl package was integrated (see https://kforge.ros.org/geometry/experimental/file/40be50217595/tf2_geometry_msgs/include/tf2_geometry_msgs/tf2_geometry_msgs.h). Perhaps the tf2 package should be refactored to support more explicitly the inverse tranformation or at least the unary inverse transform.

Edit: Definitely I think you can find what you are looking for in the source code of the package http://ros.org/wiki/robot_pose_ekf

Regards.

edit flag offensive delete link more
1

answered 2012-07-03 12:02:34 -0600

cagatay gravatar image

updated 2012-07-03 12:12:29 -0600

uncertain_tf is an extension to tf that allows to maintain uncertainty in the translation and rotation of coordinate frames.

if you want to add uncertainity to your odometry data in 6D you should check out robot_pose_ekf

turtlebot and pr2 use uncertainity for their odom datas check out this example of turtlebot

https://kforge.ros.org/turtlebot/turtlebot/file/e47d5a1dca1c/turtlebot_node/nodes/turtlebot_node.py

here is another example from cwru robotics' package

https://github.com/cwru-robotics/cwru-ros-pkg/blob/master/cwru_semi_stable/cwru_base/src/odom_translator.py

edit flag offensive delete link more
1

answered 2012-06-25 06:59:17 -0600

dornhege gravatar image

updated 2012-06-25 06:59:29 -0600

There is tf_uncertainty that might do what you are looking for.

edit flag offensive delete link more

Comments

I don't locate in the package source code the gaussian error propagation (using Jacobians) produced by the nonlinear tranforms. The resulting uncertainty after a transform is represented by a pose cloud(particles) and not as a PoseWithCovariance. In such case it is not what José Luis is looking for.

Pablo Iñigo Blasco gravatar imagePablo Iñigo Blasco ( 2012-06-26 00:24: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

2 followers

Stats

Asked: 2012-03-30 23:45:40 -0600

Seen: 1,048 times

Last updated: Jul 03 '12