python 四元数转欧拉角函数,欧拉角转换成四元数

import sysimport mathw = float(sys.argv[4])x = float(sys.argv[1])y = float(sys.argv[2])z = float(sys.argv[3])r = math.atan2(2*(w*x+y*z),1-2*(x*x+y*y))p = math.asin(2*(w*y-z*x))y = math.atan2(2*(w*z+x*y),1-2*(z*z+y*y))angleR = r*180/math.piangleP = p*180/math.piangleY = y*180/math.piprint (angleR)print (angleP)print (angleY)

原文链接：https://blog.csdn.net/pengcan985632236/article/details/85230675