3 * Werner Pfister <Pfister_Werner@intercontrol.de>
5 * (C) Copyright 2009 Semihalf, Grzegorz Bernacki
7 * See file CREDITS for list of people who contributed to this
10 * This program is free software; you can redistribute it and/or
11 * modify it under the terms of the GNU General Public License as
12 * published by the Free Software Foundation; either version 2 of
13 * the License, or (at your option) any later version.
15 * This program is distributed in the hope that it will be useful,
16 * but WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 * GNU General Public License for more details.
20 * You should have received a copy of the GNU General Public License
21 * along with this program; if not, write to the Free Software
22 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
32 DECLARE_GLOBAL_DATA_PTR;
34 static const char *led_names[] = {
47 static void mtc_calculate_checksum(tx_msp_cmd *packet)
52 buff = (uchar *) packet;
54 for (i = 0; i < 6; i++)
55 packet->cks += buff[i];
58 static int do_mtc_led(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
70 memset(&pcmd, 0, sizeof(pcmd));
71 memset(&prx, 0, sizeof(prx));
73 pcmd.cmd = CMD_SET_LED;
76 for (i = 0; strlen(led_names[i]) != 0; i++) {
77 if (strncmp(argv[1], led_names[i], strlen(led_names[i])) == 0) {
83 if (pcmd.cmd_val0 == 0xff) {
84 printf("Usage:\n%s\n", cmdtp->help);
89 if (strncmp(argv[2], "red", 3) == 0)
91 else if (strncmp(argv[2], "green", 5) == 0)
93 else if (strncmp(argv[2], "orange", 6) == 0)
100 pcmd.cmd_val2 = simple_strtol(argv[3], NULL, 10);
104 mtc_calculate_checksum(&pcmd);
105 err = spi_xfer(NULL, MTC_TRANSFER_SIZE, &pcmd, &prx,
106 SPI_XFER_BEGIN | SPI_XFER_END);
111 static int do_mtc_key(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
117 memset(&pcmd, 0, sizeof(pcmd));
118 memset(&prx, 0, sizeof(prx));
120 pcmd.cmd = CMD_GET_VIM;
122 mtc_calculate_checksum(&pcmd);
123 err = spi_xfer(NULL, MTC_TRANSFER_SIZE, &pcmd, &prx,
124 SPI_XFER_BEGIN | SPI_XFER_END);
127 /* function returns '0' if key is pressed */
128 err = (prx.input & 0x80) ? 0 : 1;
134 static int do_mtc_digout(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
139 uchar channel_mask = 0;
146 if (strncmp(argv[1], "on", 2) == 0)
148 if (strncmp(argv[2], "on", 2) == 0)
151 memset(&pcmd, 0, sizeof(pcmd));
152 memset(&prx, 0, sizeof(prx));
154 pcmd.cmd = CMD_GET_VIM;
155 pcmd.user_out = channel_mask;
157 mtc_calculate_checksum(&pcmd);
158 err = spi_xfer(NULL, MTC_TRANSFER_SIZE, &pcmd, &prx,
159 SPI_XFER_BEGIN | SPI_XFER_END);
164 static int do_mtc_digin(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
169 uchar channel_num = 0;
176 channel_num = simple_strtol(argv[1], NULL, 10);
177 if ((channel_num != 1) && (channel_num != 2)) {
178 printf("mtc digin: invalid parameter - must be '1' or '2'\n");
182 memset(&pcmd, 0, sizeof(pcmd));
183 memset(&prx, 0, sizeof(prx));
185 pcmd.cmd = CMD_GET_VIM;
187 mtc_calculate_checksum(&pcmd);
188 err = spi_xfer(NULL, MTC_TRANSFER_SIZE, &pcmd, &prx,
189 SPI_XFER_BEGIN | SPI_XFER_END);
192 /* function returns '0' when digin is on */
193 err = (prx.input & channel_num) ? 0 : 1;
199 static int do_mtc_appreg(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
207 memset(&pcmd, 0, sizeof(pcmd));
208 memset(&prx, 0, sizeof(prx));
210 pcmd.cmd = CMD_WD_PARA;
211 pcmd.cmd_val0 = 5; /* max. Count */
212 pcmd.cmd_val1 = 5; /* max. Time */
213 pcmd.cmd_val2 = 0; /* =0 means read appreg */
215 mtc_calculate_checksum(&pcmd);
216 err = spi_xfer(NULL, MTC_TRANSFER_SIZE, &pcmd, &prx,
217 SPI_XFER_BEGIN | SPI_XFER_END);
219 sprintf(buf, "%d", prx.ack2);
220 setenv("appreg", buf);
226 static int do_mtc_version(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
232 memset(&pcmd, 0, sizeof(pcmd));
233 memset(&prx, 0, sizeof(prx));
235 pcmd.cmd = CMD_FW_VERSION;
237 mtc_calculate_checksum(&pcmd);
238 err = spi_xfer(NULL, MTC_TRANSFER_SIZE, &pcmd, &prx,
239 SPI_XFER_BEGIN | SPI_XFER_END);
242 printf("FW V%d.%d.%d / HW %d\n",
243 prx.ack0, prx.ack1, prx.ack3, prx.ack2);
249 static int do_mtc_help(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]);
251 cmd_tbl_t cmd_mtc_sub[] = {
252 U_BOOT_CMD_MKENT(led, 3, 1, do_mtc_led,
254 "[ledname] [state] [blink]\n"
255 " - lednames: diag can1 can2 can3 can4 usbpwr usbbusy user1 user2\n"
256 " - state: off red green orange\n"
257 " - blink: blink interval in 100ms steps (1 - 10; 0 = static)\n"),
258 U_BOOT_CMD_MKENT(key, 0, 1, do_mtc_key,
259 "returns state of user key\n", ""),
260 U_BOOT_CMD_MKENT(version, 0, 1, do_mtc_version,
261 "returns firmware version of supervisor uC\n", ""),
262 U_BOOT_CMD_MKENT(appreg, 0, 1, do_mtc_appreg,
263 "reads appreg value and stores in environment variable 'appreg'\n", ""),
264 U_BOOT_CMD_MKENT(digin, 1, 1, do_mtc_digin,
265 "returns state of digital input",
266 "<channel_num> - get state of digital input (1 or 2)\n"),
267 U_BOOT_CMD_MKENT(digout, 2, 1, do_mtc_digout,
268 "sets digital outputs",
269 "<on|off> <on|off>- set state of digital output 1 and 2\n"),
270 U_BOOT_CMD_MKENT(help, 4, 1, do_mtc_help, "get help",
271 "[command] - get help for command\n"),
274 static int do_mtc_help(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
276 extern int _do_help(cmd_tbl_t *cmd_start, int cmd_items,
277 cmd_tbl_t *cmdtp, int flag,
278 int argc, char *argv[]);
279 #ifdef CONFIG_SYS_LONGHELP
282 return _do_help(&cmd_mtc_sub[0],
283 ARRAY_SIZE(cmd_mtc_sub), cmdtp, flag, argc, argv);
286 /* Relocate the command table function pointers when running in RAM */
287 int mtc_cmd_init_r(void)
291 for (cmdtp = &cmd_mtc_sub[0]; cmdtp !=
292 &cmd_mtc_sub[ARRAY_SIZE(cmd_mtc_sub)]; cmdtp++) {
295 addr = (ulong)(cmdtp->cmd) + gd->reloc_off;
297 (int (*)(struct cmd_tbl_s *, int, int, char *[]))addr;
299 addr = (ulong)(cmdtp->name) + gd->reloc_off;
300 cmdtp->name = (char *)addr;
303 addr = (ulong)(cmdtp->usage) + gd->reloc_off;
304 cmdtp->usage = (char *)addr;
306 #ifdef CONFIG_SYS_LONGHELP
308 addr = (ulong)(cmdtp->help) + gd->reloc_off;
309 cmdtp->help = (char *)addr;
316 int cmd_mtc(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
321 c = find_cmd_tbl(argv[1], &cmd_mtc_sub[0], ARRAY_SIZE(cmd_mtc_sub));
325 return c->cmd(c, flag, argc, argv);
327 /* Unrecognized command */
335 U_BOOT_CMD(mtc, 5, 1, cmd_mtc,
336 "mtc - special commands for digsyMTC\n",
337 "[subcommand] [args...]\n"
338 "Subcommands list:\n"
339 "led [ledname] [state] [blink] - set state of leds\n"
340 " [ledname]: diag can1 can2 can3 can4 usbpwr usbbusy user1 user2\n"
341 " [state]: off red green orange\n"
342 " [blink]: blink interval in 100ms steps (1 - 10; 0 = static)\n"
343 "key - returns state of user key\n"
344 "version - returns firmware version of supervisor uC\n"
345 "appreg - reads appreg value and stores in environment variable"
347 "digin [channel] - returns state of digital input (1 or 2)\n"
348 "digout <on|off> <on|off> - sets state of two digital outputs\n"
349 "help [subcommand] - get help for subcommand\n");