Fixed small bug in mkmatrix, added mult util