Removed orthonormalization in each step, added overlap modification to Hsub. This might be more efficient and faster than previous... though it's hard to tell on my laptop.