ArduCopter: added get_throttle_althold_with_slew to allow slower altitude target changes

Improved surface tracking by using slewed althold controller
Reduced sonar mode filter to just 3 elements to reduce lag but at the possible consequence of allowing sonar noise to creep through for people with margin sonar set-ups.