LXR uboot/common/cmd

   1/*
   2 * (C) Copyright 2001
   3 * Erik Theisen,  Wave 7 Optics, etheisen@mindspring.com.
   4 *
   5 * See file CREDITS for list of people who contributed to this
   6 * project.
   7 *
   8 * This program is free software; you can redistribute it and/or
   9 * modify it under the terms of the GNU General Public License as
  10 * published by the Free Software Foundation; either version 2 of
  11 * the License, or (at your option) any later version.
  12 *
  13 * This program is distributed in the hope that it will be useful,
  14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16 * GNU General Public License for more details.
  17 *
  18 * You should have received a copy of the GNU General Public License
  19 * along with this program; if not, write to the Free Software
  20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  21 * MA 02111-1307 USA
  22 */
  23
  24/*
  25 * AMCC 4XX DCR Functions
  26 */
  27
  28#include <common.h>
  29#include <config.h>
  30#include <command.h>
  31
  32unsigned long get_dcr (unsigned short);
  33unsigned long set_dcr (unsigned short, unsigned long);
  34
  35/* =======================================================================
  36 * Interpreter command to retrieve an AMCC PPC 4xx Device Control Register
  37 * =======================================================================
  38 */
  39int do_getdcr ( cmd_tbl_t *cmdtp, int flag, int argc, char *argv[] )
  40{
  41        unsigned short dcrn;    /* Device Control Register Num */
  42        unsigned long value;    /* DCR's value */
  43
  44        unsigned long get_dcr (unsigned short);
  45
  46        /* Validate arguments */
  47        if (argc < 2) {
  48                printf ("Usage:\n%s\n", cmdtp->usage);
  49                return 1;
  50        }
  51
  52        /* Get a DCR */
  53        dcrn = (unsigned short) simple_strtoul (argv[1], NULL, 16);
  54        value = get_dcr (dcrn);
  55
  56        printf ("%04x: %08lx\n", dcrn, value);
  57
  58        return 0;
  59}
  60
  61
  62/* ======================================================================
  63 * Interpreter command to set an AMCC PPC 4xx Device Control Register
  64 * ======================================================================
  65*/
  66int do_setdcr (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
  67{
  68        unsigned short dcrn;    /* Device Control Register Num */
  69        unsigned long value;
  70
  71        /* DCR's value */
  72        int nbytes;
  73        extern char console_buffer[];
  74
  75        /* Validate arguments */
  76        if (argc < 2) {
  77                printf ("Usage:\n%s\n", cmdtp->usage);
  78                return 1;
  79        }
  80
  81        /* Set a DCR */
  82        dcrn = (unsigned short) simple_strtoul (argv[1], NULL, 16);
  83        do {
  84                value = get_dcr (dcrn);
  85                printf ("%04x: %08lx", dcrn, value);
  86                nbytes = readline (" ? ");
  87                if (nbytes == 0) {
  88                        /*
  89                         * <CR> pressed as only input, don't modify current
  90                         * location and exit command.
  91                         */
  92                        nbytes = 1;
  93                        return 0;
  94                } else {
  95                        unsigned long i;
  96                        char *endp;
  97
  98                        i = simple_strtoul (console_buffer, &endp, 16);
  99                        nbytes = endp - console_buffer;
 100                        if (nbytes)
 101                                set_dcr (dcrn, i);
 102                }
 103        } while (nbytes);
 104
 105        return 0;
 106}
 107
 108/* =======================================================================
 109 * Interpreter command to retrieve an register value through AMCC PPC 4xx
 110 * Device Control Register inderect addressing.
 111 * =======================================================================
 112 */
 113int do_getidcr (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
 114{
 115        unsigned short adr_dcrn;        /* Device Control Register Num for Address */
 116        unsigned short dat_dcrn;        /* Device Control Register Num for Data */
 117        unsigned short offset;          /* Register's offset */
 118        unsigned long value;            /* Register's value */
 119        char *ptr = NULL;
 120        char buf[80];
 121
 122        /* Validate arguments */
 123        if (argc < 3) {
 124                printf ("Usage:\n%s\n", cmdtp->usage);
 125                return 1;
 126        }
 127
 128        /* Find out whether ther is '.' (dot) symbol in the first parameter. */
 129        strncpy (buf, argv[1], sizeof(buf)-1);
 130        buf[sizeof(buf)-1] = 0; /* will guarantee zero-end string */
 131        ptr = strchr (buf, '.');
 132
 133        if (ptr != NULL) {
 134                /* First parameter has format adr_dcrn.dat_dcrn */
 135                *ptr++ = 0; /* erase '.', create zero-end string */
 136                adr_dcrn = (unsigned short) simple_strtoul (buf, NULL, 16);
 137                dat_dcrn = (unsigned short) simple_strtoul (ptr, NULL, 16);
 138        } else {
 139                /*
 140                 * First parameter has format adr_dcrn; dat_dcrn will be
 141                 * calculated as adr_dcrn+1.
 142                 */
 143                adr_dcrn = (unsigned short) simple_strtoul (buf, NULL, 16);
 144                dat_dcrn = adr_dcrn+1;
 145        }
 146
 147        /* Register's offset */
 148        offset = (unsigned short) simple_strtoul (argv[2], NULL, 16);
 149
 150        /* Disable interrupts */
 151        disable_interrupts ();
 152        /* Set offset */
 153        set_dcr (adr_dcrn, offset);
 154        /* get data */
 155        value = get_dcr (dat_dcrn);
 156        /* Enable interrupts */
 157        enable_interrupts ();
 158
 159        printf ("%04x.%04x-%04x Read  %08lx\n", adr_dcrn, dat_dcrn, offset, value);
 160
 161        return 0;
 162}
 163
 164/* =======================================================================
 165 * Interpreter command to update an register value through AMCC PPC 4xx
 166 * Device Control Register inderect addressing.
 167 * =======================================================================
 168 */
 169int do_setidcr (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
 170{
 171        unsigned short adr_dcrn;        /* Device Control Register Num for Address */
 172        unsigned short dat_dcrn;        /* Device Control Register Num for Data */
 173        unsigned short offset;          /* Register's offset */
 174        unsigned long value;            /* Register's value */
 175        char *ptr = NULL;
 176        char buf[80];
 177
 178        /* Validate arguments */
 179        if (argc < 4) {
 180                printf ("Usage:\n%s\n", cmdtp->usage);
 181                return 1;
 182        }
 183
 184        /* Find out whether ther is '.' (dot) symbol in the first parameter. */
 185        strncpy (buf, argv[1], sizeof(buf)-1);
 186        buf[sizeof(buf)-1] = 0; /* will guarantee zero-end string */
 187        ptr = strchr (buf, '.');
 188
 189        if (ptr != NULL) {
 190                /* First parameter has format adr_dcrn.dat_dcrn */
 191                *ptr++ = 0;     /* erase '.', create zero-end string */
 192                adr_dcrn = (unsigned short) simple_strtoul (buf, NULL, 16);
 193                dat_dcrn = (unsigned short) simple_strtoul (ptr, NULL, 16);
 194        } else {
 195                /*
 196                 * First parameter has format adr_dcrn; dat_dcrn will be
 197                 * calculated as adr_dcrn+1.
 198                 */
 199                adr_dcrn = (unsigned short) simple_strtoul (buf, NULL, 16);
 200                dat_dcrn = adr_dcrn+1;
 201        }
 202
 203        /* Register's offset */
 204        offset = (unsigned short) simple_strtoul (argv[2], NULL, 16);
 205        /* New value */
 206        value  = (unsigned  long) simple_strtoul (argv[3], NULL, 16);
 207
 208        /* Disable interrupts */
 209        disable_interrupts ();
 210        /* Set offset */
 211        set_dcr (adr_dcrn, offset);
 212        /* set data */
 213        set_dcr (dat_dcrn, value);
 214        /* Enable interrupts */
 215        enable_interrupts ();
 216
 217        printf ("%04x.%04x-%04x Write %08lx\n", adr_dcrn, dat_dcrn, offset, value);
 218
 219        return 0;
 220}
 221
 222/***************************************************/
 223
 224U_BOOT_CMD(
 225        getdcr, 2,      1,      do_getdcr,
 226        "getdcr  - Get an AMCC PPC 4xx DCR's value\n",
 227        "dcrn - return a DCR's value.\n"
 228);
 229U_BOOT_CMD(
 230        setdcr, 2,      1,      do_setdcr,
 231        "setdcr  - Set an AMCC PPC 4xx DCR's value\n",
 232        "dcrn - set a DCR's value.\n"
 233);
 234
 235U_BOOT_CMD(
 236        getidcr,        3,      1,      do_getidcr,
 237        "getidcr - Get a register value via indirect DCR addressing\n",
 238        "adr_dcrn[.dat_dcrn] offset - write offset to adr_dcrn, read value from dat_dcrn.\n"
 239);
 240
 241U_BOOT_CMD(
 242        setidcr,        4,      1,      do_setidcr,
 243        "setidcr - Set a register value via indirect DCR addressing\n",
 244        "adr_dcrn[.dat_dcrn] offset value - write offset to adr_dcrn, write value to dat_dcrn.\n"
 245);
 246