Fixed #2 Firmware should respect requested jtag speed.
Some caution should be taken in the future because if the current
code flow is modified, there could be room for modifying the GPID
waveform reg during a transaction thus leading to undefined
behavior.