Fixed USB reading and writing config data

Also I added three registers that the user can use to talk to the MCU,
so far the map includes

0xB0: Start Debug Mode
0xB1: Comm Mode (FPGA communication mode)
0xB2: FPGA Config (this was already here)
0xB3: Read/Write Config