The C++ implementation still needs the extra orthogonalization step. Also maybe better eigenvalue computation.