Function orthoNormalMatrix

Setup an orientation matrix using 3 basis normalized vectors

Matrix!(T,4) orthoNormalMatrix(T) (
  Vector!(T,3) xdir,
  Vector!(T,3) ydir,
  Vector!(T,3) zdir
);