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.
 
 
 
 
 
 

1505 lines
41 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 "minidriver.h"
  35. #include "interface.h"
  36. #ifdef HAVE_STRINGS_H
  37. #include <strings.h>
  38. #endif
  39. static const Jim_Nvp nvp_jtag_tap_event[] = {
  40. { .value = JTAG_TAP_EVENT_ENABLE, .name = "tap-enable" },
  41. { .value = JTAG_TAP_EVENT_DISABLE, .name = "tap-disable" },
  42. { .name = NULL, .value = -1 }
  43. };
  44. /* jtag interfaces (parport, FTDI-USB, TI-USB, ...)
  45. */
  46. #if BUILD_ZY1000 == 1
  47. extern jtag_interface_t zy1000_interface;
  48. #elif defined(BUILD_MINIDRIVER_DUMMY)
  49. extern jtag_interface_t minidummy_interface;
  50. #else // standard drivers
  51. #if BUILD_PARPORT == 1
  52. extern jtag_interface_t parport_interface;
  53. #endif
  54. #if BUILD_DUMMY == 1
  55. extern jtag_interface_t dummy_interface;
  56. #endif
  57. #if BUILD_FT2232_FTD2XX == 1
  58. extern jtag_interface_t ft2232_interface;
  59. #endif
  60. #if BUILD_FT2232_LIBFTDI == 1
  61. extern jtag_interface_t ft2232_interface;
  62. #endif
  63. #if BUILD_AMTJTAGACCEL == 1
  64. extern jtag_interface_t amt_jtagaccel_interface;
  65. #endif
  66. #if BUILD_EP93XX == 1
  67. extern jtag_interface_t ep93xx_interface;
  68. #endif
  69. #if BUILD_AT91RM9200 == 1
  70. extern jtag_interface_t at91rm9200_interface;
  71. #endif
  72. #if BUILD_GW16012 == 1
  73. extern jtag_interface_t gw16012_interface;
  74. #endif
  75. #if BUILD_PRESTO_LIBFTDI == 1 || BUILD_PRESTO_FTD2XX == 1
  76. extern jtag_interface_t presto_interface;
  77. #endif
  78. #if BUILD_USBPROG == 1
  79. extern jtag_interface_t usbprog_interface;
  80. #endif
  81. #if BUILD_JLINK == 1
  82. extern jtag_interface_t jlink_interface;
  83. #endif
  84. #if BUILD_VSLLINK == 1
  85. extern jtag_interface_t vsllink_interface;
  86. #endif
  87. #if BUILD_RLINK == 1
  88. extern jtag_interface_t rlink_interface;
  89. #endif
  90. #if BUILD_ARMJTAGEW == 1
  91. extern jtag_interface_t armjtagew_interface;
  92. #endif
  93. #endif // standard drivers
  94. /**
  95. * The list of built-in JTAG interfaces, containing entries for those
  96. * drivers that were enabled by the @c configure script.
  97. *
  98. * The list should be defined to contain either one minidriver interface
  99. * or some number of standard driver interfaces, never both.
  100. */
  101. jtag_interface_t *jtag_interfaces[] = {
  102. #if BUILD_ZY1000 == 1
  103. &zy1000_interface,
  104. #elif defined(BUILD_MINIDRIVER_DUMMY)
  105. &minidummy_interface,
  106. #else // standard drivers
  107. #if BUILD_PARPORT == 1
  108. &parport_interface,
  109. #endif
  110. #if BUILD_DUMMY == 1
  111. &dummy_interface,
  112. #endif
  113. #if BUILD_FT2232_FTD2XX == 1
  114. &ft2232_interface,
  115. #endif
  116. #if BUILD_FT2232_LIBFTDI == 1
  117. &ft2232_interface,
  118. #endif
  119. #if BUILD_AMTJTAGACCEL == 1
  120. &amt_jtagaccel_interface,
  121. #endif
  122. #if BUILD_EP93XX == 1
  123. &ep93xx_interface,
  124. #endif
  125. #if BUILD_AT91RM9200 == 1
  126. &at91rm9200_interface,
  127. #endif
  128. #if BUILD_GW16012 == 1
  129. &gw16012_interface,
  130. #endif
  131. #if BUILD_PRESTO_LIBFTDI == 1 || BUILD_PRESTO_FTD2XX == 1
  132. &presto_interface,
  133. #endif
  134. #if BUILD_USBPROG == 1
  135. &usbprog_interface,
  136. #endif
  137. #if BUILD_JLINK == 1
  138. &jlink_interface,
  139. #endif
  140. #if BUILD_VSLLINK == 1
  141. &vsllink_interface,
  142. #endif
  143. #if BUILD_RLINK == 1
  144. &rlink_interface,
  145. #endif
  146. #if BUILD_ARMJTAGEW == 1
  147. &armjtagew_interface,
  148. #endif
  149. #endif // standard drivers
  150. NULL,
  151. };
  152. extern jtag_interface_t *jtag_interface;
  153. /* jtag commands */
  154. static int handle_interface_list_command(struct command_context_s *cmd_ctx,
  155. char *cmd, char **args, int argc);
  156. static int handle_interface_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
  157. static int handle_jtag_speed_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
  158. static int handle_jtag_khz_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
  159. static int handle_jtag_device_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
  160. static int handle_reset_config_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
  161. static int handle_jtag_nsrst_delay_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
  162. static int handle_jtag_ntrst_delay_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
  163. static int handle_scan_chain_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
  164. static int handle_jtag_reset_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
  165. static int handle_runtest_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
  166. static int handle_irscan_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
  167. static int Jim_Command_drscan(Jim_Interp *interp, int argc, Jim_Obj *const *argv);
  168. static int Jim_Command_pathmove(Jim_Interp *interp, int argc, Jim_Obj *const *argv);
  169. static int Jim_Command_flush_count(Jim_Interp *interp, int argc, Jim_Obj *const *args);
  170. static int handle_verify_ircapture_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
  171. static int handle_verify_jtag_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
  172. static int handle_tms_sequence_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
  173. extern int jtag_examine_chain(void);
  174. extern int jtag_validate_chain(void);
  175. enum jtag_tap_cfg_param {
  176. JCFG_EVENT
  177. };
  178. static Jim_Nvp nvp_config_opts[] = {
  179. { .name = "-event", .value = JCFG_EVENT },
  180. { .name = NULL, .value = -1 }
  181. };
  182. static int jtag_tap_configure_cmd( Jim_GetOptInfo *goi, jtag_tap_t * tap)
  183. {
  184. Jim_Nvp *n;
  185. Jim_Obj *o;
  186. int e;
  187. /* parse config or cget options */
  188. while (goi->argc > 0) {
  189. Jim_SetEmptyResult (goi->interp);
  190. e = Jim_GetOpt_Nvp(goi, nvp_config_opts, &n);
  191. if (e != JIM_OK) {
  192. Jim_GetOpt_NvpUnknown(goi, nvp_config_opts, 0);
  193. return e;
  194. }
  195. switch (n->value) {
  196. case JCFG_EVENT:
  197. if (goi->argc == 0) {
  198. Jim_WrongNumArgs( goi->interp, goi->argc, goi->argv, "-event ?event-name? ..." );
  199. return JIM_ERR;
  200. }
  201. e = Jim_GetOpt_Nvp( goi, nvp_jtag_tap_event, &n );
  202. if (e != JIM_OK) {
  203. Jim_GetOpt_NvpUnknown(goi, nvp_jtag_tap_event, 1);
  204. return e;
  205. }
  206. if (goi->isconfigure) {
  207. if (goi->argc != 1) {
  208. Jim_WrongNumArgs(goi->interp, goi->argc, goi->argv, "-event ?event-name? ?EVENT-BODY?");
  209. return JIM_ERR;
  210. }
  211. } else {
  212. if (goi->argc != 0) {
  213. Jim_WrongNumArgs(goi->interp, goi->argc, goi->argv, "-event ?event-name?");
  214. return JIM_ERR;
  215. }
  216. }
  217. {
  218. jtag_tap_event_action_t *jteap;
  219. jteap = tap->event_action;
  220. /* replace existing? */
  221. while (jteap) {
  222. if (jteap->event == (enum jtag_event)n->value) {
  223. break;
  224. }
  225. jteap = jteap->next;
  226. }
  227. if (goi->isconfigure) {
  228. if (jteap == NULL) {
  229. /* create new */
  230. jteap = calloc(1, sizeof (*jteap));
  231. }
  232. jteap->event = n->value;
  233. Jim_GetOpt_Obj( goi, &o);
  234. if (jteap->body) {
  235. Jim_DecrRefCount(interp, jteap->body);
  236. }
  237. jteap->body = Jim_DuplicateObj(goi->interp, o);
  238. Jim_IncrRefCount(jteap->body);
  239. /* add to head of event list */
  240. jteap->next = tap->event_action;
  241. tap->event_action = jteap;
  242. Jim_SetEmptyResult(goi->interp);
  243. } else {
  244. /* get */
  245. if (jteap == NULL) {
  246. Jim_SetEmptyResult(goi->interp);
  247. } else {
  248. Jim_SetResult(goi->interp, Jim_DuplicateObj(goi->interp, jteap->body));
  249. }
  250. }
  251. }
  252. /* loop for more */
  253. break;
  254. }
  255. } /* while (goi->argc) */
  256. return JIM_OK;
  257. }
  258. static int is_bad_irval(int ir_length, jim_wide w)
  259. {
  260. jim_wide v = 1;
  261. v <<= ir_length;
  262. v -= 1;
  263. v = ~v;
  264. return (w & v) != 0;
  265. }
  266. static int jim_newtap_cmd( Jim_GetOptInfo *goi )
  267. {
  268. jtag_tap_t *pTap;
  269. jim_wide w;
  270. int x;
  271. int e;
  272. int reqbits;
  273. Jim_Nvp *n;
  274. char *cp;
  275. const Jim_Nvp opts[] = {
  276. #define NTAP_OPT_IRLEN 0
  277. { .name = "-irlen" , .value = NTAP_OPT_IRLEN },
  278. #define NTAP_OPT_IRMASK 1
  279. { .name = "-irmask" , .value = NTAP_OPT_IRMASK },
  280. #define NTAP_OPT_IRCAPTURE 2
  281. { .name = "-ircapture" , .value = NTAP_OPT_IRCAPTURE },
  282. #define NTAP_OPT_ENABLED 3
  283. { .name = "-enable" , .value = NTAP_OPT_ENABLED },
  284. #define NTAP_OPT_DISABLED 4
  285. { .name = "-disable" , .value = NTAP_OPT_DISABLED },
  286. #define NTAP_OPT_EXPECTED_ID 5
  287. { .name = "-expected-id" , .value = NTAP_OPT_EXPECTED_ID },
  288. { .name = NULL , .value = -1 },
  289. };
  290. pTap = calloc(1, sizeof(jtag_tap_t));
  291. if (!pTap) {
  292. Jim_SetResult_sprintf(goi->interp, "no memory");
  293. return JIM_ERR;
  294. }
  295. /*
  296. * we expect CHIP + TAP + OPTIONS
  297. * */
  298. if ( goi->argc < 3 ){
  299. Jim_SetResult_sprintf(goi->interp, "Missing CHIP TAP OPTIONS ....");
  300. return JIM_ERR;
  301. }
  302. Jim_GetOpt_String( goi, &cp, NULL );
  303. pTap->chip = strdup(cp);
  304. Jim_GetOpt_String( goi, &cp, NULL );
  305. pTap->tapname = strdup(cp);
  306. /* name + dot + name + null */
  307. x = strlen(pTap->chip) + 1 + strlen(pTap->tapname) + 1;
  308. cp = malloc( x );
  309. sprintf( cp, "%s.%s", pTap->chip, pTap->tapname );
  310. pTap->dotted_name = cp;
  311. LOG_DEBUG("Creating New Tap, Chip: %s, Tap: %s, Dotted: %s, %d params",
  312. pTap->chip, pTap->tapname, pTap->dotted_name, goi->argc);
  313. /* deal with options */
  314. #define NTREQ_IRLEN 1
  315. #define NTREQ_IRCAPTURE 2
  316. #define NTREQ_IRMASK 4
  317. /* clear them as we find them */
  318. reqbits = (NTREQ_IRLEN | NTREQ_IRCAPTURE | NTREQ_IRMASK);
  319. while ( goi->argc ){
  320. e = Jim_GetOpt_Nvp( goi, opts, &n );
  321. if ( e != JIM_OK ){
  322. Jim_GetOpt_NvpUnknown( goi, opts, 0 );
  323. return e;
  324. }
  325. LOG_DEBUG("Processing option: %s", n->name );
  326. switch ( n->value ){
  327. case NTAP_OPT_ENABLED:
  328. pTap->disabled_after_reset = false;
  329. break;
  330. case NTAP_OPT_DISABLED:
  331. pTap->disabled_after_reset = true;
  332. break;
  333. case NTAP_OPT_EXPECTED_ID:
  334. {
  335. uint32_t *new_expected_ids;
  336. e = Jim_GetOpt_Wide( goi, &w );
  337. if ( e != JIM_OK) {
  338. Jim_SetResult_sprintf(goi->interp, "option: %s bad parameter", n->name);
  339. return e;
  340. }
  341. new_expected_ids = malloc(sizeof(uint32_t) * (pTap->expected_ids_cnt + 1));
  342. if (new_expected_ids == NULL) {
  343. Jim_SetResult_sprintf( goi->interp, "no memory");
  344. return JIM_ERR;
  345. }
  346. memcpy(new_expected_ids, pTap->expected_ids, sizeof(uint32_t) * pTap->expected_ids_cnt);
  347. new_expected_ids[pTap->expected_ids_cnt] = w;
  348. free(pTap->expected_ids);
  349. pTap->expected_ids = new_expected_ids;
  350. pTap->expected_ids_cnt++;
  351. break;
  352. }
  353. case NTAP_OPT_IRLEN:
  354. case NTAP_OPT_IRMASK:
  355. case NTAP_OPT_IRCAPTURE:
  356. e = Jim_GetOpt_Wide( goi, &w );
  357. if ( e != JIM_OK ){
  358. Jim_SetResult_sprintf( goi->interp, "option: %s bad parameter", n->name );
  359. return e;
  360. }
  361. switch (n->value){
  362. case NTAP_OPT_IRLEN:
  363. if (w > (jim_wide) (8 * sizeof(pTap->ir_capture_value)))
  364. LOG_WARNING("huge IR length %d", (int) w);
  365. pTap->ir_length = w;
  366. reqbits &= (~(NTREQ_IRLEN));
  367. break;
  368. case NTAP_OPT_IRMASK:
  369. if (is_bad_irval(pTap->ir_length, w)) {
  370. LOG_ERROR("IR mask %x too big",
  371. (int) w);
  372. return ERROR_FAIL;
  373. }
  374. pTap->ir_capture_mask = w;
  375. reqbits &= (~(NTREQ_IRMASK));
  376. break;
  377. case NTAP_OPT_IRCAPTURE:
  378. if (is_bad_irval(pTap->ir_length, w)) {
  379. LOG_ERROR("IR capture %x too big",
  380. (int) w);
  381. return ERROR_FAIL;
  382. }
  383. pTap->ir_capture_value = w;
  384. reqbits &= (~(NTREQ_IRCAPTURE));
  385. break;
  386. }
  387. } /* switch (n->value) */
  388. } /* while ( goi->argc ) */
  389. /* default is enabled-after-reset */
  390. pTap->enabled = !pTap->disabled_after_reset;
  391. /* Did all the required option bits get cleared? */
  392. if (0 == reqbits)
  393. {
  394. jtag_tap_init(pTap);
  395. return ERROR_OK;
  396. }
  397. Jim_SetResult_sprintf(goi->interp,
  398. "newtap: %s missing required parameters",
  399. pTap->dotted_name);
  400. jtag_tap_free(pTap);
  401. return JIM_ERR;
  402. }
  403. static void jtag_tap_handle_event(jtag_tap_t *tap, enum jtag_event e)
  404. {
  405. jtag_tap_event_action_t * jteap;
  406. int done;
  407. jteap = tap->event_action;
  408. done = 0;
  409. while (jteap) {
  410. if (jteap->event == e) {
  411. done = 1;
  412. LOG_DEBUG( "JTAG tap: %s event: %d (%s) action: %s\n",
  413. tap->dotted_name,
  414. e,
  415. Jim_Nvp_value2name_simple(nvp_jtag_tap_event, e)->name,
  416. Jim_GetString(jteap->body, NULL) );
  417. if (Jim_EvalObj(interp, jteap->body) != JIM_OK) {
  418. Jim_PrintErrorMessage(interp);
  419. } else {
  420. /* NOTE: we currently assume the handlers
  421. * can't fail. That presumes later code
  422. * will be verifying the scan chains ...
  423. */
  424. tap->enabled = (e == JTAG_TAP_EVENT_ENABLE);
  425. }
  426. }
  427. jteap = jteap->next;
  428. }
  429. if (!done) {
  430. LOG_DEBUG( "event %d %s - no action",
  431. e,
  432. Jim_Nvp_value2name_simple( nvp_jtag_tap_event, e)->name);
  433. }
  434. }
  435. static int jim_jtag_command( Jim_Interp *interp, int argc, Jim_Obj *const *argv )
  436. {
  437. Jim_GetOptInfo goi;
  438. int e;
  439. Jim_Nvp *n;
  440. Jim_Obj *o;
  441. struct command_context_s *context;
  442. enum {
  443. JTAG_CMD_INTERFACE,
  444. JTAG_CMD_INIT_RESET,
  445. JTAG_CMD_NEWTAP,
  446. JTAG_CMD_TAPENABLE,
  447. JTAG_CMD_TAPDISABLE,
  448. JTAG_CMD_TAPISENABLED,
  449. JTAG_CMD_CONFIGURE,
  450. JTAG_CMD_CGET
  451. };
  452. const Jim_Nvp jtag_cmds[] = {
  453. { .name = "interface" , .value = JTAG_CMD_INTERFACE },
  454. { .name = "arp_init-reset", .value = JTAG_CMD_INIT_RESET },
  455. { .name = "newtap" , .value = JTAG_CMD_NEWTAP },
  456. { .name = "tapisenabled" , .value = JTAG_CMD_TAPISENABLED },
  457. { .name = "tapenable" , .value = JTAG_CMD_TAPENABLE },
  458. { .name = "tapdisable" , .value = JTAG_CMD_TAPDISABLE },
  459. { .name = "configure" , .value = JTAG_CMD_CONFIGURE },
  460. { .name = "cget" , .value = JTAG_CMD_CGET },
  461. { .name = NULL, .value = -1 },
  462. };
  463. context = Jim_GetAssocData(interp, "context");
  464. /* go past the command */
  465. Jim_GetOpt_Setup( &goi, interp, argc-1, argv + 1 );
  466. e = Jim_GetOpt_Nvp( &goi, jtag_cmds, &n );
  467. if ( e != JIM_OK ){
  468. Jim_GetOpt_NvpUnknown( &goi, jtag_cmds, 0 );
  469. return e;
  470. }
  471. Jim_SetEmptyResult( goi.interp );
  472. switch ( n->value ){
  473. case JTAG_CMD_INTERFACE:
  474. /* return the name of the interface */
  475. /* TCL code might need to know the exact type... */
  476. /* FUTURE: we allow this as a means to "set" the interface. */
  477. if ( goi.argc != 0 ){
  478. Jim_WrongNumArgs( goi.interp, 1, goi.argv-1, "(no params)");
  479. return JIM_ERR;
  480. }
  481. Jim_SetResultString( goi.interp, jtag_interface->name, -1 );
  482. return JIM_OK;
  483. case JTAG_CMD_INIT_RESET:
  484. if ( goi.argc != 0 ){
  485. Jim_WrongNumArgs( goi.interp, 1, goi.argv-1, "(no params)");
  486. return JIM_ERR;
  487. }
  488. e = jtag_init_reset(context);
  489. if ( e != ERROR_OK ){
  490. Jim_SetResult_sprintf( goi.interp, "error: %d", e);
  491. return JIM_ERR;
  492. }
  493. return JIM_OK;
  494. case JTAG_CMD_NEWTAP:
  495. return jim_newtap_cmd( &goi );
  496. break;
  497. case JTAG_CMD_TAPISENABLED:
  498. case JTAG_CMD_TAPENABLE:
  499. case JTAG_CMD_TAPDISABLE:
  500. if ( goi.argc != 1 ){
  501. Jim_SetResultString( goi.interp, "Too many parameters",-1 );
  502. return JIM_ERR;
  503. }
  504. {
  505. jtag_tap_t *t;
  506. t = jtag_tap_by_jim_obj(goi.interp, goi.argv[0]);
  507. if (t == NULL)
  508. return JIM_ERR;
  509. switch (n->value) {
  510. case JTAG_CMD_TAPISENABLED:
  511. break;
  512. case JTAG_CMD_TAPENABLE:
  513. if (t->enabled)
  514. break;
  515. jtag_tap_handle_event(t, JTAG_TAP_EVENT_ENABLE);
  516. if (!t->enabled)
  517. break;
  518. /* FIXME add JTAG sanity checks, w/o TLR
  519. * - scan chain length grew by one (this)
  520. * - IDs and IR lengths are as expected
  521. */
  522. jtag_call_event_callbacks(JTAG_TAP_EVENT_ENABLE);
  523. break;
  524. case JTAG_CMD_TAPDISABLE:
  525. if (!t->enabled)
  526. break;
  527. jtag_tap_handle_event(t, JTAG_TAP_EVENT_DISABLE);
  528. if (t->enabled)
  529. break;
  530. /* FIXME add JTAG sanity checks, w/o TLR
  531. * - scan chain length shrank by one (this)
  532. * - IDs and IR lengths are as expected
  533. */
  534. jtag_call_event_callbacks(JTAG_TAP_EVENT_DISABLE);
  535. break;
  536. }
  537. e = t->enabled;
  538. Jim_SetResult(goi.interp, Jim_NewIntObj(goi.interp, e));
  539. return JIM_OK;
  540. }
  541. break;
  542. case JTAG_CMD_CGET:
  543. if ( goi.argc < 2 ){
  544. Jim_WrongNumArgs( goi.interp, 0, NULL, "?tap-name? -option ...");
  545. return JIM_ERR;
  546. }
  547. {
  548. jtag_tap_t *t;
  549. Jim_GetOpt_Obj(&goi, &o);
  550. t = jtag_tap_by_jim_obj( goi.interp, o );
  551. if ( t == NULL ){
  552. return JIM_ERR;
  553. }
  554. goi.isconfigure = 0;
  555. return jtag_tap_configure_cmd( &goi, t);
  556. }
  557. break;
  558. case JTAG_CMD_CONFIGURE:
  559. if ( goi.argc < 3 ){
  560. Jim_WrongNumArgs( goi.interp, 0, NULL, "?tap-name? -option ?VALUE? ...");
  561. return JIM_ERR;
  562. }
  563. {
  564. jtag_tap_t *t;
  565. Jim_GetOpt_Obj(&goi, &o);
  566. t = jtag_tap_by_jim_obj( goi.interp, o );
  567. if ( t == NULL ){
  568. return JIM_ERR;
  569. }
  570. goi.isconfigure = 1;
  571. return jtag_tap_configure_cmd( &goi, t);
  572. }
  573. }
  574. return JIM_ERR;
  575. }
  576. int jtag_register_commands(struct command_context_s *cmd_ctx)
  577. {
  578. register_jim( cmd_ctx, "jtag", jim_jtag_command, "perform jtag tap actions");
  579. register_command(cmd_ctx, NULL, "interface", handle_interface_command,
  580. COMMAND_CONFIG, "try to configure interface");
  581. register_command(cmd_ctx, NULL,
  582. "interface_list", &handle_interface_list_command,
  583. COMMAND_ANY, "list all built-in interfaces");
  584. register_command(cmd_ctx, NULL, "jtag_speed", handle_jtag_speed_command,
  585. COMMAND_ANY, "(DEPRECATED) set jtag speed (if supported)");
  586. register_command(cmd_ctx, NULL, "jtag_khz", handle_jtag_khz_command,
  587. COMMAND_ANY, "set maximum jtag speed (if supported); "
  588. "parameter is maximum khz, or 0 for adaptive clocking (RTCK).");
  589. register_command(cmd_ctx, NULL, "jtag_device", handle_jtag_device_command,
  590. COMMAND_CONFIG, "(DEPRECATED) jtag_device <ir_length> <ir_expected> <ir_mask>");
  591. register_command(cmd_ctx, NULL, "reset_config", handle_reset_config_command,
  592. COMMAND_ANY,
  593. "[none/trst_only/srst_only/trst_and_srst] [srst_pulls_trst/trst_pulls_srst] [combined/separate] [trst_push_pull/trst_open_drain] [srst_push_pull/srst_open_drain]");
  594. register_command(cmd_ctx, NULL, "jtag_nsrst_delay", handle_jtag_nsrst_delay_command,
  595. COMMAND_ANY, "jtag_nsrst_delay <ms> - delay after deasserting srst in ms");
  596. register_command(cmd_ctx, NULL, "jtag_ntrst_delay", handle_jtag_ntrst_delay_command,
  597. COMMAND_ANY, "jtag_ntrst_delay <ms> - delay after deasserting trst in ms");
  598. register_command(cmd_ctx, NULL, "scan_chain", handle_scan_chain_command,
  599. COMMAND_EXEC, "print current scan chain configuration");
  600. register_command(cmd_ctx, NULL, "jtag_reset", handle_jtag_reset_command,
  601. COMMAND_EXEC, "toggle reset lines <trst> <srst>");
  602. register_command(cmd_ctx, NULL, "runtest", handle_runtest_command,
  603. COMMAND_EXEC, "move to Run-Test/Idle, and execute <num_cycles>");
  604. register_command(cmd_ctx, NULL, "irscan", handle_irscan_command,
  605. COMMAND_EXEC, "execute IR scan <device> <instr> [dev2] [instr2] ...");
  606. register_jim(cmd_ctx, "drscan", Jim_Command_drscan, "execute DR scan <device> <num_bits> <value> <num_bits1> <value2> ...");
  607. register_jim(cmd_ctx, "flush_count", Jim_Command_flush_count, "returns number of times the JTAG queue has been flushed");
  608. register_jim(cmd_ctx, "pathmove", Jim_Command_pathmove, "move JTAG to state1 then to state2, state3, etc. <state1>,<state2>,<stat3>...");
  609. register_command(cmd_ctx, NULL, "verify_ircapture", handle_verify_ircapture_command,
  610. COMMAND_ANY, "verify value captured during Capture-IR <enable | disable>");
  611. register_command(cmd_ctx, NULL, "verify_jtag", handle_verify_jtag_command,
  612. COMMAND_ANY, "verify value capture <enable | disable>");
  613. register_command(cmd_ctx, NULL, "tms_sequence", handle_tms_sequence_command,
  614. COMMAND_ANY, "choose short(default) or long tms_sequence <short | long>");
  615. return ERROR_OK;
  616. }
  617. static int default_khz(int khz, int *jtag_speed)
  618. {
  619. LOG_ERROR("Translation from khz to jtag_speed not implemented");
  620. return ERROR_FAIL;
  621. }
  622. static int default_speed_div(int speed, int *khz)
  623. {
  624. LOG_ERROR("Translation from jtag_speed to khz not implemented");
  625. return ERROR_FAIL;
  626. }
  627. static int default_power_dropout(int *dropout)
  628. {
  629. *dropout = 0; /* by default we can't detect power dropout */
  630. return ERROR_OK;
  631. }
  632. static int default_srst_asserted(int *srst_asserted)
  633. {
  634. *srst_asserted = 0; /* by default we can't detect srst asserted */
  635. return ERROR_OK;
  636. }
  637. static int handle_interface_command(struct command_context_s *cmd_ctx,
  638. char *cmd, char **args, int argc)
  639. {
  640. /* check whether the interface is already configured */
  641. if (jtag_interface)
  642. {
  643. LOG_WARNING("Interface already configured, ignoring");
  644. return ERROR_OK;
  645. }
  646. /* interface name is a mandatory argument */
  647. if (argc != 1 || args[0][0] == '\0')
  648. return ERROR_COMMAND_SYNTAX_ERROR;
  649. for (unsigned i = 0; NULL != jtag_interfaces[i]; i++)
  650. {
  651. if (strcmp(args[0], jtag_interfaces[i]->name) != 0)
  652. continue;
  653. int retval = jtag_interfaces[i]->register_commands(cmd_ctx);
  654. if (ERROR_OK != retval)
  655. return retval;
  656. jtag_interface = jtag_interfaces[i];
  657. if (jtag_interface->khz == NULL)
  658. jtag_interface->khz = default_khz;
  659. if (jtag_interface->speed_div == NULL)
  660. jtag_interface->speed_div = default_speed_div;
  661. if (jtag_interface->power_dropout == NULL)
  662. jtag_interface->power_dropout = default_power_dropout;
  663. if (jtag_interface->srst_asserted == NULL)
  664. jtag_interface->srst_asserted = default_srst_asserted;
  665. return ERROR_OK;
  666. }
  667. /* no valid interface was found (i.e. the configuration option,
  668. * didn't match one of the compiled-in interfaces
  669. */
  670. LOG_ERROR("The specified JTAG interface was not found (%s)", args[0]);
  671. handle_interface_list_command(cmd_ctx, cmd, args, argc);
  672. return ERROR_JTAG_INVALID_INTERFACE;
  673. }
  674. static int handle_interface_list_command(struct command_context_s *cmd_ctx,
  675. char *cmd, char **args, int argc)
  676. {
  677. if (strcmp(cmd, "interface_list") == 0 && argc > 0)
  678. return ERROR_COMMAND_SYNTAX_ERROR;
  679. command_print(cmd_ctx, "The following JTAG interfaces are available:");
  680. for (unsigned i = 0; NULL != jtag_interfaces[i]; i++)
  681. {
  682. const char *name = jtag_interfaces[i]->name;
  683. command_print(cmd_ctx, "%u: %s", i + 1, name);
  684. }
  685. return ERROR_OK;
  686. }
  687. static int handle_jtag_device_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
  688. {
  689. int e;
  690. char buf[1024];
  691. Jim_Obj *newargs[ 10 ];
  692. /*
  693. * CONVERT SYNTAX
  694. * argv[-1] = command
  695. * argv[ 0] = ir length
  696. * argv[ 1] = ir capture
  697. * argv[ 2] = ir mask
  698. * argv[ 3] = not actually used by anything but in the docs
  699. */
  700. if ( argc < 4 ){
  701. command_print( cmd_ctx, "OLD DEPRECATED SYNTAX: Please use the NEW syntax");
  702. return ERROR_OK;
  703. }
  704. command_print( cmd_ctx, "OLD SYNTAX: DEPRECATED - translating to new syntax");
  705. command_print( cmd_ctx, "jtag newtap CHIP TAP -irlen %s -ircapture %s -irvalue %s",
  706. args[0],
  707. args[1],
  708. args[2] );
  709. command_print( cmd_ctx, "Example: STM32 has 2 taps, the cortexM3(len4) + boundaryscan(len5)");
  710. command_print( cmd_ctx, "jtag newtap stm32 cortexm3 ....., thus creating the tap: \"stm32.cortexm3\"");
  711. command_print( cmd_ctx, "jtag newtap stm32 boundary ....., and the tap: \"stm32.boundary\"");
  712. command_print( cmd_ctx, "And then refer to the taps by the dotted name.");
  713. newargs[0] = Jim_NewStringObj( interp, "jtag", -1 );
  714. newargs[1] = Jim_NewStringObj( interp, "newtap", -1 );
  715. sprintf( buf, "chip%d", jtag_tap_count() );
  716. newargs[2] = Jim_NewStringObj( interp, buf, -1 );
  717. sprintf( buf, "tap%d", jtag_tap_count() );
  718. newargs[3] = Jim_NewStringObj( interp, buf, -1 );
  719. newargs[4] = Jim_NewStringObj( interp, "-irlen", -1 );
  720. newargs[5] = Jim_NewStringObj( interp, args[0], -1 );
  721. newargs[6] = Jim_NewStringObj( interp, "-ircapture", -1 );
  722. newargs[7] = Jim_NewStringObj( interp, args[1], -1 );
  723. newargs[8] = Jim_NewStringObj( interp, "-irmask", -1 );
  724. newargs[9] = Jim_NewStringObj( interp, args[2], -1 );
  725. command_print( cmd_ctx, "NEW COMMAND:");
  726. sprintf( buf, "%s %s %s %s %s %s %s %s %s %s",
  727. Jim_GetString( newargs[0], NULL ),
  728. Jim_GetString( newargs[1], NULL ),
  729. Jim_GetString( newargs[2], NULL ),
  730. Jim_GetString( newargs[3], NULL ),
  731. Jim_GetString( newargs[4], NULL ),
  732. Jim_GetString( newargs[5], NULL ),
  733. Jim_GetString( newargs[6], NULL ),
  734. Jim_GetString( newargs[7], NULL ),
  735. Jim_GetString( newargs[8], NULL ),
  736. Jim_GetString( newargs[9], NULL ) );
  737. e = jim_jtag_command( interp, 10, newargs );
  738. if ( e != JIM_OK ){
  739. command_print( cmd_ctx, "%s", Jim_GetString( Jim_GetResult(interp), NULL ) );
  740. }
  741. return e;
  742. }
  743. static int handle_scan_chain_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
  744. {
  745. jtag_tap_t *tap;
  746. tap = jtag_all_taps();
  747. command_print(cmd_ctx, " TapName | Enabled | IdCode Expected IrLen IrCap IrMask Instr ");
  748. command_print(cmd_ctx, "---|--------------------|---------|------------|------------|------|------|------|---------");
  749. while ( tap ){
  750. uint32_t expected, expected_mask, cur_instr, ii;
  751. expected = buf_get_u32(tap->expected, 0, tap->ir_length);
  752. expected_mask = buf_get_u32(tap->expected_mask, 0, tap->ir_length);
  753. cur_instr = buf_get_u32(tap->cur_instr, 0, tap->ir_length);
  754. command_print(cmd_ctx,
  755. "%2d | %-18s | %c | 0x%08x | 0x%08x | 0x%02x | 0x%02x | 0x%02x | 0x%02x",
  756. tap->abs_chain_position,
  757. tap->dotted_name,
  758. tap->enabled ? 'Y' : 'n',
  759. (unsigned int)(tap->idcode),
  760. (unsigned int)(tap->expected_ids_cnt > 0 ? tap->expected_ids[0] : 0),
  761. (unsigned int)(tap->ir_length),
  762. (unsigned int)(expected),
  763. (unsigned int)(expected_mask),
  764. (unsigned int)(cur_instr));
  765. for (ii = 1; ii < tap->expected_ids_cnt; ii++) {
  766. command_print(cmd_ctx, " | | | | 0x%08x | | | | ",
  767. (unsigned int)(tap->expected_ids[ii]));
  768. }
  769. tap = tap->next_tap;
  770. }
  771. return ERROR_OK;
  772. }
  773. static int handle_reset_config_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
  774. {
  775. int new_cfg = 0;
  776. int mask = 0;
  777. if (argc < 1)
  778. return ERROR_COMMAND_SYNTAX_ERROR;
  779. /* Original versions cared about the order of these tokens:
  780. * reset_config signals [combination [trst_type [srst_type]]]
  781. * They also clobbered the previous configuration even on error.
  782. *
  783. * Here we don't care about the order, and only change values
  784. * which have been explicitly specified.
  785. */
  786. for (; argc; argc--, args++) {
  787. int tmp = 0;
  788. int m;
  789. /* signals */
  790. m = RESET_HAS_TRST | RESET_HAS_SRST;
  791. if (strcmp(*args, "none") == 0)
  792. tmp = RESET_NONE;
  793. else if (strcmp(*args, "trst_only") == 0)
  794. tmp = RESET_HAS_TRST;
  795. else if (strcmp(*args, "srst_only") == 0)
  796. tmp = RESET_HAS_SRST;
  797. else if (strcmp(*args, "trst_and_srst") == 0)
  798. tmp = RESET_HAS_TRST | RESET_HAS_SRST;
  799. else
  800. m = 0;
  801. if (mask & m) {
  802. LOG_ERROR("extra reset_config %s spec (%s)",
  803. "signal", *args);
  804. return ERROR_INVALID_ARGUMENTS;
  805. }
  806. if (m)
  807. goto next;
  808. /* combination (options for broken wiring) */
  809. m = RESET_SRST_PULLS_TRST | RESET_TRST_PULLS_SRST;
  810. if (strcmp(*args, "separate") == 0)
  811. /* separate reset lines - default */;
  812. else if (strcmp(*args, "srst_pulls_trst") == 0)
  813. tmp |= RESET_SRST_PULLS_TRST;
  814. else if (strcmp(*args, "trst_pulls_srst") == 0)
  815. tmp |= RESET_TRST_PULLS_SRST;
  816. else if (strcmp(*args, "combined") == 0)
  817. tmp |= RESET_SRST_PULLS_TRST | RESET_TRST_PULLS_SRST;
  818. else
  819. m = 0;
  820. if (mask & m) {
  821. LOG_ERROR("extra reset_config %s spec (%s)",
  822. "combination", *args);
  823. return ERROR_INVALID_ARGUMENTS;
  824. }
  825. if (m)
  826. goto next;
  827. /* trst_type (NOP without HAS_TRST) */
  828. m = RESET_TRST_OPEN_DRAIN;
  829. if (strcmp(*args, "trst_open_drain") == 0)
  830. tmp |= RESET_TRST_OPEN_DRAIN;
  831. else if (strcmp(*args, "trst_push_pull") == 0)
  832. /* push/pull from adapter - default */;
  833. else
  834. m = 0;
  835. if (mask & m) {
  836. LOG_ERROR("extra reset_config %s spec (%s)",
  837. "trst_type", *args);
  838. return ERROR_INVALID_ARGUMENTS;
  839. }
  840. if (m)
  841. goto next;
  842. /* srst_type (NOP without HAS_SRST) */
  843. m |= RESET_SRST_PUSH_PULL;
  844. if (strcmp(*args, "srst_push_pull") == 0)
  845. tmp |= RESET_SRST_PUSH_PULL;
  846. else if (strcmp(*args, "srst_open_drain") == 0)
  847. /* open drain from adapter - default */;
  848. else
  849. m = 0;
  850. if (mask & m) {
  851. LOG_ERROR("extra reset_config %s spec (%s)",
  852. "srst_type", *args);
  853. return ERROR_INVALID_ARGUMENTS;
  854. }
  855. if (m)
  856. goto next;
  857. /* caller provided nonsense; fail */
  858. LOG_ERROR("unknown reset_config flag (%s)", *args);
  859. return ERROR_INVALID_ARGUMENTS;
  860. next:
  861. /* Remember the bits which were specified (mask)
  862. * and their new values (new_cfg).
  863. */
  864. mask |= m;
  865. new_cfg |= tmp;
  866. }
  867. /* clear previous values of those bits, save new values */
  868. enum reset_types old_cfg = jtag_get_reset_config();
  869. old_cfg &= ~mask;
  870. new_cfg |= old_cfg;
  871. jtag_set_reset_config(new_cfg);
  872. return ERROR_OK;
  873. }
  874. static int handle_jtag_nsrst_delay_command(struct command_context_s *cmd_ctx,
  875. char *cmd, char **args, int argc)
  876. {
  877. if (argc > 1)
  878. return ERROR_COMMAND_SYNTAX_ERROR;
  879. if (argc == 1)
  880. {
  881. unsigned delay;
  882. int retval = parse_uint(args[0], &delay);
  883. if (ERROR_OK != retval)
  884. return retval;
  885. jtag_set_nsrst_delay(delay);
  886. }
  887. command_print(cmd_ctx, "jtag_nsrst_delay: %u", jtag_get_nsrst_delay());
  888. return ERROR_OK;
  889. }
  890. static int handle_jtag_ntrst_delay_command(struct command_context_s *cmd_ctx,
  891. char *cmd, char **args, int argc)
  892. {
  893. if (argc > 1)
  894. return ERROR_COMMAND_SYNTAX_ERROR;
  895. if (argc == 1)
  896. {
  897. unsigned delay;
  898. int retval = parse_uint(args[0], &delay);
  899. if (ERROR_OK != retval)
  900. return retval;
  901. jtag_set_ntrst_delay(delay);
  902. }
  903. command_print(cmd_ctx, "jtag_ntrst_delay: %u", jtag_get_ntrst_delay());
  904. return ERROR_OK;
  905. }
  906. static int handle_jtag_speed_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
  907. {
  908. int retval = ERROR_OK;
  909. if (argc > 1)
  910. return ERROR_COMMAND_SYNTAX_ERROR;
  911. if (argc == 1)
  912. {
  913. LOG_DEBUG("handle jtag speed");
  914. unsigned cur_speed = 0;
  915. int retval = parse_uint(args[0], &cur_speed);
  916. if (ERROR_OK != retval)
  917. return retval;
  918. retval = jtag_set_speed(cur_speed);
  919. }
  920. command_print(cmd_ctx, "jtag_speed: %d", jtag_get_speed());
  921. return retval;
  922. }
  923. static int handle_jtag_khz_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
  924. {
  925. if (argc > 1)
  926. return ERROR_COMMAND_SYNTAX_ERROR;
  927. int retval = ERROR_OK;
  928. if (argc == 1)
  929. {
  930. unsigned khz = 0;
  931. int retval = parse_uint(args[0], &khz);
  932. if (ERROR_OK != retval)
  933. return retval;
  934. retval = jtag_config_khz(khz);
  935. if (ERROR_OK != retval)
  936. return retval;
  937. }
  938. int cur_speed = jtag_get_speed_khz();
  939. retval = jtag_get_speed_readable(&cur_speed);
  940. if (ERROR_OK != retval)
  941. return retval;
  942. if (cur_speed)
  943. command_print(cmd_ctx, "%d kHz", cur_speed);
  944. else
  945. command_print(cmd_ctx, "RCLK - adaptive");
  946. return retval;
  947. }
  948. static int handle_jtag_reset_command(struct command_context_s *cmd_ctx,
  949. char *cmd, char **args, int argc)
  950. {
  951. if (argc != 2)
  952. return ERROR_COMMAND_SYNTAX_ERROR;
  953. int trst = -1;
  954. if (args[0][0] == '1')
  955. trst = 1;
  956. else if (args[0][0] == '0')
  957. trst = 0;
  958. else
  959. return ERROR_COMMAND_SYNTAX_ERROR;
  960. int srst = -1;
  961. if (args[1][0] == '1')
  962. srst = 1;
  963. else if (args[1][0] == '0')
  964. srst = 0;
  965. else
  966. return ERROR_COMMAND_SYNTAX_ERROR;
  967. if (jtag_interface_init(cmd_ctx) != ERROR_OK)
  968. return ERROR_JTAG_INIT_FAILED;
  969. jtag_add_reset(trst, srst);
  970. jtag_execute_queue();
  971. return ERROR_OK;
  972. }
  973. static int handle_runtest_command(struct command_context_s *cmd_ctx,
  974. char *cmd, char **args, int argc)
  975. {
  976. if (argc != 1)
  977. return ERROR_COMMAND_SYNTAX_ERROR;
  978. unsigned num_clocks;
  979. int retval = parse_uint(args[0], &num_clocks);
  980. if (ERROR_OK != retval)
  981. return retval;
  982. jtag_add_runtest(num_clocks, TAP_IDLE);
  983. jtag_execute_queue();
  984. return ERROR_OK;
  985. }
  986. /*
  987. * For "irscan" or "drscan" commands, the "end" (really, "next") state
  988. * should be stable ... and *NOT* a shift state, otherwise free-running
  989. * jtag clocks could change the values latched by the update state.
  990. */
  991. static bool scan_is_safe(tap_state_t state)
  992. {
  993. switch (state)
  994. {
  995. case TAP_RESET:
  996. case TAP_IDLE:
  997. case TAP_DRPAUSE:
  998. case TAP_IRPAUSE:
  999. return true;
  1000. default:
  1001. return false;
  1002. }
  1003. }
  1004. static int handle_irscan_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
  1005. {
  1006. int i;
  1007. scan_field_t *fields;
  1008. jtag_tap_t *tap;
  1009. tap_state_t endstate;
  1010. if ((argc < 2) || (argc % 2))
  1011. {
  1012. return ERROR_COMMAND_SYNTAX_ERROR;
  1013. }
  1014. /* optional "-endstate" "statename" at the end of the arguments,
  1015. * so that e.g. IRPAUSE can let us load the data register before
  1016. * entering RUN/IDLE to execute the instruction we load here.
  1017. */
  1018. endstate = TAP_IDLE;
  1019. if ( argc >= 4 ){
  1020. /* have at least one pair of numbers. */
  1021. /* is last pair the magic text? */
  1022. if ( 0 == strcmp( "-endstate", args[ argc - 2 ] ) ){
  1023. const char *cpA;
  1024. const char *cpS;
  1025. cpA = args[ argc-1 ];
  1026. for ( endstate = 0 ; endstate < TAP_NUM_STATES ; endstate++ ){
  1027. cpS = tap_state_name( endstate );
  1028. if ( 0 == strcmp( cpA, cpS ) ){
  1029. break;
  1030. }
  1031. }
  1032. if ( endstate >= TAP_NUM_STATES ){
  1033. return ERROR_COMMAND_SYNTAX_ERROR;
  1034. } else {
  1035. if (!scan_is_safe(endstate))
  1036. LOG_WARNING("irscan with unsafe "
  1037. "endstate \"%s\"", cpA);
  1038. /* found - remove the last 2 args */
  1039. argc -= 2;
  1040. }
  1041. }
  1042. }
  1043. int num_fields = argc / 2;
  1044. size_t fields_len = sizeof(scan_field_t) * num_fields;
  1045. fields = malloc(fields_len);
  1046. memset(fields, 0, fields_len);
  1047. int retval;
  1048. for (i = 0; i < num_fields; i++)
  1049. {
  1050. tap = jtag_tap_by_string( args[i*2] );
  1051. if (tap == NULL)
  1052. {
  1053. command_print( cmd_ctx, "Tap: %s unknown", args[i*2] );
  1054. return ERROR_FAIL;
  1055. }
  1056. int field_size = tap->ir_length;
  1057. fields[i].tap = tap;
  1058. fields[i].num_bits = field_size;
  1059. fields[i].out_value = malloc(CEIL(field_size, 8));
  1060. uint32_t value;
  1061. retval = parse_u32(args[i * 2 + 1], &value);
  1062. if (ERROR_OK != retval)
  1063. goto error_return;
  1064. buf_set_u32(fields[i].out_value, 0, field_size, value);
  1065. fields[i].in_value = NULL;
  1066. }
  1067. /* did we have an endstate? */
  1068. jtag_add_ir_scan(num_fields, fields, endstate);
  1069. retval = jtag_execute_queue();
  1070. error_return:
  1071. for (i = 0; i < num_fields; i++)
  1072. {
  1073. if (NULL != fields[i].out_value)
  1074. free(fields[i].out_value);
  1075. }
  1076. free (fields);
  1077. return retval;
  1078. }
  1079. static int Jim_Command_drscan(Jim_Interp *interp, int argc, Jim_Obj *const *args)
  1080. {
  1081. int retval;
  1082. scan_field_t *fields;
  1083. int num_fields;
  1084. int field_count = 0;
  1085. int i, e;
  1086. jtag_tap_t *tap;
  1087. tap_state_t endstate;
  1088. /* args[1] = device
  1089. * args[2] = num_bits
  1090. * args[3] = hex string
  1091. * ... repeat num bits and hex string ...
  1092. *
  1093. * .. optionally:
  1094. * args[N-2] = "-endstate"
  1095. * args[N-1] = statename
  1096. */
  1097. if ((argc < 4) || ((argc % 2) != 0))
  1098. {
  1099. Jim_WrongNumArgs(interp, 1, args, "wrong arguments");
  1100. return JIM_ERR;
  1101. }
  1102. endstate = TAP_IDLE;
  1103. script_debug(interp, "drscan", argc, args);
  1104. /* validate arguments as numbers */
  1105. e = JIM_OK;
  1106. for (i = 2; i < argc; i += 2)
  1107. {
  1108. long bits;
  1109. const char *cp;
  1110. e = Jim_GetLong(interp, args[i], &bits);
  1111. /* If valid - try next arg */
  1112. if ( e == JIM_OK ){
  1113. continue;
  1114. }
  1115. /* Not valid.. are we at the end? */
  1116. if ( ((i + 2) != argc) ){
  1117. /* nope, then error */
  1118. return e;
  1119. }
  1120. /* it could be: "-endstate FOO"
  1121. * e.g. DRPAUSE so we can issue more instructions
  1122. * before entering RUN/IDLE and executing them.
  1123. */
  1124. /* get arg as a string. */
  1125. cp = Jim_GetString( args[i], NULL );
  1126. /* is it the magic? */
  1127. if ( 0 == strcmp( "-endstate", cp ) ){
  1128. /* is the statename valid? */
  1129. cp = Jim_GetString( args[i + 1], NULL );
  1130. /* see if it is a valid state name */
  1131. endstate = tap_state_by_name(cp);
  1132. if ( endstate < 0 ){
  1133. /* update the error message */
  1134. Jim_SetResult_sprintf(interp,"endstate: %s invalid", cp );
  1135. } else {
  1136. if (!scan_is_safe(endstate))
  1137. LOG_WARNING("drscan with unsafe "
  1138. "endstate \"%s\"", cp);
  1139. /* valid - so clear the error */
  1140. e = JIM_OK;
  1141. /* and remove the last 2 args */
  1142. argc -= 2;
  1143. }
  1144. }
  1145. /* Still an error? */
  1146. if ( e != JIM_OK ){
  1147. return e; /* too bad */
  1148. }
  1149. } /* validate args */
  1150. tap = jtag_tap_by_jim_obj( interp, args[1] );
  1151. if ( tap == NULL ){
  1152. return JIM_ERR;
  1153. }
  1154. num_fields = (argc-2)/2;
  1155. fields = malloc(sizeof(scan_field_t) * num_fields);
  1156. for (i = 2; i < argc; i += 2)
  1157. {
  1158. long bits;
  1159. int len;
  1160. const char *str;
  1161. Jim_GetLong(interp, args[i], &bits);
  1162. str = Jim_GetString(args[i + 1], &len);
  1163. fields[field_count].tap = tap;
  1164. fields[field_count].num_bits = bits;
  1165. fields[field_count].out_value = malloc(CEIL(bits, 8));
  1166. str_to_buf(str, len, fields[field_count].out_value, bits, 0);
  1167. fields[field_count].in_value = fields[field_count].out_value;
  1168. field_count++;
  1169. }
  1170. jtag_add_dr_scan(num_fields, fields, endstate);
  1171. retval = jtag_execute_queue();
  1172. if (retval != ERROR_OK)
  1173. {
  1174. Jim_SetResultString(interp, "drscan: jtag execute failed",-1);
  1175. return JIM_ERR;
  1176. }
  1177. field_count = 0;
  1178. Jim_Obj *list = Jim_NewListObj(interp, NULL, 0);
  1179. for (i = 2; i < argc; i += 2)
  1180. {
  1181. long bits;
  1182. char *str;
  1183. Jim_GetLong(interp, args[i], &bits);
  1184. str = buf_to_str(fields[field_count].in_value, bits, 16);
  1185. free(fields[field_count].out_value);
  1186. Jim_ListAppendElement(interp, list, Jim_NewStringObj(interp, str, strlen(str)));
  1187. free(str);
  1188. field_count++;
  1189. }
  1190. Jim_SetResult(interp, list);
  1191. free(fields);
  1192. return JIM_OK;
  1193. }
  1194. static int Jim_Command_pathmove(Jim_Interp *interp, int argc, Jim_Obj *const *args)
  1195. {
  1196. tap_state_t states[8];
  1197. if ((argc < 2) || ((size_t)argc > (sizeof(states)/sizeof(*states) + 1)))
  1198. {
  1199. Jim_WrongNumArgs(interp, 1, args, "wrong arguments");
  1200. return JIM_ERR;
  1201. }
  1202. script_debug(interp, "pathmove", argc, args);
  1203. int i;
  1204. for (i = 0; i < argc-1; i++)
  1205. {
  1206. const char *cp;
  1207. cp = Jim_GetString( args[i + 1], NULL );
  1208. states[i] = tap_state_by_name(cp);
  1209. if ( states[i] < 0 )
  1210. {
  1211. /* update the error message */
  1212. Jim_SetResult_sprintf(interp,"endstate: %s invalid", cp );
  1213. return JIM_ERR;
  1214. }
  1215. }
  1216. if ((jtag_add_statemove(states[0]) != ERROR_OK) || ( jtag_execute_queue()!= ERROR_OK))
  1217. {
  1218. Jim_SetResultString(interp, "pathmove: jtag execute failed",-1);
  1219. return JIM_ERR;
  1220. }
  1221. jtag_add_pathmove(argc-2, states + 1);
  1222. if (jtag_execute_queue()!= ERROR_OK)
  1223. {
  1224. Jim_SetResultString(interp, "pathmove: failed",-1);
  1225. return JIM_ERR;
  1226. }
  1227. return JIM_OK;
  1228. }
  1229. static int Jim_Command_flush_count(Jim_Interp *interp, int argc, Jim_Obj *const *args)
  1230. {
  1231. script_debug(interp, "flush_count", argc, args);
  1232. Jim_SetResult(interp, Jim_NewIntObj(interp, jtag_get_flush_queue_count()));
  1233. return JIM_OK;
  1234. }
  1235. static int handle_verify_ircapture_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
  1236. {
  1237. if (argc > 1)
  1238. return ERROR_COMMAND_SYNTAX_ERROR;
  1239. if (argc == 1)
  1240. {
  1241. if (strcmp(args[0], "enable") == 0)
  1242. jtag_set_verify_capture_ir(true);
  1243. else if (strcmp(args[0], "disable") == 0)
  1244. jtag_set_verify_capture_ir(false);
  1245. else
  1246. return ERROR_COMMAND_SYNTAX_ERROR;
  1247. }
  1248. const char *status = jtag_will_verify_capture_ir() ? "enabled": "disabled";
  1249. command_print(cmd_ctx, "verify Capture-IR is %s", status);
  1250. return ERROR_OK;
  1251. }
  1252. static int handle_verify_jtag_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
  1253. {
  1254. if (argc > 1)
  1255. return ERROR_COMMAND_SYNTAX_ERROR;
  1256. if (argc == 1)
  1257. {
  1258. if (strcmp(args[0], "enable") == 0)
  1259. jtag_set_verify(true);
  1260. else if (strcmp(args[0], "disable") == 0)
  1261. jtag_set_verify(false);
  1262. else
  1263. return ERROR_COMMAND_SYNTAX_ERROR;
  1264. }
  1265. const char *status = jtag_will_verify() ? "enabled": "disabled";
  1266. command_print(cmd_ctx, "verify jtag capture is %s", status);
  1267. return ERROR_OK;
  1268. }
  1269. static int handle_tms_sequence_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
  1270. {
  1271. if (argc > 1)
  1272. return ERROR_COMMAND_SYNTAX_ERROR;
  1273. if (argc == 1)
  1274. {
  1275. bool use_new_table;
  1276. if (strcmp(args[0], "short") == 0)
  1277. use_new_table = true;
  1278. else if (strcmp(args[0], "long") == 0)
  1279. use_new_table = false;
  1280. else
  1281. return ERROR_COMMAND_SYNTAX_ERROR;
  1282. tap_use_new_tms_table(use_new_table);
  1283. }
  1284. command_print(cmd_ctx, "tms sequence is %s",
  1285. tap_uses_new_tms_table() ? "short": "long");
  1286. return ERROR_OK;
  1287. }