BaroGlitch: add reset method
Copter: reset baro glitch after baro init