self-propulsion code snippets in matlab