Sonar ADC Firmware

Finish implementing this firmware, and test it on the ADC.

Currently, the code for this is in another repository, so it will have to be imported by me first. (It is not the typical Teensy firmware as well)