Мельком смотрел этот проект. Что-то там не то с математикой. Но "вертеть головой" будет, собственно там и показано.
Точно не то. Функция FilterSensorData не по классике, а тупой смутинг. Но голова "двигаться" всеравно будет, дело привычки...