common/cmd_dcr.c

   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
  32 unsigned long get_dcr (unsigned short);
  33 unsigned long set_dcr (unsigned short, unsigned long);
  34
  35 /* =======================================================================
  36  * Interpreter command to retrieve an AMCC PPC 4xx Device Control Register
  37  * =======================================================================
  38  */
  39 int do_getdcr ( cmd_tbl_t *cmdtp, int flag, int argc, char * const 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                 return cmd_usage(cmdtp);
  49
  50         /* Get a DCR */
  51         dcrn = (unsigned short) simple_strtoul (argv[1], NULL, 16);
  52         value = get_dcr (dcrn);
  53
  54         printf ("%04x: %08lx\n", dcrn, value);
  55
  56         return 0;
  57 }
  58
  59
  60 /* ======================================================================
  61  * Interpreter command to set an AMCC PPC 4xx Device Control Register
  62  * ======================================================================
  63 */
  64 int do_setdcr (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
  65 {
  66         unsigned short dcrn;    /* Device Control Register Num */
  67         unsigned long value;
  68
  69         /* DCR's value */
  70         int nbytes;
  71         extern char console_buffer[];
  72
  73         /* Validate arguments */
  74         if (argc < 2)
  75                 return cmd_usage(cmdtp);
  76
  77         /* Set a DCR */
  78         dcrn = (unsigned short) simple_strtoul (argv[1], NULL, 16);
  79         do {
  80                 value = get_dcr (dcrn);
  81                 printf ("%04x: %08lx", dcrn, value);
  82                 nbytes = readline (" ? ");
  83                 if (nbytes == 0) {
  84                         /*
  85                          * <CR> pressed as only input, don't modify current
  86                          * location and exit command.
  87                          */
  88                         nbytes = 1;
  89                         return 0;
  90                 } else {
  91                         unsigned long i;
  92                         char *endp;
  93
  94                         i = simple_strtoul (console_buffer, &endp, 16);
  95                         nbytes = endp - console_buffer;
  96                         if (nbytes)
  97                                 set_dcr (dcrn, i);
  98                 }
  99         } while (nbytes);
 100
 101         return 0;
 102 }
 103
 104 /* =======================================================================
 105  * Interpreter command to retrieve an register value through AMCC PPC 4xx
 106  * Device Control Register inderect addressing.
 107  * =======================================================================
 108  */
 109 int do_getidcr (cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 110 {
 111         unsigned short adr_dcrn;        /* Device Control Register Num for Address */
 112         unsigned short dat_dcrn;        /* Device Control Register Num for Data */
 113         unsigned short offset;          /* Register's offset */
 114         unsigned long value;            /* Register's value */
 115         char *ptr = NULL;
 116         char buf[80];
 117
 118         /* Validate arguments */
 119         if (argc < 3)
 120                 return cmd_usage(cmdtp);
 121
 122         /* Find out whether ther is '.' (dot) symbol in the first parameter. */
 123         strncpy (buf, argv[1], sizeof(buf)-1);
 124         buf[sizeof(buf)-1] = 0; /* will guarantee zero-end string */
 125         ptr = strchr (buf, '.');
 126
 127         if (ptr != NULL) {
 128                 /* First parameter has format adr_dcrn.dat_dcrn */
 129                 *ptr++ = 0; /* erase '.', create zero-end string */
 130                 adr_dcrn = (unsigned short) simple_strtoul (buf, NULL, 16);
 131                 dat_dcrn = (unsigned short) simple_strtoul (ptr, NULL, 16);
 132         } else {
 133                 /*
 134                  * First parameter has format adr_dcrn; dat_dcrn will be
 135                  * calculated as adr_dcrn+1.
 136                  */
 137                 adr_dcrn = (unsigned short) simple_strtoul (buf, NULL, 16);
 138                 dat_dcrn = adr_dcrn+1;
 139         }
 140
 141         /* Register's offset */
 142         offset = (unsigned short) simple_strtoul (argv[2], NULL, 16);
 143
 144         /* Disable interrupts */
 145         disable_interrupts ();
 146         /* Set offset */
 147         set_dcr (adr_dcrn, offset);
 148         /* get data */
 149         value = get_dcr (dat_dcrn);
 150         /* Enable interrupts */
 151         enable_interrupts ();
 152
 153         printf ("%04x.%04x-%04x Read  %08lx\n", adr_dcrn, dat_dcrn, offset, value);
 154
 155         return 0;
 156 }
 157
 158 /* =======================================================================
 159  * Interpreter command to update an register value through AMCC PPC 4xx
 160  * Device Control Register inderect addressing.
 161  * =======================================================================
 162  */
 163 int do_setidcr (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
 164 {
 165         unsigned short adr_dcrn;        /* Device Control Register Num for Address */
 166         unsigned short dat_dcrn;        /* Device Control Register Num for Data */
 167         unsigned short offset;          /* Register's offset */
 168         unsigned long value;            /* Register's value */
 169         char *ptr = NULL;
 170         char buf[80];
 171
 172         /* Validate arguments */
 173         if (argc < 4)
 174                 return cmd_usage(cmdtp);
 175
 176         /* Find out whether ther is '.' (dot) symbol in the first parameter. */
 177         strncpy (buf, argv[1], sizeof(buf)-1);
 178         buf[sizeof(buf)-1] = 0; /* will guarantee zero-end string */
 179         ptr = strchr (buf, '.');
 180
 181         if (ptr != NULL) {
 182                 /* First parameter has format adr_dcrn.dat_dcrn */
 183                 *ptr++ = 0;     /* erase '.', create zero-end string */
 184                 adr_dcrn = (unsigned short) simple_strtoul (buf, NULL, 16);
 185                 dat_dcrn = (unsigned short) simple_strtoul (ptr, NULL, 16);
 186         } else {
 187                 /*
 188                  * First parameter has format adr_dcrn; dat_dcrn will be
 189                  * calculated as adr_dcrn+1.
 190                  */
 191                 adr_dcrn = (unsigned short) simple_strtoul (buf, NULL, 16);
 192                 dat_dcrn = adr_dcrn+1;
 193         }
 194
 195         /* Register's offset */
 196         offset = (unsigned short) simple_strtoul (argv[2], NULL, 16);
 197         /* New value */
 198         value  = (unsigned  long) simple_strtoul (argv[3], NULL, 16);
 199
 200         /* Disable interrupts */
 201         disable_interrupts ();
 202         /* Set offset */
 203         set_dcr (adr_dcrn, offset);
 204         /* set data */
 205         set_dcr (dat_dcrn, value);
 206         /* Enable interrupts */
 207         enable_interrupts ();
 208
 209         printf ("%04x.%04x-%04x Write %08lx\n", adr_dcrn, dat_dcrn, offset, value);
 210
 211         return 0;
 212 }
 213
 214 /***************************************************/
 215
 216 U_BOOT_CMD(
 217         getdcr, 2,      1,      do_getdcr,
 218         "Get an AMCC PPC 4xx DCR's value",
 219         "dcrn - return a DCR's value."
 220 );
 221 U_BOOT_CMD(
 222         setdcr, 2,      1,      do_setdcr,
 223         "Set an AMCC PPC 4xx DCR's value",
 224         "dcrn - set a DCR's value."
 225 );
 226
 227 U_BOOT_CMD(
 228         getidcr,        3,      1,      do_getidcr,
 229         "Get a register value via indirect DCR addressing",
 230         "adr_dcrn[.dat_dcrn] offset - write offset to adr_dcrn, read value from dat_dcrn."
 231 );
 232
 233 U_BOOT_CMD(
 234         setidcr,        4,      1,      do_setidcr,
 235         "Set a register value via indirect DCR addressing",
 236         "adr_dcrn[.dat_dcrn] offset value - write offset to adr_dcrn, write value to dat_dcrn."
 237 );