OpenCV學習筆記（14）利用Matlab查看雙目視覺景深效果

http://blog.csdn.net/chenyusiyuan/article/details/5680518

在利用OpenCV的 reprojectImageTo3D 函數得到環境的三維（寬度、高度、深度）信息後，通過以下代碼保存一幀三維數據：

[c-sharp]  view plain copy

1. const double max_z = 1.0e4;  
2. FILE* fp = fopen("D://OpenCV2.1//Projects//RobotVision//Imgs//3d_data.txt", "wt");  
3. for(int y = 0; y < img3d.rows; y++)  
4. {  
5.     for(int x = 0; x < img3d.cols; x++)  
6.     {  
7.         Vec3f point = img3d.at<Vec3f>(y, x);  // Vec3f 是 template 類定義  
8.         if(fabs(point[2] - max_z) < FLT_EPSILON || fabs(point[2]) > max_z)  
9.             fprintf(fp, "%d %d %d/n", 0, 0, 0);  
10.         else  
11.             fprintf(fp, "%f %f %f/n", point[0], point[1], point[2]);  
12.     }  
13. }  
14. fclose(fp);  

然後在Matlab中讀入這些數據：

[c-sharp]  view plain copy

1. data = importdata('D:/OpenCV2.1/Projects/RobotVision/Imgs/3d_data.txt');  
2. xdata=data(:,1);ydata=data(:,2);zdata = data(:,3);  
3. xdata=-xdata;  
4. % 顯示深度圖  
5. figure;  
6. depth=reshape(zdata, [352 288]);  
7. mesh(depth);  
8. % 顯示重構的三維環境  
9. figure;  
10. [cx,cy] = meshgrid(min(xdata(:)):max(xdata(:)), ...  
11.                     min(ydata(:)):max(ydata(:)));  
12. cz=griddata(xdata,ydata,zdata,cx,cy,'cubic');  
13. mesh(cx,cy,cz);  
14. xlabel('Width');    ylabel('Height');   zlabel('Depth');  

由上述代碼可以得到如下深度圖和重構的三維環境效果，當然這樣的重構只是初步的，後期還需要用OpenGL來實現：

 

 

2010-10-13：

P.S. 也可以用如下代碼，三維效果更好：

[cpp]  view plain copy

1. data=importdata('C:/Stereo IO Data/xyz.txt');   
2. img=imread('C:/Stereo IO Data/lfFrame_01.jpg');   
3. x=data(:,1); y=data(:,2); z=data(:,3);   
4. ind=find(z==0);   
5. x(ind)=NaN; y(ind)=NaN; z(ind)=NaN;   
6. figure;   
7. mesh(x,z,-y,double(img'),'FaceColor','texturemap'); //img的像素灰度值用於mesh圖的紋理映射   
8. colormap(gray); // img圖是灰度圖，故 colormap 為 gray   
9. axis equal; axis([-100 100 0 900 -50 200]);   
10. xlabel('Horizonal');ylabel('Depth');zlabel('Vertical');   
11. view([0 90]); // 視角[0,90]代表正上方俯視