Function s_graphs::matrix2PoseStamped

Function Documentation

geometry_msgs::msg::PoseStamped s_graphs::matrix2PoseStamped(const rclcpp::Time &stamp, const Eigen::Matrix4f &pose, const std::string &frame_id)
Param :