True delta calcs (very much work in progress)

This builds for me with avr-gcc and seems to build in Arduino 103
I'll try putting it on a board later