Set EMA filter as default IMU filter
Rearrange the filter code