tf::Quaternion to geometry_msgs::Pose geometry_msgs::PoseStamped to tf::Transform tf::Transform to tf::Matrix3x3 get each element of tf::Matrix3x3 Ref: I tried convert tf::Pose to geomtery_msgs and memorize it in here. But I don't think th…