通过输入旋转矩阵T可以计算出欧拉角RPY,也可以计算出四元素Q[4];也可以通过欧拉角RPY来计算出旋转矩阵