updated ultrasound conf and hyst handling
Merge branch 'Reorg' of https://github.com/madcowswe/Mavrx-firmware into Reorg