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