网络编程
位置:首页>> 网络编程>> Python编程>> Python根据欧拉角求旋转矩阵的实例

Python根据欧拉角求旋转矩阵的实例

作者:nudt_qxx  发布时间:2022-09-03 15:11:00 

标签:Python,欧拉角,旋转,矩阵

利用numpy和scipy,我们可以很容易根据欧拉角求出旋转矩阵,这里的旋转轴我们你理解成四元数里面的旋转轴


 import numpy as np
 import scipy.linalg as linalg
 import math
 #参数分别是旋转轴和旋转弧度值
 def rotate_mat(self, axis, radian):
   rot_matrix = linalg.expm(np.cross(np.eye(3), axis / linalg.norm(axis) * radian))

axis_x, axis_y, axis_z = [1,0,0], [0,1,0], [0, 0, 1]#分别是x,y和z轴,也可以自定义旋转轴
 yaw = 0.7854 #pi/4
 rot_matrix = rotate_mat(axis_z, yaw)#绕Z轴旋转pi/4

求出旋转矩阵后我们可以结合原始坐标, 直接用np.dot求出旋转前后的坐标.


new_coor = np.dot(old_coor, rot_matrix)

来源:https://blog.csdn.net/xiangxianghehe/article/details/81626253

0
投稿

猜你喜欢

手机版 网络编程 asp之家 www.aspxhome.com