function [M]=trans(x,y,z)
%Matriz transformação 3D
%   Matriz de transformação homogénea no espaço 

M=[1    0       0       x
   0    1       0       y
   0    0       1       z
   0    0       0       1];


end