attitude determination code snippets in matlab