I've been trying to get all the code together, but I keep running into unusual issues with the AVR. The code is doing some unusual bootloop, which started when trying to push floats via printf. Unless I find the cause I'll have to write my own float to string function.