LXR uboot/drivers/net/phy/generic

   1// SPDX-License-Identifier: GPL-2.0+
   2/*
   3 * Generic PHY Management code
   4 *
   5 * Copyright 2011 Freescale Semiconductor, Inc.
   6 * author Andy Fleming
   7 *
   8 * Based loosely off of Linux's PHY Lib
   9 */
  10#include <common.h>
  11#include <miiphy.h>
  12#include <phy.h>
  13
  14int gen10g_shutdown(struct phy_device *phydev)
  15{
  16        return 0;
  17}
  18
  19int gen10g_startup(struct phy_device *phydev)
  20{
  21        int devad, reg;
  22        u32 mmd_mask = phydev->mmds & MDIO_DEVS_LINK;
  23
  24        phydev->link = 1;
  25
  26        /* For now just lie and say it's 10G all the time */
  27        phydev->speed = SPEED_10000;
  28        phydev->duplex = DUPLEX_FULL;
  29
  30        /*
  31         * Go through all the link-reporting devices, and make sure
  32         * they're all up and happy
  33         */
  34        for (devad = 0; mmd_mask; devad++, mmd_mask = mmd_mask >> 1) {
  35                if (!(mmd_mask & 1))
  36                        continue;
  37
  38                /* Read twice because link state is latched and a
  39                 * read moves the current state into the register */
  40                phy_read(phydev, devad, MDIO_STAT1);
  41                reg = phy_read(phydev, devad, MDIO_STAT1);
  42                if (reg < 0 || !(reg & MDIO_STAT1_LSTATUS))
  43                        phydev->link = 0;
  44        }
  45
  46        return 0;
  47}
  48
  49int gen10g_discover_mmds(struct phy_device *phydev)
  50{
  51        int mmd, stat2, devs1, devs2;
  52
  53        /* Assume PHY must have at least one of PMA/PMD, WIS, PCS, PHY
  54         * XS or DTE XS; give up if none is present. */
  55        for (mmd = 1; mmd <= 5; mmd++) {
  56                /* Is this MMD present? */
  57                stat2 = phy_read(phydev, mmd, MDIO_STAT2);
  58                if (stat2 < 0 ||
  59                        (stat2 & MDIO_STAT2_DEVPRST) != MDIO_STAT2_DEVPRST_VAL)
  60                        continue;
  61
  62                /* It should tell us about all the other MMDs */
  63                devs1 = phy_read(phydev, mmd, MDIO_DEVS1);
  64                devs2 = phy_read(phydev, mmd, MDIO_DEVS2);
  65                if (devs1 < 0 || devs2 < 0)
  66                        continue;
  67
  68                phydev->mmds = devs1 | (devs2 << 16);
  69                return 0;
  70        }
  71
  72        return 0;
  73}
  74
  75int gen10g_config(struct phy_device *phydev)
  76{
  77        /* For now, assume 10000baseT. Fill in later */
  78        phydev->supported = phydev->advertising = SUPPORTED_10000baseT_Full;
  79
  80        return gen10g_discover_mmds(phydev);
  81}
  82
  83struct phy_driver gen10g_driver = {
  84        .uid            = 0xffffffff,
  85        .mask           = 0xffffffff,
  86        .name           = "Generic 10G PHY",
  87        .features       = 0,
  88        .config         = gen10g_config,
  89        .startup        = gen10g_startup,
  90        .shutdown       = gen10g_shutdown,
  91};
  92