ArduCopter codes with Collision avoidance enabled, altitude hold for a given height.