溫馨提示×

溫馨提示×

您好,登錄后才能下訂單哦!

密碼登錄×
登錄注冊×
其他方式登錄
點擊 登錄注冊 即表示同意《億速云用戶服務條款》

Python根據(jù)歐拉角求旋轉(zhuǎn)矩陣的實例

發(fā)布時間:2020-09-28 10:05:08 來源:腳本之家 閱讀:398 作者:nudt_qxx 欄目:開發(fā)技術

利用numpy和scipy,我們可以很容易根據(jù)歐拉角求出旋轉(zhuǎn)矩陣,這里的旋轉(zhuǎn)軸我們你理解成四元數(shù)里面的旋轉(zhuǎn)軸

  import numpy as np
  import scipy.linalg as linalg
  import math
  #參數(shù)分別是旋轉(zhuǎn)軸和旋轉(zhuǎn)弧度值
  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軸,也可以自定義旋轉(zhuǎn)軸
  yaw = 0.7854 #pi/4
  rot_matrix = rotate_mat(axis_z, yaw)#繞Z軸旋轉(zhuǎn)pi/4

求出旋轉(zhuǎn)矩陣后我們可以結(jié)合原始坐標, 直接用np.dot求出旋轉(zhuǎn)前后的坐標.

new_coor = np.dot(old_coor, rot_matrix)

以上這篇Python根據(jù)歐拉角求旋轉(zhuǎn)矩陣的實例就是小編分享給大家的全部內(nèi)容了,希望能給大家一個參考,也希望大家多多支持億速云。

向AI問一下細節(jié)

免責聲明:本站發(fā)布的內(nèi)容(圖片、視頻和文字)以原創(chuàng)、轉(zhuǎn)載和分享為主,文章觀點不代表本網(wǎng)站立場,如果涉及侵權請聯(lián)系站長郵箱:is@yisu.com進行舉報,并提供相關證據(jù),一經(jīng)查實,將立刻刪除涉嫌侵權內(nèi)容。

AI