Improved ISDIAG private function

sde_isdiag() greatly sped up (maybe 20x) -at least for large matrices.

Signed-off-by: Andrew D. Horchler <adh9@case.edu>