added experimental code for baro control