Added Matrix3 class
Removed commented out code
Removed unnecessary for loop
Code tidy up and reorganisation