Adding code for firmware. Works nice with teensy and NES controller. need test with snes.