双目深度图像处理

clear; clc; t1=cputime; A1=imread('view1.png'); B1=imread('view5.png'); A=double(A1(:,:,1)); B=double(B1(:,:,1)); a=1; b=1; AA=zeros(4,4,180,264); for i=1:1:180 for j=1:1:264 AA(:,:,i,j)=A(b:b+3,a:a+3); a=mod(a+4,1056); end; b=mod(b+4,720); end; AA=double(AA); mindis = 100000; pos_old=zeros(180,264,2); pos_new=zeros(180,264,2); for i=1:1:180 for j=1:1:264 pos_old(i,j,1)=(i-1)*4+1; pos_new(i,j,1)=(i-1)*4+1; pos_old(i,j,2)=(j-1)*4+1; pos_new(i,j,2)=(j-1)*4+1; end; end; for m=1:1:180 for n=1:1:264 mindis=100000; for i=0:1:20 if(pos_old(m,n,1)-i<1) start1=1; else start1=pos_old(m,n,1)-i; end; if(pos_old(m,n,2)-i<1) start2=1; else start2=pos_old(m,n,2)-i; end; if(pos_old(m,n,1)+i>720-4) end1=720-4; else end1=pos_old(m,n,1)+i; end; if(pos_old(m,n,2)+i>1056-4) end2=1056-4; else end2=pos_old(m,n,2)+i; end; [dis,x,y]=dis_cal(AA(:,:,m,n),B,start1,end1,start2,end2); if(dis<mindis) mindis=dis; pos_new(m,n,1)=x; pos_new(m,n,2)=y; end; end; end; end; distance=abs(pos_new(:,:,1)-pos_old(:,:,1)); minx=100000; maxx=-1; for i=1:1:180 for j=1:1:264 if(distance(i:j)>maxx) maxx=distance(i:j); end; if(distance(i:j)<minx) minx=distance(i:j); end; end; end; rgb_tmp=255.*(distance-minx)./(maxx-minx); tmp=zeros(4,4); rgb=zeros(720,1056); a=1; b=1; for i=1:1:180 for j=1:1:264 for m=1:1:4 for n=1:1:4 tmp(m,n)=rgb_tmp(i,j); end; end; rgb(b:b+3,a:a+3)=tmp(:,:); a=mod(a+4,1056); end; b=mod(b+4,720); end; rgb=uint8(rgb); imshow(rgb); t2=cputime; fprintf('timecost=%f\n',t2-t1);