]>
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 | 38 | */ |
54841ab5 | 39 | int do_getdcr ( cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[] ) |
3863585b | 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 | 46 | /* Validate arguments */ |
47e26b1b WD |
47 | if (argc < 2) |
48 | return cmd_usage(cmdtp); | |
3863585b | 49 | |
0c8721a4 WD |
50 | /* Get a DCR */ |
51 | dcrn = (unsigned short) simple_strtoul (argv[1], NULL, 16); | |
52 | value = get_dcr (dcrn); | |
3863585b | 53 | |
0c8721a4 | 54 | printf ("%04x: %08lx\n", dcrn, value); |
3863585b | 55 | |
0c8721a4 WD |
56 | return 0; |
57 | } | |
3863585b WD |
58 | |
59 | ||
60 | /* ====================================================================== | |
0c8721a4 | 61 | * Interpreter command to set an AMCC PPC 4xx Device Control Register |
3863585b WD |
62 | * ====================================================================== |
63 | */ | |
54841ab5 | 64 | int do_setdcr (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[]) |
3863585b | 65 | { |
0c8721a4 WD |
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 */ | |
47e26b1b WD |
74 | if (argc < 2) |
75 | return cmd_usage(cmdtp); | |
3863585b | 76 | |
0c8721a4 WD |
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 | } | |
3863585b | 103 | |
af9e1f5b SR |
104 | /* ======================================================================= |
105 | * Interpreter command to retrieve an register value through AMCC PPC 4xx | |
106 | * Device Control Register inderect addressing. | |
107 | * ======================================================================= | |
108 | */ | |
54841ab5 | 109 | int do_getidcr (cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) |
af9e1f5b SR |
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 */ | |
47e26b1b WD |
119 | if (argc < 3) |
120 | return cmd_usage(cmdtp); | |
af9e1f5b SR |
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 | */ | |
54841ab5 | 163 | int do_setidcr (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[]) |
af9e1f5b SR |
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 */ | |
47e26b1b WD |
173 | if (argc < 4) |
174 | return cmd_usage(cmdtp); | |
af9e1f5b SR |
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 | */ | |
2b2a40be WD |
191 | adr_dcrn = (unsigned short) simple_strtoul (buf, NULL, 16); |
192 | dat_dcrn = adr_dcrn+1; | |
193 | } | |
af9e1f5b SR |
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 | ||
8bde7f77 WD |
214 | /***************************************************/ |
215 | ||
0d498393 WD |
216 | U_BOOT_CMD( |
217 | getdcr, 2, 1, do_getdcr, | |
2fb2604d | 218 | "Get an AMCC PPC 4xx DCR's value", |
a89c33db | 219 | "dcrn - return a DCR's value." |
8bde7f77 | 220 | ); |
0d498393 WD |
221 | U_BOOT_CMD( |
222 | setdcr, 2, 1, do_setdcr, | |
2fb2604d | 223 | "Set an AMCC PPC 4xx DCR's value", |
a89c33db | 224 | "dcrn - set a DCR's value." |
8bde7f77 WD |
225 | ); |
226 | ||
af9e1f5b SR |
227 | U_BOOT_CMD( |
228 | getidcr, 3, 1, do_getidcr, | |
2fb2604d | 229 | "Get a register value via indirect DCR addressing", |
a89c33db | 230 | "adr_dcrn[.dat_dcrn] offset - write offset to adr_dcrn, read value from dat_dcrn." |
af9e1f5b SR |
231 | ); |
232 | ||
233 | U_BOOT_CMD( | |
234 | setidcr, 4, 1, do_setidcr, | |
2fb2604d | 235 | "Set a register value via indirect DCR addressing", |
a89c33db | 236 | "adr_dcrn[.dat_dcrn] offset value - write offset to adr_dcrn, write value to dat_dcrn." |
af9e1f5b | 237 | ); |