Got identity matrix, multiplication, translation, and scaling working. Need to fix rotation