Microsoft Kinect，從3D深度圖到2D

Question

我試圖通過使用kinect的快照獲取深度圖，然后制作此快照的2D圖。 目的是制作房間的地圖。 使用的算法如下：

% Matrice della figura
z=snapshot;

% Dati noti

h=size(z,1);    %480 

w=size(z,2);    %640

% M is a constant based on the field of view angle
 M1=1.12032;  % Costante per le X
 M2=0.84024;   % Costante per le Y


for i=1:h  <br>
    for j=1:w


x(i,j)=(j-(w/2))*(320/w)*M1*z(i,j);

if x(i,j)==0
    x(i,j)=NaN;
end


y(i,j)=(i-(h/2))*(240/h)*M2*z(i,j);

if y(i,j)==0
    y(i,j)=NaN;
end

end
end


Z=min(z);

X=min(x);


figure
plot(Z,X)

問題在於該算法沒有執行應做的事情。 有人能幫我嗎？

Answer 1

您可以刪除嵌套循環

x = bsxfun( @times, linspace( -w/2, w/2, w ), z*(320/w)*M1 );
x(x==0) = NaN;
y = bsxfun( @times, linspace( -h/w, h/2, h ).', z*(240/h)*M2 ); 
y( y==0 ) = NaN;