Simple firmware
Tweak speed, add TODOs. Still not ready for prime time- data rate is too low.