MATLAB Answers

Plotting Covariance from poseWithCo​varianceSt​amped message

19 views (last 30 days)
Lasse Goncz
Lasse Goncz on 4 Mar 2020
Answered: Cam Salzberger on 1 May 2020
I have recorded a bagfile and am trying to plot the /amcl_pose/pose/covariance matrix which has a message type geometry_msgs/PoseWithCovarianceStamped. I followed this tutorial on plotting data from topics, however, when i try the below code i get the error The Pose.covariance property does not exist for message type geometry_msgs/PoseWithCovarianceStamped. What am I doing wrong?
bagselect = select(bag, 'Topic', '/amcl_pose');
msgs = readMessages(bagselect);
ts = timeseries(bagselect, 'Pose.Covariance');

  0 Comments

Sign in to comment.

Answers (1)

Cam Salzberger
Cam Salzberger on 1 May 2020
Hello Lasse,
I know this is a bit late to be responding to this, but maybe someone will still benefit. I believe the issue is that the use of "timeseries" with BagSelection objects is only valid for numeric, scalar properties. The "Covariance" field is an array of values, so it cannot be translated into a timeseries the way that, for example, "Pose.Pose.Point.X" would.
You should be able to see available fields by doing "timeseries" on the whole selection (or maybe limit the time first, just to make it faster) and see which data fields are available (in DataInfo.UserData).
-Cam

  0 Comments

Sign in to comment.