If anyone's interested, I could write it up and convert it from AVR assembler to Arduino sketch code.
Yes, please.
--Phil.
