function T=Trans3D(tx,ty,tz)

T =[1 0 0 tx
    0 1 0 ty
    0 0 1 tz
    0 0 0 1];