旋转向量转为旋转矩阵 python

最新推荐文章于 2024-07-05 03:46:57 发布

江江哇

最新推荐文章于 2024-07-05 03:46:57 发布

阅读量318

点赞数

文章标签： python 矩阵 numpy

本文链接：https://blog.csdn.net/weixin_49766448/article/details/129560556

版权

这段代码展示了如何使用OpenCV库中的Rodrigues函数进行三维旋转矩阵的计算。首先初始化一个零向量，然后通过Rodrigues变换得到旋转矩阵，接着提取旋转矩阵的特定元素构造新的向量，再次应用Rodrigues变换，最后对一个给定向量执行旋转变换。

摘要由CSDN通过智能技术生成

import os
import cv2
import numpy as np
T = np.zeros((1,3), np.float32)
a = (0.001,0.006,-0.0009)
print (a)
R = cv2.Rodrigues(a)
print (R[0])
v3 = (R[0][2,1],R[0][0,2],R[0][1,0])
print (v3)
c = cv2.Rodrigues(v3)
print (c[0])
b = cv2.Rodrigues(R[0])
print (b[0])
p = (-2.100418,-2.167796,0.27330)
print(cv2.Rodrigues(p)[0])