Add matrix_trans_dense and matrix_mutl_dense