Tune the adaptive complementry filter (accel_const = 0.35)
Fix the acceleration boudary not working issue