Added better test coverage for orthonormlize and samplepoint