Function roboplan_ros_cpp::se3ToPose

Function Documentation

geometry_msgs::msg::Pose roboplan_ros_cpp::se3ToPose(const Eigen::Matrix4d &transform)

Convert a 4x4 SE3 transformation matrix to ROS Pose.

Parameters:

transform – 4x4 Eigen matrix representing an SE3 transformation

Returns:

An equivalent ROS Pose message