這篇文章主要介紹了python如何將四元數(shù)變換為旋轉(zhuǎn)矩陣,具有一定借鑒價(jià)值,感興趣的朋友可以參考下,希望大家閱讀完這篇文章之后大有收獲,下面讓小編帶著大家一起了解一下。
如下所示:
import numpy as np from autolab_core import RigidTransform # 寫上用四元數(shù)表示的orientation和xyz表示的position orientation = {'y': -0.6971278819736084, 'x': -0.716556549511624, 'z': -0.010016582945017661, 'w': 0.02142651612120239} position = {'y': -0.26022684372145516, 'x': 0.6453529828252734, 'z': 1.179122068068349} rotation_quaternion = np.asarray([orientation['w'], orientation['x'], orientation['y'], orientation['z']]) translation = np.asarray([position['x'], position['y'], position['z']]) # 這里用的是UC Berkeley的autolab_core,比較方便吧,當(dāng)然可以自己寫一個(gè)fuction來計(jì)算,計(jì)算公式在https://www.cnblogs.com/flyinggod/p/8144100.html T_qua2rota = RigidTransform(rotation_quaternion, translation) print(T_qua2rota) # 以下是打印的結(jié)果 Tra: [ 0.64535298 -0.26022684 1.17912207] Rot: [[ 0.02782477 0.99949234 -0.01551915] [ 0.99863386 -0.02710724 0.0446723 ] [ 0.04422894 -0.01674094 -0.99888114]] Qtn: [-0.02142652 0.71655655 0.69712788 0.01001658] from unassigned to world
自己寫的話
def quaternion_to_rotation_matrix(quat): q = quat.copy() n = np.dot(q, q) if n < np.finfo(q.dtype).eps: return np.identity(4) q = q * np.sqrt(2.0 / n) q = np.outer(q, q) rot_matrix = np.array( [[1.0 - q[2, 2] - q[3, 3], q[1, 2] + q[3, 0], q[1, 3] - q[2, 0], 0.0], [q[1, 2] - q[3, 0], 1.0 - q[1, 1] - q[3, 3], q[2, 3] + q[1, 0], 0.0], [q[1, 3] + q[2, 0], q[2, 3] - q[1, 0], 1.0 - q[1, 1] - q[2, 2], 0.0], [0.0, 0.0, 0.0, 1.0]], dtype=q.dtype) return rot_matrix
感謝你能夠認(rèn)真閱讀完這篇文章,希望小編分享的“python如何將四元數(shù)變換為旋轉(zhuǎn)矩陣”這篇文章對大家有幫助,同時(shí)也希望大家多多支持創(chuàng)新互聯(lián)成都網(wǎng)站設(shè)計(jì)公司,關(guān)注創(chuàng)新互聯(lián)成都網(wǎng)站設(shè)計(jì)公司行業(yè)資訊頻道,更多相關(guān)知識等著你來學(xué)習(xí)!
另外有需要云服務(wù)器可以了解下創(chuàng)新互聯(lián)scvps.cn,海內(nèi)外云服務(wù)器15元起步,三天無理由+7*72小時(shí)售后在線,公司持有idc許可證,提供“云服務(wù)器、裸金屬服務(wù)器、網(wǎng)站設(shè)計(jì)器、香港服務(wù)器、美國服務(wù)器、虛擬主機(jī)、免備案服務(wù)器”等云主機(jī)租用服務(wù)以及企業(yè)上云的綜合解決方案,具有“安全穩(wěn)定、簡單易用、服務(wù)可用性高、性價(jià)比高”等特點(diǎn)與優(yōu)勢,專為企業(yè)上云打造定制,能夠滿足用戶豐富、多元化的應(yīng)用場景需求。
當(dāng)前文章:python如何將四元數(shù)變換為旋轉(zhuǎn)矩陣-創(chuàng)新互聯(lián)
標(biāo)題URL:http://www.ekvhdxd.cn/article2/dojioc.html
成都網(wǎng)站建設(shè)公司_創(chuàng)新互聯(lián),為您提供網(wǎng)站制作、微信公眾號、面包屑導(dǎo)航、網(wǎng)站排名、云服務(wù)器、品牌網(wǎng)站制作
聲明:本網(wǎng)站發(fā)布的內(nèi)容(圖片、視頻和文字)以用戶投稿、用戶轉(zhuǎn)載內(nèi)容為主,如果涉及侵權(quán)請盡快告知,我們將會在第一時(shí)間刪除。文章觀點(diǎn)不代表本網(wǎng)站立場,如需處理請聯(lián)系客服。電話:028-86922220;郵箱:631063699@qq.com。內(nèi)容未經(jīng)允許不得轉(zhuǎn)載,或轉(zhuǎn)載時(shí)需注明來源: 創(chuàng)新互聯(lián)
猜你還喜歡下面的內(nèi)容