Python根据欧拉角求旋转矩阵的实例
更新时间:2019年01月28日 09:45:36 作者:nudt_qxx
今天小编就为大家分享一篇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)
以上这篇Python根据欧拉角求旋转矩阵的实例就是小编分享给大家的全部内容了,希望能给大家一个参考,也希望大家多多支持脚本之家。
相关文章
python中parser.add_argument()用法实例(命令行选项、参数和子命令解析器)
最近开始读论文代码了,遇到一个名字叫option的py文件,打开一看清一色的parser.add_argument(),看得是一脸懵逼,这篇文章主要给大家介绍了关于python中parser.add_argument()用法的相关资料,需要的朋友可以参考下2022-03-03
最新评论