Fix the "scaled" / "unscaled" naming issue
Start to use SMA filter to filter the IMU raw data
Fix the prototype warning