Added sonar option to baro althold process