sonar althold

sonar altitude hold for baseflight