heaviside code snippets in matlab