Function roboplan_ros_cpp::poseToSE3

Function Documentation

Eigen::Matrix4d roboplan_ros_cpp::poseToSE3(const geometry_msgs::msg::Pose &pose)

Convert ROS Pose to a 4x4 SE3 transformation matrix.

Parameters:

pose – ROS Pose message

Returns:

4x4 Eigen matrix representing the SE3 transformation