1 /***************************************************************************
2 * Copyright (C) 2006 by Dominic Rath *
3 * Dominic.Rath@gmx.de *
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. *
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. *
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 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. *
19 ***************************************************************************/
26 #include <helper/log.h>
27 #include <helper/time_support.h>
32 extern struct pld_driver virtex2_pld;
34 static struct pld_driver *pld_drivers[] = {
39 static struct pld_device *pld_devices;
41 struct pld_device *get_pld_device_by_num(int num)
46 for (p = pld_devices; p; p = p->next) {
54 /* pld device <driver> [driver_options ...]
56 COMMAND_HANDLER(handle_pld_device_command)
62 return ERROR_COMMAND_SYNTAX_ERROR;
64 for (i = 0; pld_drivers[i]; i++) {
65 if (strcmp(CMD_ARGV[0], pld_drivers[i]->name) == 0) {
66 struct pld_device *p, *c;
68 /* register pld specific commands */
70 if (pld_drivers[i]->commands) {
71 retval = register_commands(CMD_CTX, NULL,
72 pld_drivers[i]->commands);
73 if (ERROR_OK != retval) {
74 LOG_ERROR("couldn't register '%s' commands", CMD_ARGV[0]);
79 c = malloc(sizeof(struct pld_device));
80 c->driver = pld_drivers[i];
83 retval = CALL_COMMAND_HANDLER(
84 pld_drivers[i]->pld_device_command, c);
85 if (ERROR_OK != retval) {
86 LOG_ERROR("'%s' driver rejected pld device",
92 /* put pld device in linked list */
94 /* find last pld device */
95 for (p = pld_devices; p && p->next; p = p->next)
106 /* no matching pld driver found */
108 LOG_ERROR("pld driver '%s' not found", CMD_ARGV[0]);
115 COMMAND_HANDLER(handle_pld_devices_command)
117 struct pld_device *p;
121 command_print(CMD_CTX, "no pld devices configured");
125 for (p = pld_devices; p; p = p->next)
126 command_print(CMD_CTX, "#%i: %s", i++, p->driver->name);
131 COMMAND_HANDLER(handle_pld_load_command)
134 struct timeval start, end, duration;
135 struct pld_device *p;
137 gettimeofday(&start, NULL);
140 return ERROR_COMMAND_SYNTAX_ERROR;
143 COMMAND_PARSE_NUMBER(uint, CMD_ARGV[0], dev_id);
144 p = get_pld_device_by_num(dev_id);
146 command_print(CMD_CTX, "pld device '#%s' is out of bounds", CMD_ARGV[0]);
150 retval = p->driver->load(p, CMD_ARGV[1]);
151 if (retval != ERROR_OK) {
152 command_print(CMD_CTX, "failed loading file %s to pld device %u",
153 CMD_ARGV[1], dev_id);
158 gettimeofday(&end, NULL);
159 timeval_subtract(&duration, &end, &start);
161 command_print(CMD_CTX, "loaded file %s to pld device %u in %jis %jius",
163 (intmax_t)duration.tv_sec, (intmax_t)duration.tv_usec);
169 static const struct command_registration pld_exec_command_handlers[] = {
172 .handler = handle_pld_devices_command,
173 .mode = COMMAND_EXEC,
174 .help = "list configured pld devices",
178 .handler = handle_pld_load_command,
179 .mode = COMMAND_EXEC,
180 .help = "load configuration file into PLD",
181 .usage = "pld_num filename",
183 COMMAND_REGISTRATION_DONE
186 static int pld_init(struct command_context *cmd_ctx)
191 struct command *parent = command_find_in_context(cmd_ctx, "pld");
192 return register_commands(cmd_ctx, parent, pld_exec_command_handlers);
195 COMMAND_HANDLER(handle_pld_init_command)
198 return ERROR_COMMAND_SYNTAX_ERROR;
200 static bool pld_initialized;
201 if (pld_initialized) {
202 LOG_INFO("'pld init' has already been called");
205 pld_initialized = true;
207 LOG_DEBUG("Initializing PLDs...");
208 return pld_init(CMD_CTX);
211 static const struct command_registration pld_config_command_handlers[] = {
214 .mode = COMMAND_CONFIG,
215 .handler = handle_pld_device_command,
216 .help = "configure a PLD device",
217 .usage = "driver_name [driver_args ... ]",
221 .mode = COMMAND_CONFIG,
222 .handler = handle_pld_init_command,
223 .help = "initialize PLD devices",
226 COMMAND_REGISTRATION_DONE
228 static const struct command_registration pld_command_handler[] = {
232 .help = "programmable logic device commands",
234 .chain = pld_config_command_handlers,
236 COMMAND_REGISTRATION_DONE
238 int pld_register_commands(struct command_context *cmd_ctx)
240 return register_commands(cmd_ctx, NULL, pld_command_handler);