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 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
19 ***************************************************************************/
25 #include <helper/log.h>
26 #include <helper/time_support.h>
31 extern struct pld_driver virtex2_pld
;
33 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
)
57 /* pld device <driver> [driver_options ...]
59 COMMAND_HANDLER(handle_pld_device_command
)
66 return ERROR_COMMAND_SYNTAX_ERROR
;
69 for (i
= 0; pld_drivers
[i
]; i
++)
71 if (strcmp(CMD_ARGV
[0], pld_drivers
[i
]->name
) == 0)
73 struct pld_device
*p
, *c
;
75 /* register pld specific commands */
77 if (pld_drivers
[i
]->commands
) {
78 retval
= register_commands(CMD_CTX
, NULL
,
79 pld_drivers
[i
]->commands
);
80 if (ERROR_OK
!= retval
)
82 LOG_ERROR("couldn't register '%s' commands", CMD_ARGV
[0]);
87 c
= malloc(sizeof(struct pld_device
));
88 c
->driver
= pld_drivers
[i
];
91 retval
= CALL_COMMAND_HANDLER(
92 pld_drivers
[i
]->pld_device_command
, c
);
93 if (ERROR_OK
!= retval
)
95 LOG_ERROR("'%s' driver rejected pld device",
101 /* put pld device in linked list */
104 /* find last pld device */
105 for (p
= pld_devices
; p
&& p
->next
; p
= p
->next
);
118 /* no matching pld driver found */
121 LOG_ERROR("pld driver '%s' not found", CMD_ARGV
[0]);
128 COMMAND_HANDLER(handle_pld_devices_command
)
130 struct pld_device
*p
;
135 command_print(CMD_CTX
, "no pld devices configured");
139 for (p
= pld_devices
; p
; p
= p
->next
)
141 command_print(CMD_CTX
, "#%i: %s", i
++, p
->driver
->name
);
147 COMMAND_HANDLER(handle_pld_load_command
)
150 struct timeval start
, end
, duration
;
151 struct pld_device
*p
;
153 gettimeofday(&start
, NULL
);
157 return ERROR_COMMAND_SYNTAX_ERROR
;
161 COMMAND_PARSE_NUMBER(uint
, CMD_ARGV
[0], dev_id
);
162 p
= get_pld_device_by_num(dev_id
);
165 command_print(CMD_CTX
, "pld device '#%s' is out of bounds", CMD_ARGV
[0]);
169 if ((retval
= p
->driver
->load(p
, CMD_ARGV
[1])) != ERROR_OK
)
171 command_print(CMD_CTX
, "failed loading file %s to pld device %u",
172 CMD_ARGV
[1], dev_id
);
180 gettimeofday(&end
, NULL
);
181 timeval_subtract(&duration
, &end
, &start
);
183 command_print(CMD_CTX
, "loaded file %s to pld device %u in %jis %jius",
185 (intmax_t)duration
.tv_sec
, (intmax_t)duration
.tv_usec
);
191 static const struct command_registration pld_exec_command_handlers
[] = {
194 .handler
= handle_pld_devices_command
,
195 .mode
= COMMAND_EXEC
,
196 .help
= "list configured pld devices",
200 .handler
= handle_pld_load_command
,
201 .mode
= COMMAND_EXEC
,
202 .help
= "load configuration file into PLD",
203 .usage
= "pld_num filename",
205 COMMAND_REGISTRATION_DONE
208 static int pld_init(struct command_context
*cmd_ctx
)
213 struct command
*parent
= command_find_in_context(cmd_ctx
, "pld");
214 return register_commands(cmd_ctx
, parent
, pld_exec_command_handlers
);
217 COMMAND_HANDLER(handle_pld_init_command
)
220 return ERROR_COMMAND_SYNTAX_ERROR
;
222 static bool pld_initialized
= false;
225 LOG_INFO("'pld init' has already been called");
228 pld_initialized
= true;
230 LOG_DEBUG("Initializing PLDs...");
231 return pld_init(CMD_CTX
);
234 static const struct command_registration pld_config_command_handlers
[] = {
237 .mode
= COMMAND_CONFIG
,
238 .handler
= handle_pld_device_command
,
239 .help
= "configure a PLD device",
240 .usage
= "driver_name [driver_args ... ]",
244 .mode
= COMMAND_CONFIG
,
245 .handler
= handle_pld_init_command
,
246 .help
= "initialize PLD devices",
248 COMMAND_REGISTRATION_DONE
250 static const struct command_registration pld_command_handler
[] = {
254 .help
= "programmable logic device commands",
255 .chain
= pld_config_command_handlers
,
257 COMMAND_REGISTRATION_DONE
259 int pld_register_commands(struct command_context
*cmd_ctx
)
261 return register_commands(cmd_ctx
, NULL
, pld_command_handler
);