Add explicit orthogonalization of psi_1