Conversion between Eigen::Matrix4d and geometry_msgs::TransformStamped?
What would be the correct conversion from Eigen::Matrix4d
to geometry_msgs::TransformStamped
or geometry_msgs::Transform
, and from geometry_msgs::TransformStamped
or geometry_msgs::Transform
to Eigen::Matrix4d
? Appreciate any help:-)