uboot/common/cmd_mii.c
<<
>>
Prefs
   1/*
   2 * (C) Copyright 2001
   3 * Gerald Van Baren, Custom IDEAS, vanbaren@cideas.com
   4 *
   5 * SPDX-License-Identifier:     GPL-2.0+
   6 */
   7
   8/*
   9 * MII Utilities
  10 */
  11
  12#include <common.h>
  13#include <command.h>
  14#include <miiphy.h>
  15
  16typedef struct _MII_reg_desc_t {
  17        ushort regno;
  18        char * name;
  19} MII_reg_desc_t;
  20
  21static const MII_reg_desc_t reg_0_5_desc_tbl[] = {
  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" },
  28};
  29
  30typedef struct _MII_field_desc_t {
  31        ushort hi;
  32        ushort lo;
  33        ushort mask;
  34        char * name;
  35} MII_field_desc_t;
  36
  37static const MII_field_desc_t reg_0_desc_tbl[] = {
  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
  50static const MII_field_desc_t reg_1_desc_tbl[] = {
  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
  69static const MII_field_desc_t reg_2_desc_tbl[] = {
  70        { 15,  0, 0xffff, "OUI portion"                },
  71};
  72
  73static const MII_field_desc_t reg_3_desc_tbl[] = {
  74        { 15, 10, 0x3f, "OUI portion"                },
  75        {  9,  4, 0x3f, "manufacturer part number"   },
  76        {  3,  0, 0x0f, "manufacturer rev. number"   },
  77};
  78
  79static const MII_field_desc_t reg_4_desc_tbl[] = {
  80        { 15, 15, 0x01, "next page able"               },
  81        { 14, 14, 0x01, "(reserved)"                   },
  82        { 13, 13, 0x01, "remote fault"                 },
  83        { 12, 12, 0x01, "(reserved)"                   },
  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
  94static const MII_field_desc_t reg_5_desc_tbl[] = {
  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};
 108typedef struct _MII_field_desc_and_len_t {
 109        const MII_field_desc_t *pdesc;
 110        ushort len;
 111} MII_field_desc_and_len_t;
 112
 113static 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)   },
 120};
 121
 122static void dump_reg(
 123        ushort             regval,
 124        const MII_reg_desc_t *prd,
 125        const MII_field_desc_and_len_t *pdl);
 126
 127static int special_field(
 128        ushort regno,
 129        const MII_field_desc_t *pdesc,
 130        ushort regval);
 131
 132static void MII_dump_0_to_5(
 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
 146static void dump_reg(
 147        ushort             regval,
 148        const MII_reg_desc_t *prd,
 149        const MII_field_desc_and_len_t *pdl)
 150{
 151        ulong i;
 152        ushort mask_in_place;
 153        const MII_field_desc_t *pdesc;
 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
 163                printf("  (%04hx:%04x) %u.",
 164                       mask_in_place,
 165                       regval & mask_in_place,
 166                       prd->regno);
 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
 194static int special_field(
 195        ushort regno,
 196        const MII_field_desc_t *pdesc,
 197        ushort regval)
 198{
 199        if ((regno == MII_BMCR) && (pdesc->lo == 6)) {
 200                ushort speed_bits = regval & (BMCR_SPEED1000 | BMCR_SPEED100);
 201                printf("%2u,%2u =   b%u%u    speed selection = %s Mbps",
 202                        6, 13,
 203                        (regval >>  6) & 1,
 204                        (regval >> 13) & 1,
 205                        speed_bits == BMCR_SPEED1000 ? "1000" :
 206                        speed_bits == BMCR_SPEED100  ? "100" :
 207                        "10");
 208                return 1;
 209        }
 210
 211        else if ((regno == MII_BMCR) && (pdesc->lo == 8)) {
 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
 219        else if ((regno == MII_ADVERTISE) && (pdesc->lo == 0)) {
 220                ushort sel_bits = (regval >> pdesc->lo) & pdesc->mask;
 221                printf("%2u-%2u = %5u    selector = %s",
 222                        pdesc->hi, pdesc->lo, sel_bits,
 223                        sel_bits == PHY_ANLPAR_PSB_802_3 ?
 224                                "IEEE 802.3" :
 225                        sel_bits == PHY_ANLPAR_PSB_802_9 ?
 226                                "IEEE 802.9 ISLAN-16T" :
 227                        "???");
 228                return 1;
 229        }
 230
 231        else if ((regno == MII_LPA) && (pdesc->lo == 0)) {
 232                ushort sel_bits = (regval >> pdesc->lo) & pdesc->mask;
 233                printf("%2u-%2u =     %u    selector = %s",
 234                        pdesc->hi, pdesc->lo, sel_bits,
 235                        sel_bits == PHY_ANLPAR_PSB_802_3 ?
 236                                "IEEE 802.3" :
 237                        sel_bits == PHY_ANLPAR_PSB_802_9 ?
 238                                "IEEE 802.9 ISLAN-16T" :
 239                        "???");
 240                return 1;
 241        }
 242
 243        return 0;
 244}
 245
 246static char last_op[2];
 247static uint last_data;
 248static uint last_addr_lo;
 249static uint last_addr_hi;
 250static uint last_reg_lo;
 251static uint last_reg_hi;
 252
 253static 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
 269/* ---------------------------------------------------------------- */
 270static int do_mii(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 271{
 272        char            op[2];
 273        unsigned char   addrlo, addrhi, reglo, reghi;
 274        unsigned char   addr, reg;
 275        unsigned short  data;
 276        int             rcode = 0;
 277        const char      *devname;
 278
 279        if (argc < 2)
 280                return CMD_RET_USAGE;
 281
 282#if defined(CONFIG_MII_INIT)
 283        mii_init ();
 284#endif
 285
 286        /*
 287         * We use the last specified parameters, unless new ones are
 288         * entered.
 289         */
 290        op[0] = last_op[0];
 291        op[1] = last_op[1];
 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) {
 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
 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
 313        /* use current device */
 314        devname = miiphy_get_current_dev();
 315
 316        /*
 317         * check info/read/write.
 318         */
 319        if (op[0] == 'i') {
 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) {
 329                        start = addrlo; end = addrhi;
 330                } else {
 331                        start = 0; end = 31;
 332                }
 333
 334                for (j = start; j <= end; j++) {
 335                        if (miiphy_info (devname, j, &oui, &model, &rev) == 0) {
 336                                printf("PHY 0x%02X: "
 337                                        "OUI = 0x%04X, "
 338                                        "Model = 0x%02X, "
 339                                        "Rev = 0x%02X, "
 340                                        "%3dbase%s, %s\n",
 341                                        j, oui, model, rev,
 342                                        miiphy_speed (devname, j),
 343                                        miiphy_is_1000base_x (devname, j)
 344                                                ? "X" : "T",
 345                                        (miiphy_duplex (devname, j) == FULL)
 346                                                ? "FDX" : "HDX");
 347                        }
 348                }
 349        } else if (op[0] == 'r') {
 350                for (addr = addrlo; addr <= addrhi; addr++) {
 351                        for (reg = reglo; reg <= reghi; reg++) {
 352                                data = 0xffff;
 353                                if (miiphy_read (devname, addr, reg, &data) != 0) {
 354                                        printf(
 355                                        "Error reading from the PHY addr=%02x reg=%02x\n",
 356                                                addr, reg);
 357                                        rcode = 1;
 358                                } else {
 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                }
 368        } else if (op[0] == 'w') {
 369                for (addr = addrlo; addr <= addrhi; addr++) {
 370                        for (reg = reglo; reg <= reghi; reg++) {
 371                                if (miiphy_write (devname, addr, reg, data) != 0) {
 372                                        printf("Error writing to the PHY addr=%02x reg=%02x\n",
 373                                                addr, reg);
 374                                        rcode = 1;
 375                                }
 376                        }
 377                }
 378        } else if (strncmp(op, "du", 2) == 0) {
 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++) {
 388                        for (reg = reglo; reg < reghi + 1; reg++) {
 389                                if (miiphy_read(devname, addr, reg, &regs[reg]) != 0) {
 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                }
 401        } else if (strncmp(op, "de", 2) == 0) {
 402                if (argc == 2)
 403                        miiphy_listdev ();
 404                else
 405                        miiphy_set_current_dev (argv[2]);
 406        } else {
 407                return CMD_RET_USAGE;
 408        }
 409
 410        /*
 411         * Save the parameters for repeats.
 412         */
 413        last_op[0] = op[0];
 414        last_op[1] = op[1];
 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
 426U_BOOT_CMD(
 427        mii,    5,      1,      do_mii,
 428        "MII utility commands",
 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"
 435        "Addr and/or reg may be ranges, e.g. 2-7."
 436);
 437