drivers/net/phy/generic_10g.c

   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
  14 int gen10g_shutdown(struct phy_device *phydev)
  15 {
  16         return 0;
  17 }
  18
  19 int 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
  49 int 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
  75 int 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
  83 struct 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 };