flight controller code snippets in matlab