Yaw角到Quaternion geometry_msgs::Quaternion geo_q = tf::createQuaternionMsgFromYaw(refLinePose_.yaw); Quaternion到Yaw角 double yaw=tf::getYaw(i.pose.orientation); //