Working on prediagonalization subroutines...