board/digsy_mtc/cmd_mtc.c

   1 /*
   2  * (C) Copyright 2009
   3  * Werner Pfister <Pfister_Werner@intercontrol.de>
   4  *
   5  * (C) Copyright 2009 Semihalf, Grzegorz Bernacki
   6  *
   7  * See file CREDITS for list of people who contributed to this
   8  * project.
   9  *
  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.
  14  *
  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.
  19  *
  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,
  23  * MA 02111-1307 USA
  24  */
  25
  26 #include <common.h>
  27 #include <command.h>
  28 #include <mpc5xxx.h>
  29 #include "spi.h"
  30 #include "cmd_mtc.h"
  31
  32 DECLARE_GLOBAL_DATA_PTR;
  33
  34 static const char *led_names[] = {
  35         "diag",
  36         "can1",
  37         "can2",
  38         "can3",
  39         "can4",
  40         "usbpwr",
  41         "usbbusy",
  42         "user1",
  43         "user2",
  44         ""
  45 };
  46
  47 static int msp430_xfer(const void *dout, void *din)
  48 {
  49         int err;
  50
  51         err = spi_xfer(NULL, MTC_TRANSFER_SIZE, dout, din,
  52                        SPI_XFER_BEGIN | SPI_XFER_END);
  53
  54         /* The MSP chip needs time to ready itself for the next command */
  55         udelay(1000);
  56
  57         return err;
  58 }
  59
  60 static void mtc_calculate_checksum(tx_msp_cmd *packet)
  61 {
  62         int i;
  63         uchar *buff;
  64
  65         buff = (uchar *) packet;
  66
  67         for (i = 0; i < 6; i++)
  68                 packet->cks += buff[i];
  69 }
  70
  71 static int do_mtc_led(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
  72 {
  73         tx_msp_cmd pcmd;
  74         rx_msp_cmd prx;
  75         int err;
  76         int i;
  77
  78         if (argc < 2) {
  79                 cmd_usage(cmdtp);
  80                 return -1;
  81         }
  82
  83         memset(&pcmd, 0, sizeof(pcmd));
  84         memset(&prx, 0, sizeof(prx));
  85
  86         pcmd.cmd = CMD_SET_LED;
  87
  88         pcmd.cmd_val0 = 0xff;
  89         for (i = 0; strlen(led_names[i]) != 0; i++) {
  90                 if (strncmp(argv[1], led_names[i], strlen(led_names[i])) == 0) {
  91                         pcmd.cmd_val0 = i;
  92                         break;
  93                 }
  94         }
  95
  96         if (pcmd.cmd_val0 == 0xff) {
  97                 printf("Usage:\n%s\n", cmdtp->help);
  98                 return -1;
  99         }
 100
 101         if (argc >= 3) {
 102                 if (strncmp(argv[2], "red", 3) == 0)
 103                         pcmd.cmd_val1 = 1;
 104                 else if (strncmp(argv[2], "green", 5) == 0)
 105                         pcmd.cmd_val1 = 2;
 106                 else if (strncmp(argv[2], "orange", 6) == 0)
 107                         pcmd.cmd_val1 = 3;
 108                 else
 109                         pcmd.cmd_val1 = 0;
 110         }
 111
 112         if (argc >= 4)
 113                 pcmd.cmd_val2 = simple_strtol(argv[3], NULL, 10);
 114         else
 115                 pcmd.cmd_val2 = 0;
 116
 117         mtc_calculate_checksum(&pcmd);
 118         err = msp430_xfer(&pcmd, &prx);
 119
 120         return err;
 121 }
 122
 123 static int do_mtc_key(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
 124 {
 125         tx_msp_cmd pcmd;
 126         rx_msp_cmd prx;
 127         int err;
 128
 129         memset(&pcmd, 0, sizeof(pcmd));
 130         memset(&prx, 0, sizeof(prx));
 131
 132         pcmd.cmd = CMD_GET_VIM;
 133
 134         mtc_calculate_checksum(&pcmd);
 135         err = msp430_xfer(&pcmd, &prx);
 136
 137         if (!err) {
 138                 /* function returns '0' if key is pressed */
 139                 err = (prx.input & 0x80) ? 0 : 1;
 140         }
 141
 142         return err;
 143 }
 144
 145 static int do_mtc_digout(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
 146 {
 147         tx_msp_cmd pcmd;
 148         rx_msp_cmd prx;
 149         int err;
 150         uchar channel_mask = 0;
 151
 152         if (argc < 3) {
 153                 cmd_usage(cmdtp);
 154                 return -1;
 155         }
 156
 157         if (strncmp(argv[1], "on", 2) == 0)
 158                 channel_mask |= 1;
 159         if (strncmp(argv[2], "on", 2) == 0)
 160                 channel_mask |= 2;
 161
 162         memset(&pcmd, 0, sizeof(pcmd));
 163         memset(&prx, 0, sizeof(prx));
 164
 165         pcmd.cmd = CMD_GET_VIM;
 166         pcmd.user_out = channel_mask;
 167
 168         mtc_calculate_checksum(&pcmd);
 169         err = msp430_xfer(&pcmd, &prx);
 170
 171         return err;
 172 }
 173
 174 static int do_mtc_digin(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
 175 {
 176         tx_msp_cmd pcmd;
 177         rx_msp_cmd prx;
 178         int err;
 179         uchar channel_num = 0;
 180
 181         if (argc < 2) {
 182                 cmd_usage(cmdtp);
 183                 return -1;
 184         }
 185
 186         channel_num = simple_strtol(argv[1], NULL, 10);
 187         if ((channel_num != 1) && (channel_num != 2)) {
 188                 printf("mtc digin: invalid parameter - must be '1' or '2'\n");
 189                 return -1;
 190         }
 191
 192         memset(&pcmd, 0, sizeof(pcmd));
 193         memset(&prx, 0, sizeof(prx));
 194
 195         pcmd.cmd = CMD_GET_VIM;
 196
 197         mtc_calculate_checksum(&pcmd);
 198         err = msp430_xfer(&pcmd, &prx);
 199
 200         if (!err) {
 201                 /* function returns '0' when digin is on */
 202                 err = (prx.input & channel_num) ? 0 : 1;
 203         }
 204
 205         return err;
 206 }
 207
 208 static int do_mtc_appreg(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
 209 {
 210         tx_msp_cmd pcmd;
 211         rx_msp_cmd prx;
 212         int err;
 213         char buf[5];
 214
 215         /* read appreg */
 216         memset(&pcmd, 0, sizeof(pcmd));
 217         memset(&prx, 0, sizeof(prx));
 218
 219         pcmd.cmd = CMD_WD_PARA;
 220         pcmd.cmd_val0 = 5;      /* max. Count */
 221         pcmd.cmd_val1 = 5;      /* max. Time */
 222         pcmd.cmd_val2 = 0;      /* =0 means read appreg */
 223
 224         mtc_calculate_checksum(&pcmd);
 225         err = msp430_xfer(&pcmd, &prx);
 226
 227         if (!err) {
 228                 sprintf(buf, "%d", prx.ack2);
 229                 setenv("appreg", buf);
 230         }
 231
 232         return err;
 233 }
 234
 235 static int do_mtc_version(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
 236 {
 237         tx_msp_cmd pcmd;
 238         rx_msp_cmd prx;
 239         int err;
 240
 241         memset(&pcmd, 0, sizeof(pcmd));
 242         memset(&prx, 0, sizeof(prx));
 243
 244         pcmd.cmd = CMD_FW_VERSION;
 245
 246         mtc_calculate_checksum(&pcmd);
 247         err = msp430_xfer(&pcmd, &prx);
 248
 249         if (!err) {
 250                 printf("FW V%d.%d.%d / HW %d\n",
 251                        prx.ack0, prx.ack1, prx.ack3, prx.ack2);
 252         }
 253
 254         return err;
 255 }
 256
 257 static int do_mtc_state(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
 258 {
 259         tx_msp_cmd pcmd;
 260         rx_msp_cmd prx;
 261         int err;
 262
 263         memset(&pcmd, 0, sizeof(pcmd));
 264         memset(&prx, 0, sizeof(prx));
 265
 266         pcmd.cmd = CMD_WD_WDSTATE;
 267         pcmd.cmd_val2 = 1;
 268
 269         mtc_calculate_checksum(&pcmd);
 270         err = msp430_xfer(&pcmd, &prx);
 271
 272         if (!err) {
 273                 printf("State     %02Xh\n", prx.state);
 274                 printf("Input     %02Xh\n", prx.input);
 275                 printf("UserWD    %02Xh\n", prx.ack2);
 276                 printf("Sys WD    %02Xh\n", prx.ack3);
 277                 printf("WD Timout %02Xh\n", prx.ack0);
 278                 printf("eSysState %02Xh\n", prx.ack1);
 279         }
 280
 281         return err;
 282 }
 283
 284 static int do_mtc_help(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]);
 285
 286 cmd_tbl_t cmd_mtc_sub[] = {
 287         U_BOOT_CMD_MKENT(led, 3, 1, do_mtc_led,
 288         "set state of leds",
 289         "[ledname] [state] [blink]\n"
 290         " - lednames: diag can1 can2 can3 can4 usbpwr usbbusy user1 user2\n"
 291         " - state: off red green orange\n"
 292         " - blink: blink interval in 100ms steps (1 - 10; 0 = static)\n"),
 293         U_BOOT_CMD_MKENT(key, 0, 1, do_mtc_key,
 294         "returns state of user key", ""),
 295         U_BOOT_CMD_MKENT(version, 0, 1, do_mtc_version,
 296         "returns firmware version of supervisor uC", ""),
 297         U_BOOT_CMD_MKENT(appreg, 0, 1, do_mtc_appreg,
 298         "reads appreg value and stores in environment variable 'appreg'", ""),
 299         U_BOOT_CMD_MKENT(digin, 1, 1, do_mtc_digin,
 300         "returns state of digital input",
 301         "<channel_num> - get state of digital input (1 or 2)\n"),
 302         U_BOOT_CMD_MKENT(digout, 2, 1, do_mtc_digout,
 303         "sets digital outputs",
 304         "<on|off> <on|off>- set state of digital output 1 and 2\n"),
 305         U_BOOT_CMD_MKENT(state, 0, 1, do_mtc_state,
 306         "displays state", ""),
 307         U_BOOT_CMD_MKENT(help, 4, 1, do_mtc_help, "get help",
 308         "[command] - get help for command\n"),
 309 };
 310
 311 static int do_mtc_help(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
 312 {
 313         extern int _do_help(cmd_tbl_t *cmd_start, int cmd_items,
 314                             cmd_tbl_t *cmdtp, int flag,
 315                             int argc, char *argv[]);
 316 #ifdef CONFIG_SYS_LONGHELP
 317         puts("mtc ");
 318 #endif
 319         return _do_help(&cmd_mtc_sub[0],
 320                         ARRAY_SIZE(cmd_mtc_sub), cmdtp, flag, argc, argv);
 321 }
 322
 323 /* Relocate the command table function pointers when running in RAM */
 324 int mtc_cmd_init_r(void)
 325 {
 326         cmd_tbl_t *cmdtp;
 327
 328         for (cmdtp = &cmd_mtc_sub[0]; cmdtp !=
 329              &cmd_mtc_sub[ARRAY_SIZE(cmd_mtc_sub)]; cmdtp++) {
 330                 ulong addr;
 331
 332                 addr = (ulong)(cmdtp->cmd) + gd->reloc_off;
 333                 cmdtp->cmd =
 334                     (int (*)(struct cmd_tbl_s *, int, int, char *[]))addr;
 335
 336                 addr = (ulong)(cmdtp->name) + gd->reloc_off;
 337                 cmdtp->name = (char *)addr;
 338
 339                 if (cmdtp->usage) {
 340                         addr = (ulong)(cmdtp->usage) + gd->reloc_off;
 341                         cmdtp->usage = (char *)addr;
 342                 }
 343 #ifdef CONFIG_SYS_LONGHELP
 344                 if (cmdtp->help) {
 345                         addr = (ulong)(cmdtp->help) + gd->reloc_off;
 346                         cmdtp->help = (char *)addr;
 347                 }
 348 #endif
 349         }
 350         return 0;
 351 }
 352
 353 int cmd_mtc(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
 354 {
 355         cmd_tbl_t *c;
 356         int err = 0;
 357
 358         c = find_cmd_tbl(argv[1], &cmd_mtc_sub[0], ARRAY_SIZE(cmd_mtc_sub));
 359         if (c) {
 360                 argc--;
 361                 argv++;
 362                 return c->cmd(c, flag, argc, argv);
 363         } else {
 364                 /* Unrecognized command */
 365                 cmd_usage(cmdtp);
 366                 return 1;
 367         }
 368
 369         return err;
 370 }
 371
 372 U_BOOT_CMD(mtc, 5, 1, cmd_mtc,
 373         "special commands for digsyMTC",
 374         "[subcommand] [args...]\n"
 375         "Subcommands list:\n"
 376         "led [ledname] [state] [blink] - set state of leds\n"
 377         "  [ledname]: diag can1 can2 can3 can4 usbpwr usbbusy user1 user2\n"
 378         "  [state]: off red green orange\n"
 379         "  [blink]: blink interval in 100ms steps (1 - 10; 0 = static)\n"
 380         "key - returns state of user key\n"
 381         "version - returns firmware version of supervisor uC\n"
 382         "appreg - reads appreg value and stores in environment variable"
 383         " 'appreg'\n"
 384         "digin [channel] - returns state of digital input (1 or 2)\n"
 385         "digout <on|off> <on|off> - sets state of two digital outputs\n"
 386         "state - displays state\n"
 387         "help [subcommand] - get help for subcommand\n"
 388 );