Fix mutiple command exec in JTAG

A function was put inside macros to do bitswapping. This leads
to execute 2 or 4 times the given function which is probably not
the intended behavior! Thanks 0xf4b for finding and reporting it.