import numpy as np
import cv2
from PIL import Image, ImageDraw
import copy
from scipy.spatial.transform import Rotation as R
def eulerAnglesToRotationMatrix(theta):
# 将角度转换为弧度
theta_rad = np.radians(theta)
# 构造绕 x、y、z 轴的旋转矩阵
R_x = np.array([[1, 0, 0],
[0, np.cos(theta_rad[0]), -np.sin(theta_rad[0])],
[0, np.sin(theta_rad[0]), np.cos(theta_rad[0])]])
R_y = np.array([[np.cos(theta_rad[1]), 0, np.sin(theta_rad[1])],
[0, 1, 0],
[-np.sin(theta_rad[1]), 0, np.cos(theta_rad[1])]])
R_z = np.array([[np.cos(theta_rad[2]), -np.sin(theta_rad[2]), 0],
[np.sin(theta_rad[2]), np.cos(theta_rad[2]), 0],
[0, 0, 1]])
# 计算总的旋转矩阵
R = np.dot(R_z, np.dot(R_y, R_x))
return R
def rotation_matrix_to_euler_angles(rotation_matrix):
r = R.from_matrix(rotation_matrix)
euler_angles = r.as_euler('xyz', degrees=True)
return euler_angles
旋转矩阵和欧拉角之间的相互转换代码
©著作权归作者所有,转载或内容合作请联系作者
- 文/潘晓璐 我一进店门，熙熙楼的掌柜王于贵愁眉苦脸地迎上来，“玉大人，你说我怎么就摊上这事。” “怎么了？”我有些...
- 文/花漫 我一把揭开白布。 她就那样静静地躺着，像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上，一...
- 文/苍兰香墨 我猛地睁开眼，长吁一口气：“原来是场噩梦啊……” “哼！你这毒妇竟也来了？” 一声冷哼从身侧响起，我...
推荐阅读更多精彩内容
- 欧拉角转旋转矩阵 对于两个三维点 ，，由点经过旋转矩阵旋转到，则有： 任何一个旋转可以表示为依次绕着三个旋转轴旋三...
- 参考文章[https://blog.csdn.net/u011906844/article/details/121...
- 四元数（quaternion）和旋转矩阵（rotation matrix）之间的相互转换在计算机图形学和三维计算中...
