Question: Write a ros node (say eigens) in cpp that subscribes to the /amcl_pose topic, extracts the covariance matrix for the pose estimate and computes its

Write a ros node (say "eigens") in cpp that subscribes to the /amcl_pose topic, extracts the covariance matrix for the pose estimate and computes its eigenvectors and eigenvalues, so that the uncertainty ellipsoid can be determined. Note however that you can stop after you compute the eigenvector and eigenvalues and you do not need to compute the ellipsoid.

To compute the eigenvectors use this function:

http://docs.ros.org/kinetic/api/amcl/html/eig3_8h.html

Step by Step Solution

There are 3 Steps involved in it

1 Expert Approved Answer
Step: 1 Unlock blur-text-image
Question Has Been Solved by an Expert!

Get step-by-step solutions from verified subject matter experts

Step: 2 Unlock
Step: 3 Unlock

Students Have Also Explored These Related Databases Questions!