20082f3858f258a4cd4f36328f253673605657a8
[openocd.git] / src / jtag / hla / hla_tcl.c
1 /***************************************************************************
2 * Copyright (C) 2011 by Mathias Kuester *
3 * Mathias Kuester <kesmtp@freenet.de> *
4 * *
5 * Copyright (C) 2012 by Spencer Oliver *
6 * spen@spen-soft.co.uk *
7 * *
8 * This program is free software; you can redistribute it and/or modify *
9 * it under the terms of the GNU General Public License as published by *
10 * the Free Software Foundation; either version 2 of the License, or *
11 * (at your option) any later version. *
12 * *
13 * This program is distributed in the hope that it will be useful, *
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
16 * GNU General Public License for more details. *
17 * *
18 * You should have received a copy of the GNU General Public License *
19 * along with this program; if not, write to the *
20 * Free Software Foundation, Inc., *
21 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. *
22 ***************************************************************************/
23
24 #ifdef HAVE_CONFIG_H
25 #include "config.h"
26 #endif
27
28 /* project specific includes */
29 #include <jtag/interface.h>
30 #include <transport/transport.h>
31 #include <helper/time_support.h>
32
33 static int jim_newtap_expected_id(Jim_Nvp *n, Jim_GetOptInfo *goi,
34 struct jtag_tap *pTap)
35 {
36 jim_wide w;
37 int e = Jim_GetOpt_Wide(goi, &w);
38 if (e != JIM_OK) {
39 Jim_SetResultFormatted(goi->interp, "option: %s bad parameter",
40 n->name);
41 return e;
42 }
43
44 unsigned expected_len = sizeof(uint32_t) * pTap->expected_ids_cnt;
45 uint32_t *new_expected_ids = malloc(expected_len + sizeof(uint32_t));
46 if (new_expected_ids == NULL) {
47 Jim_SetResultFormatted(goi->interp, "no memory");
48 return JIM_ERR;
49 }
50
51 memcpy(new_expected_ids, pTap->expected_ids, expected_len);
52
53 new_expected_ids[pTap->expected_ids_cnt] = w;
54
55 free(pTap->expected_ids);
56 pTap->expected_ids = new_expected_ids;
57 pTap->expected_ids_cnt++;
58
59 return JIM_OK;
60 }
61
62 #define NTAP_OPT_IRLEN 0
63 #define NTAP_OPT_IRMASK 1
64 #define NTAP_OPT_IRCAPTURE 2
65 #define NTAP_OPT_ENABLED 3
66 #define NTAP_OPT_DISABLED 4
67 #define NTAP_OPT_EXPECTED_ID 5
68 #define NTAP_OPT_VERSION 6
69
70 static int jim_hl_newtap_cmd(Jim_GetOptInfo *goi)
71 {
72 struct jtag_tap *pTap;
73 int x;
74 int e;
75 Jim_Nvp *n;
76 char *cp;
77 const Jim_Nvp opts[] = {
78 { .name = "-irlen", .value = NTAP_OPT_IRLEN },
79 { .name = "-irmask", .value = NTAP_OPT_IRMASK },
80 { .name = "-ircapture", .value = NTAP_OPT_IRCAPTURE },
81 { .name = "-enable", .value = NTAP_OPT_ENABLED },
82 { .name = "-disable", .value = NTAP_OPT_DISABLED },
83 { .name = "-expected-id", .value = NTAP_OPT_EXPECTED_ID },
84 { .name = "-ignore-version", .value = NTAP_OPT_VERSION },
85 { .name = NULL, .value = -1},
86 };
87
88 pTap = calloc(1, sizeof(struct jtag_tap));
89 if (!pTap) {
90 Jim_SetResultFormatted(goi->interp, "no memory");
91 return JIM_ERR;
92 }
93
94 /*
95 * we expect CHIP + TAP + OPTIONS
96 * */
97 if (goi->argc < 3) {
98 Jim_SetResultFormatted(goi->interp,
99 "Missing CHIP TAP OPTIONS ....");
100 free(pTap);
101 return JIM_ERR;
102 }
103 Jim_GetOpt_String(goi, &cp, NULL);
104 pTap->chip = strdup(cp);
105
106 Jim_GetOpt_String(goi, &cp, NULL);
107 pTap->tapname = strdup(cp);
108
109 /* name + dot + name + null */
110 x = strlen(pTap->chip) + 1 + strlen(pTap->tapname) + 1;
111 cp = malloc(x);
112 sprintf(cp, "%s.%s", pTap->chip, pTap->tapname);
113 pTap->dotted_name = cp;
114
115 LOG_DEBUG("Creating New Tap, Chip: %s, Tap: %s, Dotted: %s, %d params",
116 pTap->chip, pTap->tapname, pTap->dotted_name, goi->argc);
117
118 while (goi->argc) {
119 e = Jim_GetOpt_Nvp(goi, opts, &n);
120 if (e != JIM_OK) {
121 Jim_GetOpt_NvpUnknown(goi, opts, 0);
122 free(cp);
123 free(pTap);
124 return e;
125 }
126 LOG_DEBUG("Processing option: %s", n->name);
127 switch (n->value) {
128 case NTAP_OPT_EXPECTED_ID:
129 e = jim_newtap_expected_id(n, goi, pTap);
130 if (JIM_OK != e) {
131 free(cp);
132 free(pTap);
133 return e;
134 }
135 break;
136 case NTAP_OPT_IRLEN:
137 case NTAP_OPT_IRMASK:
138 case NTAP_OPT_IRCAPTURE:
139 /* dummy read to ignore the next argument */
140 Jim_GetOpt_Wide(goi, NULL);
141 break;
142 } /* switch (n->value) */
143 } /* while (goi->argc) */
144
145 /* default is enabled-after-reset */
146 pTap->enabled = !pTap->disabled_after_reset;
147
148 jtag_tap_init(pTap);
149 return JIM_OK;
150 }
151
152 int jim_hl_newtap(Jim_Interp *interp, int argc, Jim_Obj * const *argv)
153 {
154 Jim_GetOptInfo goi;
155 Jim_GetOpt_Setup(&goi, interp, argc - 1, argv + 1);
156 return jim_hl_newtap_cmd(&goi);
157 }