Added debug outputs for baro testing