Clean up code. Add JTAG reset from program rom.