Fixed bugs in creating identity matrices. Mistakenly created matrices that had 1 in all of its elements instead of just in the main diagonal.