1 #ifndef eigen_geometry_msgs_h 
    2 #define eigen_geometry_msgs_h 
    5 #include "geometry_msgs/PoseArray.h" 
geometry_msgs::PoseArray pose_array_from_eigen_matr(Eigen::MatrixXd pos)
Eigen::MatrixX3d eigen_matr_from_pose_array(geometry_msgs::PoseArray pose_array)