ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange
Ask Your Question
0

An incomprehension about geometry_msgs/PoseWithCovariance Message

asked 2020-02-26 06:59:49 -0500

YancenBOB gravatar image

Hi, I have a question about pose covariance.

In the doc website (link text), I see the covariance is shown as a matrix with 6*6 size and the parameters are x, y, z, rotation about X axis, rotation about Y axis, rotation about Z axis in order.

I am confused about the size and the parameters. The x,y,z are the coordinate of a 3D point and they are 3 parameters? And then, three rotations are shown in 33 matrix respectively? If it is, the all parameters are 3 + 39 = 30. Why 6*6 here?

Thank you!

edit retag flag offensive close merge delete

2 Answers

Sort by ยป oldest newest most voted
1

answered 2020-02-26 10:34:16 -0500

bob-ROS gravatar image

updated 2020-02-26 10:44:12 -0500

It is 6x6 because it is a covariance matrix with the 6 different states ( x, y, z, roll, pitch, yaw). The diagonal of this matrix is the variance ( the "spread" of a specific state, e.g. a high x position variance means it has a very large spread of values), the other values will be the "covariance" with respect to the other 5 states. If it is a pure diagonal matrix it means there is no covariance between the states.

https://datascienceplus.com/understan...

edit flag offensive delete link more

Comments

Thanks for your answer. By the way, I guess that the TwistWithCovariance is about the linear velocity of xyz and the rotation velocity about 3 axes?

YancenBOB gravatar image YancenBOB  ( 2020-03-01 19:28:46 -0500 )edit

Exactly. Just derive everything once.

bob-ROS gravatar image bob-ROS  ( 2020-03-02 02:19:58 -0500 )edit

Ok, I got it. Thanks you!

YancenBOB gravatar image YancenBOB  ( 2020-03-03 23:41:25 -0500 )edit

Question Tools

1 follower

Stats

Asked: 2020-02-26 06:59:49 -0500

Seen: 315 times

Last updated: Feb 26 '20