]>
Commit | Line | Data |
---|---|---|
3863585b WD |
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 | /* | |
0c8721a4 | 25 | * AMCC 4XX DCR Functions |
3863585b WD |
26 | */ |
27 | ||
28 | #include <common.h> | |
29 | #include <config.h> | |
30 | #include <command.h> | |
3863585b | 31 | |
af9e1f5b SR |
32 | unsigned long get_dcr (unsigned short); |
33 | unsigned long set_dcr (unsigned short, unsigned long); | |
34 | ||
0c8721a4 WD |
35 | /* ======================================================================= |
36 | * Interpreter command to retrieve an AMCC PPC 4xx Device Control Register | |
37 | * ======================================================================= | |
3863585b WD |
38 | */ |
39 | int do_getdcr ( cmd_tbl_t *cmdtp, int flag, int argc, char *argv[] ) | |
40 | { | |
0c8721a4 WD |
41 | unsigned short dcrn; /* Device Control Register Num */ |
42 | unsigned long value; /* DCR's value */ | |
3863585b | 43 | |
0c8721a4 | 44 | unsigned long get_dcr (unsigned short); |
8bde7f77 | 45 | |
0c8721a4 WD |
46 | /* Validate arguments */ |
47 | if (argc < 2) { | |
48 | printf ("Usage:\n%s\n", cmdtp->usage); | |
49 | return 1; | |
50 | } | |
3863585b | 51 | |
0c8721a4 WD |
52 | /* Get a DCR */ |
53 | dcrn = (unsigned short) simple_strtoul (argv[1], NULL, 16); | |
54 | value = get_dcr (dcrn); | |
3863585b | 55 | |
0c8721a4 | 56 | printf ("%04x: %08lx\n", dcrn, value); |
3863585b | 57 | |
0c8721a4 WD |
58 | return 0; |
59 | } | |
3863585b WD |
60 | |
61 | ||
62 | /* ====================================================================== | |
0c8721a4 | 63 | * Interpreter command to set an AMCC PPC 4xx Device Control Register |
3863585b WD |
64 | * ====================================================================== |
65 | */ | |
0c8721a4 | 66 | int do_setdcr (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[]) |
3863585b | 67 | { |
0c8721a4 WD |
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; | |
8bde7f77 | 79 | } |
3863585b | 80 | |
0c8721a4 WD |
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 | } | |
3863585b | 107 | |
af9e1f5b SR |
108 | /* ======================================================================= |
109 | * Interpreter command to retrieve an register value through AMCC PPC 4xx | |
110 | * Device Control Register inderect addressing. | |
111 | * ======================================================================= | |
112 | */ | |
113 | int 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 | */ | |
169 | int 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; | |
2b2a40be | 182 | } |
af9e1f5b SR |
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 | */ | |
2b2a40be WD |
199 | adr_dcrn = (unsigned short) simple_strtoul (buf, NULL, 16); |
200 | dat_dcrn = adr_dcrn+1; | |
201 | } | |
af9e1f5b SR |
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 | ||
8bde7f77 WD |
222 | /***************************************************/ |
223 | ||
0d498393 WD |
224 | U_BOOT_CMD( |
225 | getdcr, 2, 1, do_getdcr, | |
0c8721a4 | 226 | "getdcr - Get an AMCC PPC 4xx DCR's value\n", |
8bde7f77 WD |
227 | "dcrn - return a DCR's value.\n" |
228 | ); | |
0d498393 WD |
229 | U_BOOT_CMD( |
230 | setdcr, 2, 1, do_setdcr, | |
0c8721a4 | 231 | "setdcr - Set an AMCC PPC 4xx DCR's value\n", |
8bde7f77 WD |
232 | "dcrn - set a DCR's value.\n" |
233 | ); | |
234 | ||
af9e1f5b SR |
235 | U_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 | ||
241 | U_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 | ); |