]> git.sur5r.net Git - u-boot/blob - common/cmd_dcr.c
bfin: make env offset sector aligned for bct-brettl2 and ibf-dsp561 boards
[u-boot] / common / cmd_dcr.c
1 /*
2  * (C) Copyright 2001
3  * Erik Theisen,  Wave 7 Optics, etheisen@mindspring.com.
4  *
5  * SPDX-License-Identifier:     GPL-2.0+
6  */
7
8 /*
9  * AMCC 4XX DCR Functions
10  */
11
12 #include <common.h>
13 #include <cli.h>
14 #include <config.h>
15 #include <command.h>
16
17 unsigned long get_dcr (unsigned short);
18 unsigned long set_dcr (unsigned short, unsigned long);
19
20 /* =======================================================================
21  * Interpreter command to retrieve an AMCC PPC 4xx Device Control Register
22  * =======================================================================
23  */
24 int do_getdcr ( cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[] )
25 {
26         unsigned short dcrn;    /* Device Control Register Num */
27         unsigned long value;    /* DCR's value */
28
29         unsigned long get_dcr (unsigned short);
30
31         /* Validate arguments */
32         if (argc < 2)
33                 return CMD_RET_USAGE;
34
35         /* Get a DCR */
36         dcrn = (unsigned short) simple_strtoul (argv[1], NULL, 16);
37         value = get_dcr (dcrn);
38
39         printf ("%04x: %08lx\n", dcrn, value);
40
41         return 0;
42 }
43
44
45 /* ======================================================================
46  * Interpreter command to set an AMCC PPC 4xx Device Control Register
47  * ======================================================================
48 */
49 int do_setdcr (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
50 {
51         unsigned short dcrn;    /* Device Control Register Num */
52         unsigned long value;
53
54         /* DCR's value */
55         int nbytes;
56
57         /* Validate arguments */
58         if (argc < 2)
59                 return CMD_RET_USAGE;
60
61         /* Set a DCR */
62         dcrn = (unsigned short) simple_strtoul (argv[1], NULL, 16);
63         do {
64                 value = get_dcr (dcrn);
65                 printf ("%04x: %08lx", dcrn, value);
66                 nbytes = cli_readline(" ? ");
67                 if (nbytes == 0) {
68                         /*
69                          * <CR> pressed as only input, don't modify current
70                          * location and exit command.
71                          */
72                         nbytes = 1;
73                         return 0;
74                 } else {
75                         unsigned long i;
76                         char *endp;
77
78                         i = simple_strtoul (console_buffer, &endp, 16);
79                         nbytes = endp - console_buffer;
80                         if (nbytes)
81                                 set_dcr (dcrn, i);
82                 }
83         } while (nbytes);
84
85         return 0;
86 }
87
88 /* =======================================================================
89  * Interpreter command to retrieve an register value through AMCC PPC 4xx
90  * Device Control Register inderect addressing.
91  * =======================================================================
92  */
93 int do_getidcr (cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
94 {
95         unsigned short adr_dcrn;        /* Device Control Register Num for Address */
96         unsigned short dat_dcrn;        /* Device Control Register Num for Data */
97         unsigned short offset;          /* Register's offset */
98         unsigned long value;            /* Register's value */
99         char *ptr = NULL;
100         char buf[80];
101
102         /* Validate arguments */
103         if (argc < 3)
104                 return CMD_RET_USAGE;
105
106         /* Find out whether ther is '.' (dot) symbol in the first parameter. */
107         strncpy (buf, argv[1], sizeof(buf)-1);
108         buf[sizeof(buf)-1] = 0; /* will guarantee zero-end string */
109         ptr = strchr (buf, '.');
110
111         if (ptr != NULL) {
112                 /* First parameter has format adr_dcrn.dat_dcrn */
113                 *ptr++ = 0; /* erase '.', create zero-end string */
114                 adr_dcrn = (unsigned short) simple_strtoul (buf, NULL, 16);
115                 dat_dcrn = (unsigned short) simple_strtoul (ptr, NULL, 16);
116         } else {
117                 /*
118                  * First parameter has format adr_dcrn; dat_dcrn will be
119                  * calculated as adr_dcrn+1.
120                  */
121                 adr_dcrn = (unsigned short) simple_strtoul (buf, NULL, 16);
122                 dat_dcrn = adr_dcrn+1;
123         }
124
125         /* Register's offset */
126         offset = (unsigned short) simple_strtoul (argv[2], NULL, 16);
127
128         /* Disable interrupts */
129         disable_interrupts ();
130         /* Set offset */
131         set_dcr (adr_dcrn, offset);
132         /* get data */
133         value = get_dcr (dat_dcrn);
134         /* Enable interrupts */
135         enable_interrupts ();
136
137         printf ("%04x.%04x-%04x Read  %08lx\n", adr_dcrn, dat_dcrn, offset, value);
138
139         return 0;
140 }
141
142 /* =======================================================================
143  * Interpreter command to update an register value through AMCC PPC 4xx
144  * Device Control Register inderect addressing.
145  * =======================================================================
146  */
147 int do_setidcr (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
148 {
149         unsigned short adr_dcrn;        /* Device Control Register Num for Address */
150         unsigned short dat_dcrn;        /* Device Control Register Num for Data */
151         unsigned short offset;          /* Register's offset */
152         unsigned long value;            /* Register's value */
153         char *ptr = NULL;
154         char buf[80];
155
156         /* Validate arguments */
157         if (argc < 4)
158                 return CMD_RET_USAGE;
159
160         /* Find out whether ther is '.' (dot) symbol in the first parameter. */
161         strncpy (buf, argv[1], sizeof(buf)-1);
162         buf[sizeof(buf)-1] = 0; /* will guarantee zero-end string */
163         ptr = strchr (buf, '.');
164
165         if (ptr != NULL) {
166                 /* First parameter has format adr_dcrn.dat_dcrn */
167                 *ptr++ = 0;     /* erase '.', create zero-end string */
168                 adr_dcrn = (unsigned short) simple_strtoul (buf, NULL, 16);
169                 dat_dcrn = (unsigned short) simple_strtoul (ptr, NULL, 16);
170         } else {
171                 /*
172                  * First parameter has format adr_dcrn; dat_dcrn will be
173                  * calculated as adr_dcrn+1.
174                  */
175                 adr_dcrn = (unsigned short) simple_strtoul (buf, NULL, 16);
176                 dat_dcrn = adr_dcrn+1;
177         }
178
179         /* Register's offset */
180         offset = (unsigned short) simple_strtoul (argv[2], NULL, 16);
181         /* New value */
182         value  = (unsigned  long) simple_strtoul (argv[3], NULL, 16);
183
184         /* Disable interrupts */
185         disable_interrupts ();
186         /* Set offset */
187         set_dcr (adr_dcrn, offset);
188         /* set data */
189         set_dcr (dat_dcrn, value);
190         /* Enable interrupts */
191         enable_interrupts ();
192
193         printf ("%04x.%04x-%04x Write %08lx\n", adr_dcrn, dat_dcrn, offset, value);
194
195         return 0;
196 }
197
198 /***************************************************/
199
200 U_BOOT_CMD(
201         getdcr, 2,      1,      do_getdcr,
202         "Get an AMCC PPC 4xx DCR's value",
203         "dcrn - return a DCR's value."
204 );
205 U_BOOT_CMD(
206         setdcr, 2,      1,      do_setdcr,
207         "Set an AMCC PPC 4xx DCR's value",
208         "dcrn - set a DCR's value."
209 );
210
211 U_BOOT_CMD(
212         getidcr,        3,      1,      do_getidcr,
213         "Get a register value via indirect DCR addressing",
214         "adr_dcrn[.dat_dcrn] offset - write offset to adr_dcrn, read value from dat_dcrn."
215 );
216
217 U_BOOT_CMD(
218         setidcr,        4,      1,      do_setidcr,
219         "Set a register value via indirect DCR addressing",
220         "adr_dcrn[.dat_dcrn] offset value - write offset to adr_dcrn, write value to dat_dcrn."
221 );