1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28#include <common.h>
29#include <command.h>
30#include <miiphy.h>
31
32typedef struct _MII_reg_desc_t {
33 ushort regno;
34 char * name;
35} MII_reg_desc_t;
36
37static const MII_reg_desc_t reg_0_5_desc_tbl[] = {
38 { MII_BMCR, "PHY control register" },
39 { MII_BMSR, "PHY status register" },
40 { MII_PHYSID1, "PHY ID 1 register" },
41 { MII_PHYSID2, "PHY ID 2 register" },
42 { MII_ADVERTISE, "Autonegotiation advertisement register" },
43 { MII_LPA, "Autonegotiation partner abilities register" },
44};
45
46typedef struct _MII_field_desc_t {
47 ushort hi;
48 ushort lo;
49 ushort mask;
50 char * name;
51} MII_field_desc_t;
52
53static const MII_field_desc_t reg_0_desc_tbl[] = {
54 { 15, 15, 0x01, "reset" },
55 { 14, 14, 0x01, "loopback" },
56 { 13, 6, 0x81, "speed selection" },
57 { 12, 12, 0x01, "A/N enable" },
58 { 11, 11, 0x01, "power-down" },
59 { 10, 10, 0x01, "isolate" },
60 { 9, 9, 0x01, "restart A/N" },
61 { 8, 8, 0x01, "duplex" },
62 { 7, 7, 0x01, "collision test enable" },
63 { 5, 0, 0x3f, "(reserved)" }
64};
65
66static const MII_field_desc_t reg_1_desc_tbl[] = {
67 { 15, 15, 0x01, "100BASE-T4 able" },
68 { 14, 14, 0x01, "100BASE-X full duplex able" },
69 { 13, 13, 0x01, "100BASE-X half duplex able" },
70 { 12, 12, 0x01, "10 Mbps full duplex able" },
71 { 11, 11, 0x01, "10 Mbps half duplex able" },
72 { 10, 10, 0x01, "100BASE-T2 full duplex able" },
73 { 9, 9, 0x01, "100BASE-T2 half duplex able" },
74 { 8, 8, 0x01, "extended status" },
75 { 7, 7, 0x01, "(reserved)" },
76 { 6, 6, 0x01, "MF preamble suppression" },
77 { 5, 5, 0x01, "A/N complete" },
78 { 4, 4, 0x01, "remote fault" },
79 { 3, 3, 0x01, "A/N able" },
80 { 2, 2, 0x01, "link status" },
81 { 1, 1, 0x01, "jabber detect" },
82 { 0, 0, 0x01, "extended capabilities" },
83};
84
85static const MII_field_desc_t reg_2_desc_tbl[] = {
86 { 15, 0, 0xffff, "OUI portion" },
87};
88
89static const MII_field_desc_t reg_3_desc_tbl[] = {
90 { 15, 10, 0x3f, "OUI portion" },
91 { 9, 4, 0x3f, "manufacturer part number" },
92 { 3, 0, 0x0f, "manufacturer rev. number" },
93};
94
95static const MII_field_desc_t reg_4_desc_tbl[] = {
96 { 15, 15, 0x01, "next page able" },
97 { 14, 14, 0x01, "reserved" },
98 { 13, 13, 0x01, "remote fault" },
99 { 12, 12, 0x01, "reserved" },
100 { 11, 11, 0x01, "asymmetric pause" },
101 { 10, 10, 0x01, "pause enable" },
102 { 9, 9, 0x01, "100BASE-T4 able" },
103 { 8, 8, 0x01, "100BASE-TX full duplex able" },
104 { 7, 7, 0x01, "100BASE-TX able" },
105 { 6, 6, 0x01, "10BASE-T full duplex able" },
106 { 5, 5, 0x01, "10BASE-T able" },
107 { 4, 0, 0x1f, "xxx to do" },
108};
109
110static const MII_field_desc_t reg_5_desc_tbl[] = {
111 { 15, 15, 0x01, "next page able" },
112 { 14, 14, 0x01, "acknowledge" },
113 { 13, 13, 0x01, "remote fault" },
114 { 12, 12, 0x01, "(reserved)" },
115 { 11, 11, 0x01, "asymmetric pause able" },
116 { 10, 10, 0x01, "pause able" },
117 { 9, 9, 0x01, "100BASE-T4 able" },
118 { 8, 8, 0x01, "100BASE-X full duplex able" },
119 { 7, 7, 0x01, "100BASE-TX able" },
120 { 6, 6, 0x01, "10BASE-T full duplex able" },
121 { 5, 5, 0x01, "10BASE-T able" },
122 { 4, 0, 0x1f, "xxx to do" },
123};
124typedef struct _MII_field_desc_and_len_t {
125 const MII_field_desc_t *pdesc;
126 ushort len;
127} MII_field_desc_and_len_t;
128
129static const MII_field_desc_and_len_t desc_and_len_tbl[] = {
130 { reg_0_desc_tbl, ARRAY_SIZE(reg_0_desc_tbl) },
131 { reg_1_desc_tbl, ARRAY_SIZE(reg_1_desc_tbl) },
132 { reg_2_desc_tbl, ARRAY_SIZE(reg_2_desc_tbl) },
133 { reg_3_desc_tbl, ARRAY_SIZE(reg_3_desc_tbl) },
134 { reg_4_desc_tbl, ARRAY_SIZE(reg_4_desc_tbl) },
135 { reg_5_desc_tbl, ARRAY_SIZE(reg_5_desc_tbl) },
136};
137
138static void dump_reg(
139 ushort regval,
140 const MII_reg_desc_t *prd,
141 const MII_field_desc_and_len_t *pdl);
142
143static int special_field(
144 ushort regno,
145 const MII_field_desc_t *pdesc,
146 ushort regval);
147
148static void MII_dump_0_to_5(
149 ushort regvals[6],
150 uchar reglo,
151 uchar reghi)
152{
153 ulong i;
154
155 for (i = 0; i < 6; i++) {
156 if ((reglo <= i) && (i <= reghi))
157 dump_reg(regvals[i], ®_0_5_desc_tbl[i],
158 &desc_and_len_tbl[i]);
159 }
160}
161
162static void dump_reg(
163 ushort regval,
164 const MII_reg_desc_t *prd,
165 const MII_field_desc_and_len_t *pdl)
166{
167 ulong i;
168 ushort mask_in_place;
169 const MII_field_desc_t *pdesc;
170
171 printf("%u. (%04hx) -- %s --\n",
172 prd->regno, regval, prd->name);
173
174 for (i = 0; i < pdl->len; i++) {
175 pdesc = &pdl->pdesc[i];
176
177 mask_in_place = pdesc->mask << pdesc->lo;
178
179 printf(" (%04hx:%04hx) %u.",
180 mask_in_place,
181 regval & mask_in_place,
182 prd->regno);
183
184 if (special_field(prd->regno, pdesc, regval)) {
185 }
186 else {
187 if (pdesc->hi == pdesc->lo)
188 printf("%2u ", pdesc->lo);
189 else
190 printf("%2u-%2u", pdesc->hi, pdesc->lo);
191 printf(" = %5u %s",
192 (regval & mask_in_place) >> pdesc->lo,
193 pdesc->name);
194 }
195 printf("\n");
196
197 }
198 printf("\n");
199}
200
201
202
203
204
205
206
207
208
209
210static int special_field(
211 ushort regno,
212 const MII_field_desc_t *pdesc,
213 ushort regval)
214{
215 if ((regno == MII_BMCR) && (pdesc->lo == 6)) {
216 ushort speed_bits = regval & (BMCR_SPEED1000 | BMCR_SPEED100);
217 printf("%2u,%2u = b%u%u speed selection = %s Mbps",
218 6, 13,
219 (regval >> 6) & 1,
220 (regval >> 13) & 1,
221 speed_bits == BMCR_SPEED1000 ? "1000" :
222 speed_bits == BMCR_SPEED100 ? "100" :
223 "10");
224 return 1;
225 }
226
227 else if ((regno == MII_BMCR) && (pdesc->lo == 8)) {
228 printf("%2u = %5u duplex = %s",
229 pdesc->lo,
230 (regval >> pdesc->lo) & 1,
231 ((regval >> pdesc->lo) & 1) ? "full" : "half");
232 return 1;
233 }
234
235 else if ((regno == MII_ADVERTISE) && (pdesc->lo == 0)) {
236 ushort sel_bits = (regval >> pdesc->lo) & pdesc->mask;
237 printf("%2u-%2u = %5u selector = %s",
238 pdesc->hi, pdesc->lo, sel_bits,
239 sel_bits == PHY_ANLPAR_PSB_802_3 ?
240 "IEEE 802.3" :
241 sel_bits == PHY_ANLPAR_PSB_802_9 ?
242 "IEEE 802.9 ISLAN-16T" :
243 "???");
244 return 1;
245 }
246
247 else if ((regno == MII_LPA) && (pdesc->lo == 0)) {
248 ushort sel_bits = (regval >> pdesc->lo) & pdesc->mask;
249 printf("%2u-%2u = %u selector = %s",
250 pdesc->hi, pdesc->lo, sel_bits,
251 sel_bits == PHY_ANLPAR_PSB_802_3 ?
252 "IEEE 802.3" :
253 sel_bits == PHY_ANLPAR_PSB_802_9 ?
254 "IEEE 802.9 ISLAN-16T" :
255 "???");
256 return 1;
257 }
258
259 return 0;
260}
261
262static char last_op[2];
263static uint last_data;
264static uint last_addr_lo;
265static uint last_addr_hi;
266static uint last_reg_lo;
267static uint last_reg_hi;
268
269static void extract_range(
270 char * input,
271 unsigned char * plo,
272 unsigned char * phi)
273{
274 char * end;
275 *plo = simple_strtoul(input, &end, 16);
276 if (*end == '-') {
277 end++;
278 *phi = simple_strtoul(end, NULL, 16);
279 }
280 else {
281 *phi = *plo;
282 }
283}
284
285
286static int do_mii(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
287{
288 char op[2];
289 unsigned char addrlo, addrhi, reglo, reghi;
290 unsigned char addr, reg;
291 unsigned short data;
292 int rcode = 0;
293 const char *devname;
294
295 if (argc < 2)
296 return CMD_RET_USAGE;
297
298#if defined(CONFIG_MII_INIT)
299 mii_init ();
300#endif
301
302
303
304
305
306 op[0] = last_op[0];
307 op[1] = last_op[1];
308 addrlo = last_addr_lo;
309 addrhi = last_addr_hi;
310 reglo = last_reg_lo;
311 reghi = last_reg_hi;
312 data = last_data;
313
314 if ((flag & CMD_FLAG_REPEAT) == 0) {
315 op[0] = argv[1][0];
316 if (strlen(argv[1]) > 1)
317 op[1] = argv[1][1];
318 else
319 op[1] = '\0';
320
321 if (argc >= 3)
322 extract_range(argv[2], &addrlo, &addrhi);
323 if (argc >= 4)
324 extract_range(argv[3], ®lo, ®hi);
325 if (argc >= 5)
326 data = simple_strtoul (argv[4], NULL, 16);
327 }
328
329
330 devname = miiphy_get_current_dev();
331
332
333
334
335 if (op[0] == 'i') {
336 unsigned char j, start, end;
337 unsigned int oui;
338 unsigned char model;
339 unsigned char rev;
340
341
342
343
344 if (argc >= 3) {
345 start = addrlo; end = addrhi;
346 } else {
347 start = 0; end = 31;
348 }
349
350 for (j = start; j <= end; j++) {
351 if (miiphy_info (devname, j, &oui, &model, &rev) == 0) {
352 printf("PHY 0x%02X: "
353 "OUI = 0x%04X, "
354 "Model = 0x%02X, "
355 "Rev = 0x%02X, "
356 "%3dbase%s, %s\n",
357 j, oui, model, rev,
358 miiphy_speed (devname, j),
359 miiphy_is_1000base_x (devname, j)
360 ? "X" : "T",
361 (miiphy_duplex (devname, j) == FULL)
362 ? "FDX" : "HDX");
363 }
364 }
365 } else if (op[0] == 'r') {
366 for (addr = addrlo; addr <= addrhi; addr++) {
367 for (reg = reglo; reg <= reghi; reg++) {
368 data = 0xffff;
369 if (miiphy_read (devname, addr, reg, &data) != 0) {
370 printf(
371 "Error reading from the PHY addr=%02x reg=%02x\n",
372 addr, reg);
373 rcode = 1;
374 } else {
375 if ((addrlo != addrhi) || (reglo != reghi))
376 printf("addr=%02x reg=%02x data=",
377 (uint)addr, (uint)reg);
378 printf("%04X\n", data & 0x0000FFFF);
379 }
380 }
381 if ((addrlo != addrhi) && (reglo != reghi))
382 printf("\n");
383 }
384 } else if (op[0] == 'w') {
385 for (addr = addrlo; addr <= addrhi; addr++) {
386 for (reg = reglo; reg <= reghi; reg++) {
387 if (miiphy_write (devname, addr, reg, data) != 0) {
388 printf("Error writing to the PHY addr=%02x reg=%02x\n",
389 addr, reg);
390 rcode = 1;
391 }
392 }
393 }
394 } else if (strncmp(op, "du", 2) == 0) {
395 ushort regs[6];
396 int ok = 1;
397 if ((reglo > 5) || (reghi > 5)) {
398 printf(
399 "The MII dump command only formats the "
400 "standard MII registers, 0-5.\n");
401 return 1;
402 }
403 for (addr = addrlo; addr <= addrhi; addr++) {
404 for (reg = reglo; reg < reghi + 1; reg++) {
405 if (miiphy_read(devname, addr, reg, ®s[reg]) != 0) {
406 ok = 0;
407 printf(
408 "Error reading from the PHY addr=%02x reg=%02x\n",
409 addr, reg);
410 rcode = 1;
411 }
412 }
413 if (ok)
414 MII_dump_0_to_5(regs, reglo, reghi);
415 printf("\n");
416 }
417 } else if (strncmp(op, "de", 2) == 0) {
418 if (argc == 2)
419 miiphy_listdev ();
420 else
421 miiphy_set_current_dev (argv[2]);
422 } else {
423 return CMD_RET_USAGE;
424 }
425
426
427
428
429 last_op[0] = op[0];
430 last_op[1] = op[1];
431 last_addr_lo = addrlo;
432 last_addr_hi = addrhi;
433 last_reg_lo = reglo;
434 last_reg_hi = reghi;
435 last_data = data;
436
437 return rcode;
438}
439
440
441
442U_BOOT_CMD(
443 mii, 5, 1, do_mii,
444 "MII utility commands",
445 "device - list available devices\n"
446 "mii device <devname> - set current device\n"
447 "mii info <addr> - display MII PHY info\n"
448 "mii read <addr> <reg> - read MII PHY <addr> register <reg>\n"
449 "mii write <addr> <reg> <data> - write MII PHY <addr> register <reg>\n"
450 "mii dump <addr> <reg> - pretty-print <addr> <reg> (0-5 only)\n"
451 "Addr and/or reg may be ranges, e.g. 2-7."
452);
453