Ported URG code to px4 firmware.