Worked matrix class a little
Matrix stuff added