? ?? 在做雙目立體視覺深度圖像生成的時候，遇到旋轉向量（1x3）與旋轉矩陣（3x3）的概念，得知二者可以通過羅德里格斯相互轉化。

1.旋轉的表示

? ? ?處理三維旋轉問題時，通常采用旋轉矩陣的方式來描述旋轉變換。旋轉矩陣有以下兩種方式得到。

? ?? ?物體在三維空間中的旋轉，可以被分為解為在直接坐標系下，分別先后圍繞x,y,z坐標軸旋轉得到。旋轉的角度也就是我們常聽到的角度roll，pitch，yew。如果已知這幾個角度，就可以直接通過每一步的矩陣相乘得到整個旋轉矩陣。

? ? ? ? ? ? ? ? ? ? ? ? ? ? ? R=R(yaw)R(pitch)R(roll)

R=R(yaw)R(pitch)R(roll)

? ? ? ?旋轉矩陣還可以理解為圍繞空間中某一個向量，直接一次旋轉某一個角度得到。在openCV相機標定時得到的旋轉向量r就是用這種方式。即由旋轉變量來描述。

2.旋轉向量得到旋轉矩陣

? ? ???旋轉向量的長度（模）表示繞軸逆時針旋轉的角度（弧度）。旋轉向量與旋轉矩陣可以通過羅德里格斯（Rodrigues）變換進行轉換。

? ? ? ?旋轉角度?θ=norm(r)? ? ? （norm表示求向量r的模長）
? ? ? ?單位向量?(rx,ry,rz)=r/θ?
? ? ? ?旋轉矩陣?

R=cos(θ)I+(1?cos(θ))rrT+sin(θ)∣∣∣∣∣0rz?ry?rz0rxry?rx0∣∣∣∣∣
? ? ? ?其中 I 為單位矩陣， rT 為 r 的轉置。?
? ? ? ?所以?
rrT=∣∣∣∣∣rx?rxry?rxrz?rxrx?ryry?ryrz?ryrx?rzry?rzrz?rz∣∣∣∣∣ 3.根據旋轉向量求另一個旋轉向量

? ? ? ?用r表示待旋轉的向量，v為旋轉向量的單位向量，θ為旋轉角，旋轉后的向量可以表示為?

r′=rcos(θ)+(1?cos(θ))(v?r)v+sin(θ)(v×r) 4.根據兩個旋轉向量求旋轉矩陣

（1）旋轉角度

? ? ? ?已知旋轉前向量為P, 旋轉后變為Q。由點積定義可知：

? ? ? ?可推出P，Q之間的夾角為：

（2）旋轉軸

? ? ? ?旋轉角所在的平面為有P和Q所構成的平面，那么旋轉軸必垂直該平面。

? ? ? ?假定旋轉前向量為a(a1, a2, a3)， 旋轉后向量為b（b1, b2, b3)。由叉乘定義得：

? ? ? ?所以旋轉軸c(c1, c2, c3)為：

5.OpenCV實現Rodrigues變換的函數為

int?cvRodrigues2(?const?CvMat*?src,?CvMat*?dst,?CvMat*?jacobian=0?);

? ? ?src為輸入的旋轉向量（3x1或者1x3）或者旋轉矩陣（3x3）。

? ? ?dst為輸出的旋轉矩陣（3x3）或者旋轉向量（3x1或者1x3）。

? ? ?jacobian為可選的輸出雅可比矩陣（3x9或者9x3），是輸入與輸出數組的偏導數。

驗證代碼如下：

#include <stdio.h> #include <cv.h>void main() {int i;double r_vec[3]={-2.100418,-2.167796,0.273330};double R_matrix[9];CvMat pr_vec;CvMat pR_matrix;cvInitMatHeader(&pr_vec,1,3,CV_64FC1,r_vec,CV_AUTOSTEP);cvInitMatHeader(&pR_matrix,3,3,CV_64FC1,R_matrix,CV_AUTOSTEP);cvRodrigues2(&pr_vec, &pR_matrix,0);for(i=0; i<9; i++){printf("%f\n",R_matrix[i]);} }

6、opencv另一種變換方法

//將旋轉向量轉化為旋轉矩陣 Mat_<float> r_l = (Mat_<float>(3, 1) << 0.04345, -0.05236, -0.01810);//左攝像機的旋轉向量 Mat_<float> r_r = (Mat_<float>(3, 1) << 0.04345, -0.05236, -0.01810);//右攝像機的旋轉向量 Mat R_R, R_L; Rodrigues(r_l, R_L); Rodrigues(r_r, R_R);

參考：

1?http://blog.csdn.net/tl_tj/article/details/47006007

2?http://blog.sina.com.cn/s/blog_5fb3f125010100hp.html

3?根據旋轉前后的兩個向量值，先求出旋轉角度和旋轉軸，然后用羅德里格旋轉公式即可求出對應的旋轉矩陣。?https://www.cnblogs.com/xpvincent/archive/2013/02/15/2912836.html

總結

以上是生活随笔為你收集整理的罗德里格斯（Rodrigues）旋转向量与矩阵的变换的全部內容，希望文章能夠幫你解決所遇到的問題。

如果覺得生活随笔網站內容還不錯，歡迎將生活随笔推薦給好友。