David Brownell <david-b@pacbell.net>:
[openocd.git] / src / pld / pld.c
1 /***************************************************************************
2 * Copyright (C) 2006 by Dominic Rath *
3 * Dominic.Rath@gmx.de *
4 * *
5 * This program is free software; you can redistribute it and/or modify *
6 * it under the terms of the GNU General Public License as published by *
7 * the Free Software Foundation; either version 2 of the License, or *
8 * (at your option) any later version. *
9 * *
10 * This program is distributed in the hope that it will be useful, *
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
13 * GNU General Public License for more details. *
14 * *
15 * You should have received a copy of the GNU General Public License *
16 * along with this program; if not, write to the *
17 * Free Software Foundation, Inc., *
18 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
19 ***************************************************************************/
20 #ifdef HAVE_CONFIG_H
21 #include "config.h"
22 #endif
23
24 #include "pld.h"
25 #include "log.h"
26 #include "time_support.h"
27
28
29 /* pld drivers
30 */
31 extern pld_driver_t virtex2_pld;
32
33 static pld_driver_t *pld_drivers[] =
34 {
35 &virtex2_pld,
36 NULL,
37 };
38
39 static pld_device_t *pld_devices;
40 static command_t *pld_cmd;
41
42 static int handle_pld_devices_command(struct command_context_s *cmd_ctx,
43 char *cmd, char **args, int argc);
44 static int handle_pld_device_command(struct command_context_s *cmd_ctx,
45 char *cmd, char **args, int argc);
46 static int handle_pld_load_command(struct command_context_s *cmd_ctx,
47 char *cmd, char **args, int argc);
48
49 int pld_init(struct command_context_s *cmd_ctx)
50 {
51 if (pld_devices)
52 {
53 register_command(cmd_ctx, pld_cmd, "devices", handle_pld_devices_command, COMMAND_EXEC,
54 "list configured pld devices");
55 register_command(cmd_ctx, pld_cmd, "load", handle_pld_load_command, COMMAND_EXEC,
56 "load configuration <file> into programmable logic device");
57 }
58
59 return ERROR_OK;
60 }
61
62 pld_device_t *get_pld_device_by_num(int num)
63 {
64 pld_device_t *p;
65 int i = 0;
66
67 for (p = pld_devices; p; p = p->next)
68 {
69 if (i++ == num)
70 {
71 return p;
72 }
73 }
74
75 return NULL;
76 }
77
78 /* pld device <driver> [driver_options ...]
79 */
80 static int handle_pld_device_command(struct command_context_s *cmd_ctx,
81 char *cmd, char **args, int argc)
82 {
83 int i;
84 int found = 0;
85
86 if (argc < 1)
87 {
88 LOG_WARNING("incomplete 'pld device' command");
89 return ERROR_OK;
90 }
91
92 for (i = 0; pld_drivers[i]; i++)
93 {
94 if (strcmp(args[0], pld_drivers[i]->name) == 0)
95 {
96 pld_device_t *p, *c;
97
98 /* register pld specific commands */
99 if (pld_drivers[i]->register_commands(cmd_ctx) != ERROR_OK)
100 {
101 LOG_ERROR("couldn't register '%s' commands", args[0]);
102 exit(-1);
103 }
104
105 c = malloc(sizeof(pld_device_t));
106 c->driver = pld_drivers[i];
107 c->next = NULL;
108
109 if (pld_drivers[i]->pld_device_command(cmd_ctx, cmd, args, argc, c) != ERROR_OK)
110 {
111 LOG_ERROR("'%s' driver rejected pld device", args[0]);
112 free(c);
113 return ERROR_OK;
114 }
115
116 /* put pld device in linked list */
117 if (pld_devices)
118 {
119 /* find last pld device */
120 for (p = pld_devices; p && p->next; p = p->next);
121 if (p)
122 p->next = c;
123 }
124 else
125 {
126 pld_devices = c;
127 }
128
129 found = 1;
130 }
131 }
132
133 /* no matching pld driver found */
134 if (!found)
135 {
136 LOG_ERROR("pld driver '%s' not found", args[0]);
137 exit(-1);
138 }
139
140 return ERROR_OK;
141 }
142
143 static int handle_pld_devices_command(struct command_context_s *cmd_ctx,
144 char *cmd, char **args, int argc)
145 {
146 pld_device_t *p;
147 int i = 0;
148
149 if (!pld_devices)
150 {
151 command_print(cmd_ctx, "no pld devices configured");
152 return ERROR_OK;
153 }
154
155 for (p = pld_devices; p; p = p->next)
156 {
157 command_print(cmd_ctx, "#%i: %s", i++, p->driver->name);
158 }
159
160 return ERROR_OK;
161 }
162
163 static int handle_pld_load_command(struct command_context_s *cmd_ctx,
164 char *cmd, char **args, int argc)
165 {
166 int retval;
167 struct timeval start, end, duration;
168 pld_device_t *p;
169
170 gettimeofday(&start, NULL);
171
172 if (argc < 2)
173 {
174 command_print(cmd_ctx, "usage: pld load <device#> <file>");
175 return ERROR_OK;
176 }
177
178 p = get_pld_device_by_num(strtoul(args[0], NULL, 0));
179 if (!p)
180 {
181 command_print(cmd_ctx, "pld device '#%s' is out of bounds", args[0]);
182 return ERROR_OK;
183 }
184
185 if ((retval = p->driver->load(p, args[1])) != ERROR_OK)
186 {
187 command_print(cmd_ctx, "failed loading file %s to pld device %lu",
188 args[1], strtoul(args[0], NULL, 0));
189 switch (retval)
190 {
191 }
192 }
193 else
194 {
195 gettimeofday(&end, NULL);
196 timeval_subtract(&duration, &end, &start);
197
198 command_print(cmd_ctx, "loaded file %s to pld device %lu in %jis %jius",
199 args[1], strtoul(args[0], NULL, 0),
200 (intmax_t)duration.tv_sec, (intmax_t)duration.tv_usec);
201 }
202
203 return ERROR_OK;
204 }
205
206 int pld_register_commands(struct command_context_s *cmd_ctx)
207 {
208 pld_cmd = register_command(cmd_ctx, NULL, "pld", NULL, COMMAND_ANY, "programmable logic device commands");
209
210 register_command(cmd_ctx, pld_cmd, "device", handle_pld_device_command, COMMAND_CONFIG, NULL);
211
212 return ERROR_OK;
213 }