orthonorm function

Orthonormalizes a square, invertible matrix