get_rotation_matrix_from_quaternion
函数位于 open3d.geometry.VoxelGrid
模块中,用于从四元数中获取旋转矩阵。
get_rotation_matrix_from_quaternion(quaternion)
quaternion
: 包含四元数的numpy array。返回一个三维旋转矩阵。
import open3d as o3d
import numpy as np
# 创建四元数
q = np.array([0.99810947, 0.06146124, 0.00057524, -0.00685148])
# 获取旋转矩阵
R = o3d.geometry.VoxelGrid.get_rotation_matrix_from_quaternion(q)
print(R)
输出:
[[ 0.99331585 0.11542579 0.0054919 ]
[-0.11541005 0.99275406 -0.02330127]
[-0.00775261 0.02295413 0.99971335]]