added Matrix transpose, fixed const problems in matrix multiplication