[people/ms/u-boot.git] / common / cmd_mii.c

/*
 * (C) Copyright 2001
 * Gerald Van Baren, Custom IDEAS, vanbaren@cideas.com
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */

/*
 * 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], &reg_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 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;
	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;

	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], &reglo, &reghi);
		if (argc >= 5)
			data = simple_strtoul (argv[4], NULL, 16);
	}

	/* 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 (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, &regs[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;

	return rcode;
}

/***************************************************/

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