You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
 
 
 
 
 
 

480 lines
14 KiB

  1. /***************************************************************************
  2. * Copyright (C) 2005 by Dominic Rath *
  3. * Dominic.Rath@gmx.de *
  4. * *
  5. * Copyright (C) 2007,2008 √ėyvind Harboe *
  6. * oyvind.harboe@zylin.com *
  7. * *
  8. * Copyright (C) 2009 SoftPLC Corporation *
  9. * http://softplc.com *
  10. * dick@softplc.com *
  11. * *
  12. * Copyright (C) 2009 Zachary T Welch *
  13. * zw@superlucidity.net *
  14. * *
  15. * This program is free software; you can redistribute it and/or modify *
  16. * it under the terms of the GNU General Public License as published by *
  17. * the Free Software Foundation; either version 2 of the License, or *
  18. * (at your option) any later version. *
  19. * *
  20. * This program is distributed in the hope that it will be useful, *
  21. * but WITHOUT ANY WARRANTY; without even the implied warranty of *
  22. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
  23. * GNU General Public License for more details. *
  24. * *
  25. * You should have received a copy of the GNU General Public License *
  26. * along with this program; if not, write to the *
  27. * Free Software Foundation, Inc., *
  28. * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
  29. ***************************************************************************/
  30. #ifdef HAVE_CONFIG_H
  31. #include "config.h"
  32. #endif
  33. #include "jtag.h"
  34. #include "interface.h"
  35. /**
  36. * @see tap_set_state() and tap_get_state() accessors.
  37. * Actual name is not important since accessors hide it.
  38. */
  39. static tap_state_t state_follower = TAP_RESET;
  40. void tap_set_state_impl(tap_state_t new_state)
  41. {
  42. /* this is the state we think the TAPs are in now, was cur_state */
  43. state_follower = new_state;
  44. }
  45. tap_state_t tap_get_state()
  46. {
  47. return state_follower;
  48. }
  49. /**
  50. * @see tap_set_end_state() and tap_get_end_state() accessors.
  51. * Actual name is not important because accessors hide it.
  52. */
  53. static tap_state_t end_state_follower = TAP_RESET;
  54. void tap_set_end_state(tap_state_t new_end_state)
  55. {
  56. /* this is the state we think the TAPs will be in at completion of the
  57. current TAP operation, was end_state
  58. */
  59. end_state_follower = new_end_state;
  60. }
  61. tap_state_t tap_get_end_state()
  62. {
  63. return end_state_follower;
  64. }
  65. int tap_move_ndx(tap_state_t astate)
  66. {
  67. /* given a stable state, return the index into the tms_seqs[]
  68. * array within tap_get_tms_path()
  69. */
  70. int ndx;
  71. switch (astate)
  72. {
  73. case TAP_RESET: ndx = 0; break;
  74. case TAP_IDLE: ndx = 1; break;
  75. case TAP_DRSHIFT: ndx = 2; break;
  76. case TAP_DRPAUSE: ndx = 3; break;
  77. case TAP_IRSHIFT: ndx = 4; break;
  78. case TAP_IRPAUSE: ndx = 5; break;
  79. default:
  80. LOG_ERROR("FATAL: unstable state \"%s\" in tap_move_ndx()",
  81. tap_state_name(astate));
  82. exit(1);
  83. }
  84. return ndx;
  85. }
  86. /* tap_move[i][j]: tap movement command to go from state i to state j
  87. * encodings of i and j are what tap_move_ndx() reports.
  88. *
  89. * DRSHIFT->DRSHIFT and IRSHIFT->IRSHIFT have to be caught in interface specific code
  90. */
  91. struct tms_sequences
  92. {
  93. uint8_t bits;
  94. uint8_t bit_count;
  95. };
  96. /*
  97. * These macros allow us to specify TMS state transitions by bits rather than hex bytes.
  98. * Read the bits from LSBit first to MSBit last (right-to-left).
  99. */
  100. #define HEX__(n) 0x##n##LU
  101. #define B8__(x) \
  102. (((x) & 0x0000000FLU)?(1 << 0):0) \
  103. +(((x) & 0x000000F0LU)?(1 << 1):0) \
  104. +(((x) & 0x00000F00LU)?(1 << 2):0) \
  105. +(((x) & 0x0000F000LU)?(1 << 3):0) \
  106. +(((x) & 0x000F0000LU)?(1 << 4):0) \
  107. +(((x) & 0x00F00000LU)?(1 << 5):0) \
  108. +(((x) & 0x0F000000LU)?(1 << 6):0) \
  109. +(((x) & 0xF0000000LU)?(1 << 7):0)
  110. #define B8(bits,count) { ((uint8_t)B8__(HEX__(bits))), (count) }
  111. static const struct tms_sequences old_tms_seqs[6][6] = /* [from_state_ndx][to_state_ndx] */
  112. {
  113. /* value clocked to TMS to move from one of six stable states to another.
  114. * N.B. OOCD clocks TMS from LSB first, so read these right-to-left.
  115. * N.B. Reset only needs to be 0b11111, but in JLink an even byte of 1's is more stable.
  116. * These extra ones cause no TAP state problem, because we go into reset and stay in reset.
  117. */
  118. /* to state: */
  119. /* RESET IDLE DRSHIFT DRPAUSE IRSHIFT IRPAUSE */ /* from state: */
  120. { B8(1111111,7), B8(0000000,7), B8(0010111,7), B8(0001010,7), B8(0011011,7), B8(0010110,7) }, /* RESET */
  121. { B8(1111111,7), B8(0000000,7), B8(0100101,7), B8(0000101,7), B8(0101011,7), B8(0001011,7) }, /* IDLE */
  122. { B8(1111111,7), B8(0110001,7), B8(0000000,7), B8(0000001,7), B8(0001111,7), B8(0101111,7) }, /* DRSHIFT */
  123. { B8(1111111,7), B8(0110000,7), B8(0100000,7), B8(0010111,7), B8(0011110,7), B8(0101111,7) }, /* DRPAUSE */
  124. { B8(1111111,7), B8(0110001,7), B8(0000111,7), B8(0010111,7), B8(0000000,7), B8(0000001,7) }, /* IRSHIFT */
  125. { B8(1111111,7), B8(0110000,7), B8(0011100,7), B8(0010111,7), B8(0011110,7), B8(0101111,7) }, /* IRPAUSE */
  126. };
  127. static const struct tms_sequences short_tms_seqs[6][6] = /* [from_state_ndx][to_state_ndx] */
  128. {
  129. /* this is the table submitted by Jeff Williams on 3/30/2009 with this comment:
  130. OK, I added Peter's version of the state table, and it works OK for
  131. me on MC1322x. I've recreated the jlink portion of patch with this
  132. new state table. His changes to my state table are pretty minor in
  133. terms of total transitions, but Peter feels that his version fixes
  134. some long-standing problems.
  135. Jeff
  136. I added the bit count into the table, reduced RESET column to 7 bits from 8.
  137. Dick
  138. state specific comments:
  139. ------------------------
  140. *->RESET tried the 5 bit reset and it gave me problems, 7 bits seems to
  141. work better on ARM9 with ft2232 driver. (Dick)
  142. RESET->DRSHIFT add 1 extra clock cycles in the RESET state before advancing.
  143. needed on ARM9 with ft2232 driver. (Dick)
  144. (For a total of *THREE* extra clocks in RESET; NOP.)
  145. RESET->IRSHIFT add 1 extra clock cycles in the RESET state before advancing.
  146. needed on ARM9 with ft2232 driver. (Dick)
  147. (For a total of *TWO* extra clocks in RESET; NOP.)
  148. RESET->* always adds one or more clocks in the target state,
  149. which should be NOPS; except shift states which (as
  150. noted above) add those clocks in RESET.
  151. The X-to-X transitions always add clocks; from *SHIFT, they go
  152. via IDLE and thus *DO HAVE SIDE EFFECTS* (capture and update).
  153. */
  154. /* to state: */
  155. /* RESET IDLE DRSHIFT DRPAUSE IRSHIFT IRPAUSE */ /* from state: */
  156. { B8(1111111,7), B8(0000000,7), B8(0010111,7), B8(0001010,7), B8(0011011,7), B8(0010110,7) }, /* RESET */
  157. { B8(1111111,7), B8(0000000,7), B8(001,3), B8(0101,4), B8(0011,4), B8(01011,5) }, /* IDLE */
  158. { B8(1111111,7), B8(011,3), B8(00111,5), B8(01,2), B8(001111,6), B8(0101111,7) }, /* DRSHIFT */
  159. { B8(1111111,7), B8(011,3), B8(01,2), B8(0,1), B8(001111,6), B8(0101111,7) }, /* DRPAUSE */
  160. { B8(1111111,7), B8(011,3), B8(00111,5), B8(010111,6), B8(001111,6), B8(01,2) }, /* IRSHIFT */
  161. { B8(1111111,7), B8(011,3), B8(00111,5), B8(010111,6), B8(01,2), B8(0,1)} /* IRPAUSE */
  162. };
  163. typedef const struct tms_sequences tms_table[6][6];
  164. static tms_table *tms_seqs=&short_tms_seqs;
  165. int tap_get_tms_path(tap_state_t from, tap_state_t to)
  166. {
  167. return (*tms_seqs)[tap_move_ndx(from)][tap_move_ndx(to)].bits;
  168. }
  169. int tap_get_tms_path_len(tap_state_t from, tap_state_t to)
  170. {
  171. return (*tms_seqs)[tap_move_ndx(from)][tap_move_ndx(to)].bit_count;
  172. }
  173. bool tap_is_state_stable(tap_state_t astate)
  174. {
  175. bool is_stable;
  176. /* A switch () is used because it is symbol dependent
  177. (not value dependent like an array), and can also check bounds.
  178. */
  179. switch (astate)
  180. {
  181. case TAP_RESET:
  182. case TAP_IDLE:
  183. case TAP_DRSHIFT:
  184. case TAP_DRPAUSE:
  185. case TAP_IRSHIFT:
  186. case TAP_IRPAUSE:
  187. is_stable = true;
  188. break;
  189. default:
  190. is_stable = false;
  191. }
  192. return is_stable;
  193. }
  194. tap_state_t tap_state_transition(tap_state_t cur_state, bool tms)
  195. {
  196. tap_state_t new_state;
  197. /* A switch is used because it is symbol dependent and not value dependent
  198. like an array. Also it can check for out of range conditions.
  199. */
  200. if (tms)
  201. {
  202. switch (cur_state)
  203. {
  204. case TAP_RESET:
  205. new_state = cur_state;
  206. break;
  207. case TAP_IDLE:
  208. case TAP_DRUPDATE:
  209. case TAP_IRUPDATE:
  210. new_state = TAP_DRSELECT;
  211. break;
  212. case TAP_DRSELECT:
  213. new_state = TAP_IRSELECT;
  214. break;
  215. case TAP_DRCAPTURE:
  216. case TAP_DRSHIFT:
  217. new_state = TAP_DREXIT1;
  218. break;
  219. case TAP_DREXIT1:
  220. case TAP_DREXIT2:
  221. new_state = TAP_DRUPDATE;
  222. break;
  223. case TAP_DRPAUSE:
  224. new_state = TAP_DREXIT2;
  225. break;
  226. case TAP_IRSELECT:
  227. new_state = TAP_RESET;
  228. break;
  229. case TAP_IRCAPTURE:
  230. case TAP_IRSHIFT:
  231. new_state = TAP_IREXIT1;
  232. break;
  233. case TAP_IREXIT1:
  234. case TAP_IREXIT2:
  235. new_state = TAP_IRUPDATE;
  236. break;
  237. case TAP_IRPAUSE:
  238. new_state = TAP_IREXIT2;
  239. break;
  240. default:
  241. LOG_ERROR("fatal: invalid argument cur_state=%d", cur_state);
  242. exit(1);
  243. break;
  244. }
  245. }
  246. else
  247. {
  248. switch (cur_state)
  249. {
  250. case TAP_RESET:
  251. case TAP_IDLE:
  252. case TAP_DRUPDATE:
  253. case TAP_IRUPDATE:
  254. new_state = TAP_IDLE;
  255. break;
  256. case TAP_DRSELECT:
  257. new_state = TAP_DRCAPTURE;
  258. break;
  259. case TAP_DRCAPTURE:
  260. case TAP_DRSHIFT:
  261. case TAP_DREXIT2:
  262. new_state = TAP_DRSHIFT;
  263. break;
  264. case TAP_DREXIT1:
  265. case TAP_DRPAUSE:
  266. new_state = TAP_DRPAUSE;
  267. break;
  268. case TAP_IRSELECT:
  269. new_state = TAP_IRCAPTURE;
  270. break;
  271. case TAP_IRCAPTURE:
  272. case TAP_IRSHIFT:
  273. case TAP_IREXIT2:
  274. new_state = TAP_IRSHIFT;
  275. break;
  276. case TAP_IREXIT1:
  277. case TAP_IRPAUSE:
  278. new_state = TAP_IRPAUSE;
  279. break;
  280. default:
  281. LOG_ERROR("fatal: invalid argument cur_state=%d", cur_state);
  282. exit(1);
  283. break;
  284. }
  285. }
  286. return new_state;
  287. }
  288. /* NOTE: do not change these state names. They're documented,
  289. * and we rely on them to match SVF input (except for "RUN/IDLE").
  290. */
  291. static const struct name_mapping {
  292. enum tap_state symbol;
  293. const char *name;
  294. } tap_name_mapping[] = {
  295. { TAP_RESET, "RESET", },
  296. { TAP_IDLE, "RUN/IDLE", },
  297. { TAP_DRSELECT, "DRSELECT", },
  298. { TAP_DRCAPTURE,"DRCAPTURE", },
  299. { TAP_DRSHIFT, "DRSHIFT", },
  300. { TAP_DREXIT1, "DREXIT1", },
  301. { TAP_DRPAUSE, "DRPAUSE", },
  302. { TAP_DREXIT2, "DREXIT2", },
  303. { TAP_DRUPDATE, "DRUPDATE", },
  304. { TAP_IRSELECT, "IRSELECT", },
  305. { TAP_IRCAPTURE,"IRCAPTURE", },
  306. { TAP_IRSHIFT, "IRSHIFT", },
  307. { TAP_IREXIT1, "IREXIT1", },
  308. { TAP_IRPAUSE, "IRPAUSE", },
  309. { TAP_IREXIT2, "IREXIT2", },
  310. { TAP_IRUPDATE, "IRUPDATE", },
  311. /* only for input: accept standard SVF name */
  312. { TAP_IDLE, "IDLE", },
  313. };
  314. const char *tap_state_name(tap_state_t state)
  315. {
  316. unsigned i;
  317. for (i = 0; i < ARRAY_SIZE(tap_name_mapping); i++) {
  318. if (tap_name_mapping[i].symbol == state)
  319. return tap_name_mapping[i].name;
  320. }
  321. return "???";
  322. }
  323. tap_state_t tap_state_by_name(const char *name)
  324. {
  325. unsigned i;
  326. for (i = 0; i < ARRAY_SIZE(tap_name_mapping); i++) {
  327. /* be nice to the human */
  328. if (strcasecmp(name, tap_name_mapping[i].name) == 0)
  329. return tap_name_mapping[i].symbol;
  330. }
  331. /* not found */
  332. return TAP_INVALID;
  333. }
  334. #ifdef _DEBUG_JTAG_IO_
  335. #define JTAG_DEBUG_STATE_APPEND(buf, len, bit) \
  336. do { buf[len] = bit ? '1' : '0'; } while (0)
  337. #define JTAG_DEBUG_STATE_PRINT(a, b, astr, bstr) \
  338. DEBUG_JTAG_IO("TAP/SM: %9s -> %5s\tTMS: %s\tTDI: %s", \
  339. tap_state_name(a), tap_state_name(b), astr, bstr)
  340. tap_state_t jtag_debug_state_machine(const void *tms_buf, const void *tdi_buf,
  341. unsigned tap_bits, tap_state_t next_state)
  342. {
  343. const uint8_t *tms_buffer;
  344. const uint8_t *tdi_buffer;
  345. unsigned tap_bytes;
  346. unsigned cur_byte;
  347. unsigned cur_bit;
  348. unsigned tap_out_bits;
  349. char tms_str[33];
  350. char tdi_str[33];
  351. tap_state_t last_state;
  352. // set startstate (and possibly last, if tap_bits == 0)
  353. last_state = next_state;
  354. DEBUG_JTAG_IO("TAP/SM: START state: %s", tap_state_name(next_state));
  355. tms_buffer = (const uint8_t *)tms_buf;
  356. tdi_buffer = (const uint8_t *)tdi_buf;
  357. tap_bytes = DIV_ROUND_UP(tap_bits, 8);
  358. DEBUG_JTAG_IO("TAP/SM: TMS bits: %u (bytes: %u)", tap_bits, tap_bytes);
  359. tap_out_bits = 0;
  360. for (cur_byte = 0; cur_byte < tap_bytes; cur_byte++)
  361. {
  362. for (cur_bit = 0; cur_bit < 8; cur_bit++)
  363. {
  364. // make sure we do not run off the end of the buffers
  365. unsigned tap_bit = cur_byte * 8 + cur_bit;
  366. if (tap_bit == tap_bits)
  367. break;
  368. // check and save TMS bit
  369. tap_bit = !!(tms_buffer[cur_byte] & (1 << cur_bit));
  370. JTAG_DEBUG_STATE_APPEND(tms_str, tap_out_bits, tap_bit);
  371. // use TMS bit to find the next TAP state
  372. next_state = tap_state_transition(last_state, tap_bit);
  373. // check and store TDI bit
  374. tap_bit = !!(tdi_buffer[cur_byte] & (1 << cur_bit));
  375. JTAG_DEBUG_STATE_APPEND(tdi_str, tap_out_bits, tap_bit);
  376. // increment TAP bits
  377. tap_out_bits++;
  378. // Only show TDO bits on state transitions, or
  379. // after some number of bits in the same state.
  380. if ((next_state == last_state) && (tap_out_bits < 32))
  381. continue;
  382. // terminate strings and display state transition
  383. tms_str[tap_out_bits] = tdi_str[tap_out_bits] = 0;
  384. JTAG_DEBUG_STATE_PRINT(last_state, next_state, tms_str, tdi_str);
  385. // reset state
  386. last_state = next_state;
  387. tap_out_bits = 0;
  388. }
  389. }
  390. if (tap_out_bits)
  391. {
  392. // terminate strings and display state transition
  393. tms_str[tap_out_bits] = tdi_str[tap_out_bits] = 0;
  394. JTAG_DEBUG_STATE_PRINT(last_state, next_state, tms_str, tdi_str);
  395. }
  396. DEBUG_JTAG_IO("TAP/SM: FINAL state: %s", tap_state_name(next_state));
  397. return next_state;
  398. }
  399. #endif // _DEBUG_JTAG_IO_
  400. void tap_use_new_tms_table(bool use_new)
  401. {
  402. tms_seqs = use_new ? &short_tms_seqs : &old_tms_seqs;
  403. }
  404. bool tap_uses_new_tms_table(void)
  405. {
  406. return tms_seqs == &short_tms_seqs;
  407. }