Remove Systick in MEMS Initialization.
Add MEMS hardware filter setting.
Include mems file to main and make it compilable.