Merged IMUFilter branch to main