]>
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 | 47 | if (argc < 2) |
4c12eeb8 | 48 | return CMD_RET_USAGE; |
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; | |
0c8721a4 WD |
71 | |
72 | /* Validate arguments */ | |
47e26b1b | 73 | if (argc < 2) |
4c12eeb8 | 74 | return CMD_RET_USAGE; |
3863585b | 75 | |
0c8721a4 WD |
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 | } | |
3863585b | 102 | |
af9e1f5b SR |
103 | /* ======================================================================= |
104 | * Interpreter command to retrieve an register value through AMCC PPC 4xx | |
105 | * Device Control Register inderect addressing. | |
106 | * ======================================================================= | |
107 | */ | |
54841ab5 | 108 | int do_getidcr (cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) |
af9e1f5b SR |
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 */ | |
47e26b1b | 118 | if (argc < 3) |
4c12eeb8 | 119 | return CMD_RET_USAGE; |
af9e1f5b SR |
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 | */ | |
54841ab5 | 162 | int do_setidcr (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[]) |
af9e1f5b SR |
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 */ | |
47e26b1b | 172 | if (argc < 4) |
4c12eeb8 | 173 | return CMD_RET_USAGE; |
af9e1f5b SR |
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 | */ | |
2b2a40be WD |
190 | adr_dcrn = (unsigned short) simple_strtoul (buf, NULL, 16); |
191 | dat_dcrn = adr_dcrn+1; | |
192 | } | |
af9e1f5b SR |
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 | ||
8bde7f77 WD |
213 | /***************************************************/ |
214 | ||
0d498393 WD |
215 | U_BOOT_CMD( |
216 | getdcr, 2, 1, do_getdcr, | |
2fb2604d | 217 | "Get an AMCC PPC 4xx DCR's value", |
a89c33db | 218 | "dcrn - return a DCR's value." |
8bde7f77 | 219 | ); |
0d498393 WD |
220 | U_BOOT_CMD( |
221 | setdcr, 2, 1, do_setdcr, | |
2fb2604d | 222 | "Set an AMCC PPC 4xx DCR's value", |
a89c33db | 223 | "dcrn - set a DCR's value." |
8bde7f77 WD |
224 | ); |
225 | ||
af9e1f5b SR |
226 | U_BOOT_CMD( |
227 | getidcr, 3, 1, do_getidcr, | |
2fb2604d | 228 | "Get a register value via indirect DCR addressing", |
a89c33db | 229 | "adr_dcrn[.dat_dcrn] offset - write offset to adr_dcrn, read value from dat_dcrn." |
af9e1f5b SR |
230 | ); |
231 | ||
232 | U_BOOT_CMD( | |
233 | setidcr, 4, 1, do_setidcr, | |
2fb2604d | 234 | "Set a register value via indirect DCR addressing", |
a89c33db | 235 | "adr_dcrn[.dat_dcrn] offset value - write offset to adr_dcrn, write value to dat_dcrn." |
af9e1f5b | 236 | ); |