void clacToolPose(RcEuler orginPt, RcEuler xVectorPt, RcEuler zVectorPt, RcEuler &dstRcEuler) { *************求解轨迹点对应的姿态角*************// Eigen::Vector3f n0; //存储x方向上的单位向量 Eigen::Vector3f o0; //存储y方向上的单位向量 Eigen::Vector3f a0; //存储z方向上的单位向量