Now just to get it running and tested.

Edit: It lives, albeit after a few issues getting the existing ranging code to run on an MCU with half the RAM and newer architecture (turns out static libraries for avrxmega6 don't like to compile for avrxmega7):