sensor fusion code snippets in matlab