forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
469 lines
12 KiB
469 lines
12 KiB
// SPDX-License-Identifier: GPL-2.0+ |
|
/* |
|
* (C) Copyright 2001 |
|
* Gerald Van Baren, Custom IDEAS, [email protected] |
|
*/ |
|
|
|
/* |
|
* MII Utilities |
|
*/ |
|
|
|
#include <common.h> |
|
#include <command.h> |
|
#include <miiphy.h> |
|
|
|
typedef struct _MII_reg_desc_t { |
|
ushort regno; |
|
char * name; |
|
} MII_reg_desc_t; |
|
|
|
static const MII_reg_desc_t reg_0_5_desc_tbl[] = { |
|
{ MII_BMCR, "PHY control register" }, |
|
{ MII_BMSR, "PHY status register" }, |
|
{ MII_PHYSID1, "PHY ID 1 register" }, |
|
{ MII_PHYSID2, "PHY ID 2 register" }, |
|
{ MII_ADVERTISE, "Autonegotiation advertisement register" }, |
|
{ MII_LPA, "Autonegotiation partner abilities register" }, |
|
}; |
|
|
|
typedef struct _MII_field_desc_t { |
|
ushort hi; |
|
ushort lo; |
|
ushort mask; |
|
char * name; |
|
} MII_field_desc_t; |
|
|
|
static const MII_field_desc_t reg_0_desc_tbl[] = { |
|
{ 15, 15, 0x01, "reset" }, |
|
{ 14, 14, 0x01, "loopback" }, |
|
{ 13, 6, 0x81, "speed selection" }, /* special */ |
|
{ 12, 12, 0x01, "A/N enable" }, |
|
{ 11, 11, 0x01, "power-down" }, |
|
{ 10, 10, 0x01, "isolate" }, |
|
{ 9, 9, 0x01, "restart A/N" }, |
|
{ 8, 8, 0x01, "duplex" }, /* special */ |
|
{ 7, 7, 0x01, "collision test enable" }, |
|
{ 5, 0, 0x3f, "(reserved)" } |
|
}; |
|
|
|
static const MII_field_desc_t reg_1_desc_tbl[] = { |
|
{ 15, 15, 0x01, "100BASE-T4 able" }, |
|
{ 14, 14, 0x01, "100BASE-X full duplex able" }, |
|
{ 13, 13, 0x01, "100BASE-X half duplex able" }, |
|
{ 12, 12, 0x01, "10 Mbps full duplex able" }, |
|
{ 11, 11, 0x01, "10 Mbps half duplex able" }, |
|
{ 10, 10, 0x01, "100BASE-T2 full duplex able" }, |
|
{ 9, 9, 0x01, "100BASE-T2 half duplex able" }, |
|
{ 8, 8, 0x01, "extended status" }, |
|
{ 7, 7, 0x01, "(reserved)" }, |
|
{ 6, 6, 0x01, "MF preamble suppression" }, |
|
{ 5, 5, 0x01, "A/N complete" }, |
|
{ 4, 4, 0x01, "remote fault" }, |
|
{ 3, 3, 0x01, "A/N able" }, |
|
{ 2, 2, 0x01, "link status" }, |
|
{ 1, 1, 0x01, "jabber detect" }, |
|
{ 0, 0, 0x01, "extended capabilities" }, |
|
}; |
|
|
|
static const MII_field_desc_t reg_2_desc_tbl[] = { |
|
{ 15, 0, 0xffff, "OUI portion" }, |
|
}; |
|
|
|
static const MII_field_desc_t reg_3_desc_tbl[] = { |
|
{ 15, 10, 0x3f, "OUI portion" }, |
|
{ 9, 4, 0x3f, "manufacturer part number" }, |
|
{ 3, 0, 0x0f, "manufacturer rev. number" }, |
|
}; |
|
|
|
static const MII_field_desc_t reg_4_desc_tbl[] = { |
|
{ 15, 15, 0x01, "next page able" }, |
|
{ 14, 14, 0x01, "(reserved)" }, |
|
{ 13, 13, 0x01, "remote fault" }, |
|
{ 12, 12, 0x01, "(reserved)" }, |
|
{ 11, 11, 0x01, "asymmetric pause" }, |
|
{ 10, 10, 0x01, "pause enable" }, |
|
{ 9, 9, 0x01, "100BASE-T4 able" }, |
|
{ 8, 8, 0x01, "100BASE-TX full duplex able" }, |
|
{ 7, 7, 0x01, "100BASE-TX able" }, |
|
{ 6, 6, 0x01, "10BASE-T full duplex able" }, |
|
{ 5, 5, 0x01, "10BASE-T able" }, |
|
{ 4, 0, 0x1f, "xxx to do" }, |
|
}; |
|
|
|
static const MII_field_desc_t reg_5_desc_tbl[] = { |
|
{ 15, 15, 0x01, "next page able" }, |
|
{ 14, 14, 0x01, "acknowledge" }, |
|
{ 13, 13, 0x01, "remote fault" }, |
|
{ 12, 12, 0x01, "(reserved)" }, |
|
{ 11, 11, 0x01, "asymmetric pause able" }, |
|
{ 10, 10, 0x01, "pause able" }, |
|
{ 9, 9, 0x01, "100BASE-T4 able" }, |
|
{ 8, 8, 0x01, "100BASE-X full duplex able" }, |
|
{ 7, 7, 0x01, "100BASE-TX able" }, |
|
{ 6, 6, 0x01, "10BASE-T full duplex able" }, |
|
{ 5, 5, 0x01, "10BASE-T able" }, |
|
{ 4, 0, 0x1f, "xxx to do" }, |
|
}; |
|
typedef struct _MII_field_desc_and_len_t { |
|
const MII_field_desc_t *pdesc; |
|
ushort len; |
|
} MII_field_desc_and_len_t; |
|
|
|
static const MII_field_desc_and_len_t desc_and_len_tbl[] = { |
|
{ reg_0_desc_tbl, ARRAY_SIZE(reg_0_desc_tbl) }, |
|
{ reg_1_desc_tbl, ARRAY_SIZE(reg_1_desc_tbl) }, |
|
{ reg_2_desc_tbl, ARRAY_SIZE(reg_2_desc_tbl) }, |
|
{ reg_3_desc_tbl, ARRAY_SIZE(reg_3_desc_tbl) }, |
|
{ reg_4_desc_tbl, ARRAY_SIZE(reg_4_desc_tbl) }, |
|
{ reg_5_desc_tbl, ARRAY_SIZE(reg_5_desc_tbl) }, |
|
}; |
|
|
|
static void dump_reg( |
|
ushort regval, |
|
const MII_reg_desc_t *prd, |
|
const MII_field_desc_and_len_t *pdl); |
|
|
|
static int special_field( |
|
ushort regno, |
|
const MII_field_desc_t *pdesc, |
|
ushort regval); |
|
|
|
static void MII_dump_0_to_5( |
|
ushort regvals[6], |
|
uchar reglo, |
|
uchar reghi) |
|
{ |
|
ulong i; |
|
|
|
for (i = 0; i < 6; i++) { |
|
if ((reglo <= i) && (i <= reghi)) |
|
dump_reg(regvals[i], ®_0_5_desc_tbl[i], |
|
&desc_and_len_tbl[i]); |
|
} |
|
} |
|
|
|
static void dump_reg( |
|
ushort regval, |
|
const MII_reg_desc_t *prd, |
|
const MII_field_desc_and_len_t *pdl) |
|
{ |
|
ulong i; |
|
ushort mask_in_place; |
|
const MII_field_desc_t *pdesc; |
|
|
|
printf("%u. (%04hx) -- %s --\n", |
|
prd->regno, regval, prd->name); |
|
|
|
for (i = 0; i < pdl->len; i++) { |
|
pdesc = &pdl->pdesc[i]; |
|
|
|
mask_in_place = pdesc->mask << pdesc->lo; |
|
|
|
printf(" (%04hx:%04x) %u.", |
|
mask_in_place, |
|
regval & mask_in_place, |
|
prd->regno); |
|
|
|
if (special_field(prd->regno, pdesc, regval)) { |
|
} |
|
else { |
|
if (pdesc->hi == pdesc->lo) |
|
printf("%2u ", pdesc->lo); |
|
else |
|
printf("%2u-%2u", pdesc->hi, pdesc->lo); |
|
printf(" = %5u %s", |
|
(regval & mask_in_place) >> pdesc->lo, |
|
pdesc->name); |
|
} |
|
printf("\n"); |
|
|
|
} |
|
printf("\n"); |
|
} |
|
|
|
/* Special fields: |
|
** 0.6,13 |
|
** 0.8 |
|
** 2.15-0 |
|
** 3.15-0 |
|
** 4.4-0 |
|
** 5.4-0 |
|
*/ |
|
|
|
static int special_field( |
|
ushort regno, |
|
const MII_field_desc_t *pdesc, |
|
ushort regval) |
|
{ |
|
if ((regno == MII_BMCR) && (pdesc->lo == 6)) { |
|
ushort speed_bits = regval & (BMCR_SPEED1000 | BMCR_SPEED100); |
|
printf("%2u,%2u = b%u%u speed selection = %s Mbps", |
|
6, 13, |
|
(regval >> 6) & 1, |
|
(regval >> 13) & 1, |
|
speed_bits == BMCR_SPEED1000 ? "1000" : |
|
speed_bits == BMCR_SPEED100 ? "100" : |
|
"10"); |
|
return 1; |
|
} |
|
|
|
else if ((regno == MII_BMCR) && (pdesc->lo == 8)) { |
|
printf("%2u = %5u duplex = %s", |
|
pdesc->lo, |
|
(regval >> pdesc->lo) & 1, |
|
((regval >> pdesc->lo) & 1) ? "full" : "half"); |
|
return 1; |
|
} |
|
|
|
else if ((regno == MII_ADVERTISE) && (pdesc->lo == 0)) { |
|
ushort sel_bits = (regval >> pdesc->lo) & pdesc->mask; |
|
printf("%2u-%2u = %5u selector = %s", |
|
pdesc->hi, pdesc->lo, sel_bits, |
|
sel_bits == PHY_ANLPAR_PSB_802_3 ? |
|
"IEEE 802.3" : |
|
sel_bits == PHY_ANLPAR_PSB_802_9 ? |
|
"IEEE 802.9 ISLAN-16T" : |
|
"???"); |
|
return 1; |
|
} |
|
|
|
else if ((regno == MII_LPA) && (pdesc->lo == 0)) { |
|
ushort sel_bits = (regval >> pdesc->lo) & pdesc->mask; |
|
printf("%2u-%2u = %u selector = %s", |
|
pdesc->hi, pdesc->lo, sel_bits, |
|
sel_bits == PHY_ANLPAR_PSB_802_3 ? |
|
"IEEE 802.3" : |
|
sel_bits == PHY_ANLPAR_PSB_802_9 ? |
|
"IEEE 802.9 ISLAN-16T" : |
|
"???"); |
|
return 1; |
|
} |
|
|
|
return 0; |
|
} |
|
|
|
static char last_op[2]; |
|
static uint last_data; |
|
static uint last_addr_lo; |
|
static uint last_addr_hi; |
|
static uint last_reg_lo; |
|
static uint last_reg_hi; |
|
static uint last_mask; |
|
|
|
static void extract_range( |
|
char * input, |
|
unsigned char * plo, |
|
unsigned char * phi) |
|
{ |
|
char * end; |
|
*plo = simple_strtoul(input, &end, 16); |
|
if (*end == '-') { |
|
end++; |
|
*phi = simple_strtoul(end, NULL, 16); |
|
} |
|
else { |
|
*phi = *plo; |
|
} |
|
} |
|
|
|
/* ---------------------------------------------------------------- */ |
|
static int do_mii(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) |
|
{ |
|
char op[2]; |
|
unsigned char addrlo, addrhi, reglo, reghi; |
|
unsigned char addr, reg; |
|
unsigned short data, mask; |
|
int rcode = 0; |
|
const char *devname; |
|
|
|
if (argc < 2) |
|
return CMD_RET_USAGE; |
|
|
|
#if defined(CONFIG_MII_INIT) |
|
mii_init (); |
|
#endif |
|
|
|
/* |
|
* We use the last specified parameters, unless new ones are |
|
* entered. |
|
*/ |
|
op[0] = last_op[0]; |
|
op[1] = last_op[1]; |
|
addrlo = last_addr_lo; |
|
addrhi = last_addr_hi; |
|
reglo = last_reg_lo; |
|
reghi = last_reg_hi; |
|
data = last_data; |
|
mask = last_mask; |
|
|
|
if ((flag & CMD_FLAG_REPEAT) == 0) { |
|
op[0] = argv[1][0]; |
|
if (strlen(argv[1]) > 1) |
|
op[1] = argv[1][1]; |
|
else |
|
op[1] = '\0'; |
|
|
|
if (argc >= 3) |
|
extract_range(argv[2], &addrlo, &addrhi); |
|
if (argc >= 4) |
|
extract_range(argv[3], ®lo, ®hi); |
|
if (argc >= 5) |
|
data = simple_strtoul(argv[4], NULL, 16); |
|
if (argc >= 6) |
|
mask = simple_strtoul(argv[5], NULL, 16); |
|
} |
|
|
|
if (addrhi > 31) { |
|
printf("Incorrect PHY address. Range should be 0-31\n"); |
|
return CMD_RET_USAGE; |
|
} |
|
|
|
/* use current device */ |
|
devname = miiphy_get_current_dev(); |
|
|
|
/* |
|
* check info/read/write. |
|
*/ |
|
if (op[0] == 'i') { |
|
unsigned char j, start, end; |
|
unsigned int oui; |
|
unsigned char model; |
|
unsigned char rev; |
|
|
|
/* |
|
* Look for any and all PHYs. Valid addresses are 0..31. |
|
*/ |
|
if (argc >= 3) { |
|
start = addrlo; end = addrhi; |
|
} else { |
|
start = 0; end = 31; |
|
} |
|
|
|
for (j = start; j <= end; j++) { |
|
if (miiphy_info (devname, j, &oui, &model, &rev) == 0) { |
|
printf("PHY 0x%02X: " |
|
"OUI = 0x%04X, " |
|
"Model = 0x%02X, " |
|
"Rev = 0x%02X, " |
|
"%3dbase%s, %s\n", |
|
j, oui, model, rev, |
|
miiphy_speed (devname, j), |
|
miiphy_is_1000base_x (devname, j) |
|
? "X" : "T", |
|
(miiphy_duplex (devname, j) == FULL) |
|
? "FDX" : "HDX"); |
|
} |
|
} |
|
} else if (op[0] == 'r') { |
|
for (addr = addrlo; addr <= addrhi; addr++) { |
|
for (reg = reglo; reg <= reghi; reg++) { |
|
data = 0xffff; |
|
if (miiphy_read (devname, addr, reg, &data) != 0) { |
|
printf( |
|
"Error reading from the PHY addr=%02x reg=%02x\n", |
|
addr, reg); |
|
rcode = 1; |
|
} else { |
|
if ((addrlo != addrhi) || (reglo != reghi)) |
|
printf("addr=%02x reg=%02x data=", |
|
(uint)addr, (uint)reg); |
|
printf("%04X\n", data & 0x0000FFFF); |
|
} |
|
} |
|
if ((addrlo != addrhi) && (reglo != reghi)) |
|
printf("\n"); |
|
} |
|
} else if (op[0] == 'w') { |
|
for (addr = addrlo; addr <= addrhi; addr++) { |
|
for (reg = reglo; reg <= reghi; reg++) { |
|
if (miiphy_write (devname, addr, reg, data) != 0) { |
|
printf("Error writing to the PHY addr=%02x reg=%02x\n", |
|
addr, reg); |
|
rcode = 1; |
|
} |
|
} |
|
} |
|
} else if (op[0] == 'm') { |
|
for (addr = addrlo; addr <= addrhi; addr++) { |
|
for (reg = reglo; reg <= reghi; reg++) { |
|
unsigned short val = 0; |
|
if (miiphy_read(devname, addr, |
|
reg, &val)) { |
|
printf("Error reading from the PHY"); |
|
printf(" addr=%02x", addr); |
|
printf(" reg=%02x\n", reg); |
|
rcode = 1; |
|
} else { |
|
val = (val & ~mask) | (data & mask); |
|
if (miiphy_write(devname, addr, |
|
reg, val)) { |
|
printf("Error writing to the PHY"); |
|
printf(" addr=%02x", addr); |
|
printf(" reg=%02x\n", reg); |
|
rcode = 1; |
|
} |
|
} |
|
} |
|
} |
|
} else if (strncmp(op, "du", 2) == 0) { |
|
ushort regs[6]; |
|
int ok = 1; |
|
if ((reglo > 5) || (reghi > 5)) { |
|
printf( |
|
"The MII dump command only formats the " |
|
"standard MII registers, 0-5.\n"); |
|
return 1; |
|
} |
|
for (addr = addrlo; addr <= addrhi; addr++) { |
|
for (reg = reglo; reg < reghi + 1; reg++) { |
|
if (miiphy_read(devname, addr, reg, ®s[reg]) != 0) { |
|
ok = 0; |
|
printf( |
|
"Error reading from the PHY addr=%02x reg=%02x\n", |
|
addr, reg); |
|
rcode = 1; |
|
} |
|
} |
|
if (ok) |
|
MII_dump_0_to_5(regs, reglo, reghi); |
|
printf("\n"); |
|
} |
|
} else if (strncmp(op, "de", 2) == 0) { |
|
if (argc == 2) |
|
miiphy_listdev (); |
|
else |
|
miiphy_set_current_dev (argv[2]); |
|
} else { |
|
return CMD_RET_USAGE; |
|
} |
|
|
|
/* |
|
* Save the parameters for repeats. |
|
*/ |
|
last_op[0] = op[0]; |
|
last_op[1] = op[1]; |
|
last_addr_lo = addrlo; |
|
last_addr_hi = addrhi; |
|
last_reg_lo = reglo; |
|
last_reg_hi = reghi; |
|
last_data = data; |
|
last_mask = mask; |
|
|
|
return rcode; |
|
} |
|
|
|
/***************************************************/ |
|
|
|
U_BOOT_CMD( |
|
mii, 6, 1, do_mii, |
|
"MII utility commands", |
|
"device - list available devices\n" |
|
"mii device <devname> - set current device\n" |
|
"mii info <addr> - display MII PHY info\n" |
|
"mii read <addr> <reg> - read MII PHY <addr> register <reg>\n" |
|
"mii write <addr> <reg> <data> - write MII PHY <addr> register <reg>\n" |
|
"mii modify <addr> <reg> <data> <mask> - modify MII PHY <addr> register <reg>\n" |
|
" updating bits identified in <mask>\n" |
|
"mii dump <addr> <reg> - pretty-print <addr> <reg> (0-5 only)\n" |
|
"Addr and/or reg may be ranges, e.g. 2-7." |
|
);
|
|
|