/*
   * (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 --
  ",
  		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("
  ");
  
  	}
  	printf("
  ");
  }
  
  /* 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], &reglo, &reghi);
  		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
  ");
  		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
  ",

  					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
  ",
  						addr, reg);
  					rcode = 1;

  				} else {

  					if ((addrlo != addrhi) || (reglo != reghi))
  						printf("addr=%02x reg=%02x data=",
  							(uint)addr, (uint)reg);
  					printf("%04X
  ", data & 0x0000FFFF);
  				}
  			}
  			if ((addrlo != addrhi) && (reglo != reghi))
  				printf("
  ");
  		}

  	} 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
  ",
  						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
  ", 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
  ", 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.
  ");
  			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
  ",
  						addr, reg);
  					rcode = 1;
  				}
  			}
  			if (ok)
  				MII_dump_0_to_5(regs, reglo, reghi);
  			printf("
  ");
  		}

  	} 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
  "
  	"mii device <devname>                  - set current device
  "
  	"mii info   <addr>                     - display MII PHY info
  "
  	"mii read   <addr> <reg>               - read  MII PHY <addr> register <reg>
  "
  	"mii write  <addr> <reg> <data>        - write MII PHY <addr> register <reg>
  "
  	"mii modify <addr> <reg> <data> <mask> - modify MII PHY <addr> register <reg>
  "
  	"                                        updating bits identified in <mask>
  "
  	"mii dump   <addr> <reg>               - pretty-print <addr> <reg> (0-5 only)
  "

  	"Addr and/or reg may be ranges, e.g. 2-7."

  );