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