Fix the EMA last data wasn't initialize issue
Fix the gyro integrate input variable issue