Add matrix-vector multiplication routine