ArduCopter: changed alt hold to use the sonar if enabled and healthy