%função translação

function T=Trans(P)     %ou em vez de P podemos por (Px,Py,Pz)
T=[1 0 0 P(1);0 1 0 P(2);0 0 1 P(3);0 0 0 1];