Contains the necessary changes so that now the altitude hold uses the sonar distance derivative rather than the inertial navigation if the sonar readings are within bound