LCOV - code coverage report
Current view: top level - drivers/net/phy - phy.c (source / functions) Hit Total Coverage
Test: Real Lines: 0 363 0.0 %
Date: 2020-10-17 15:46:16 Functions: 0 39 0.0 %
Legend: Neither, QEMU, Real, Both Branches: 0 0 -

           Branch data     Line data    Source code
       1                 :            : // SPDX-License-Identifier: GPL-2.0+
       2                 :            : /* Framework for configuring and reading PHY devices
       3                 :            :  * Based on code in sungem_phy.c and gianfar_phy.c
       4                 :            :  *
       5                 :            :  * Author: Andy Fleming
       6                 :            :  *
       7                 :            :  * Copyright (c) 2004 Freescale Semiconductor, Inc.
       8                 :            :  * Copyright (c) 2006, 2007  Maciej W. Rozycki
       9                 :            :  */
      10                 :            : 
      11                 :            : #include <linux/kernel.h>
      12                 :            : #include <linux/string.h>
      13                 :            : #include <linux/errno.h>
      14                 :            : #include <linux/unistd.h>
      15                 :            : #include <linux/interrupt.h>
      16                 :            : #include <linux/delay.h>
      17                 :            : #include <linux/netdevice.h>
      18                 :            : #include <linux/etherdevice.h>
      19                 :            : #include <linux/skbuff.h>
      20                 :            : #include <linux/mm.h>
      21                 :            : #include <linux/module.h>
      22                 :            : #include <linux/mii.h>
      23                 :            : #include <linux/ethtool.h>
      24                 :            : #include <linux/phy.h>
      25                 :            : #include <linux/phy_led_triggers.h>
      26                 :            : #include <linux/workqueue.h>
      27                 :            : #include <linux/mdio.h>
      28                 :            : #include <linux/io.h>
      29                 :            : #include <linux/uaccess.h>
      30                 :            : #include <linux/atomic.h>
      31                 :            : 
      32                 :            : #define PHY_STATE_TIME  HZ
      33                 :            : 
      34                 :            : #define PHY_STATE_STR(_state)                   \
      35                 :            :         case PHY_##_state:                      \
      36                 :            :                 return __stringify(_state);     \
      37                 :            : 
      38                 :            : static const char *phy_state_to_str(enum phy_state st)
      39                 :            : {
      40                 :            :         switch (st) {
      41                 :            :         PHY_STATE_STR(DOWN)
      42                 :            :         PHY_STATE_STR(READY)
      43                 :            :         PHY_STATE_STR(UP)
      44                 :            :         PHY_STATE_STR(RUNNING)
      45                 :            :         PHY_STATE_STR(NOLINK)
      46                 :            :         PHY_STATE_STR(HALTED)
      47                 :            :         }
      48                 :            : 
      49                 :            :         return NULL;
      50                 :            : }
      51                 :            : 
      52                 :            : static void phy_link_up(struct phy_device *phydev)
      53                 :            : {
      54                 :          0 :         phydev->phy_link_change(phydev, true, true);
      55                 :            :         phy_led_trigger_change_speed(phydev);
      56                 :            : }
      57                 :            : 
      58                 :            : static void phy_link_down(struct phy_device *phydev, bool do_carrier)
      59                 :            : {
      60                 :          0 :         phydev->phy_link_change(phydev, false, do_carrier);
      61                 :            :         phy_led_trigger_change_speed(phydev);
      62                 :            : }
      63                 :            : 
      64                 :          0 : static const char *phy_pause_str(struct phy_device *phydev)
      65                 :            : {
      66                 :            :         bool local_pause, local_asym_pause;
      67                 :            : 
      68                 :          0 :         if (phydev->autoneg == AUTONEG_DISABLE)
      69                 :            :                 goto no_pause;
      70                 :            : 
      71                 :          0 :         local_pause = linkmode_test_bit(ETHTOOL_LINK_MODE_Pause_BIT,
      72                 :            :                                         phydev->advertising);
      73                 :            :         local_asym_pause = linkmode_test_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT,
      74                 :            :                                              phydev->advertising);
      75                 :            : 
      76                 :          0 :         if (local_pause && phydev->pause)
      77                 :            :                 return "rx/tx";
      78                 :            : 
      79                 :          0 :         if (local_asym_pause && phydev->asym_pause) {
      80                 :          0 :                 if (local_pause)
      81                 :            :                         return "rx";
      82                 :          0 :                 if (phydev->pause)
      83                 :            :                         return "tx";
      84                 :            :         }
      85                 :            : 
      86                 :            : no_pause:
      87                 :            :         return "off";
      88                 :            : }
      89                 :            : 
      90                 :            : /**
      91                 :            :  * phy_print_status - Convenience function to print out the current phy status
      92                 :            :  * @phydev: the phy_device struct
      93                 :            :  */
      94                 :          0 : void phy_print_status(struct phy_device *phydev)
      95                 :            : {
      96                 :          0 :         if (phydev->link) {
      97                 :          0 :                 netdev_info(phydev->attached_dev,
      98                 :            :                         "Link is Up - %s/%s - flow control %s\n",
      99                 :            :                         phy_speed_to_str(phydev->speed),
     100                 :          0 :                         phy_duplex_to_str(phydev->duplex),
     101                 :            :                         phy_pause_str(phydev));
     102                 :            :         } else  {
     103                 :          0 :                 netdev_info(phydev->attached_dev, "Link is Down\n");
     104                 :            :         }
     105                 :          0 : }
     106                 :            : EXPORT_SYMBOL(phy_print_status);
     107                 :            : 
     108                 :            : /**
     109                 :            :  * phy_clear_interrupt - Ack the phy device's interrupt
     110                 :            :  * @phydev: the phy_device struct
     111                 :            :  *
     112                 :            :  * If the @phydev driver has an ack_interrupt function, call it to
     113                 :            :  * ack and clear the phy device's interrupt.
     114                 :            :  *
     115                 :            :  * Returns 0 on success or < 0 on error.
     116                 :            :  */
     117                 :            : static int phy_clear_interrupt(struct phy_device *phydev)
     118                 :            : {
     119                 :          0 :         if (phydev->drv->ack_interrupt)
     120                 :          0 :                 return phydev->drv->ack_interrupt(phydev);
     121                 :            : 
     122                 :            :         return 0;
     123                 :            : }
     124                 :            : 
     125                 :            : /**
     126                 :            :  * phy_config_interrupt - configure the PHY device for the requested interrupts
     127                 :            :  * @phydev: the phy_device struct
     128                 :            :  * @interrupts: interrupt flags to configure for this @phydev
     129                 :            :  *
     130                 :            :  * Returns 0 on success or < 0 on error.
     131                 :            :  */
     132                 :            : static int phy_config_interrupt(struct phy_device *phydev, bool interrupts)
     133                 :            : {
     134                 :          0 :         phydev->interrupts = interrupts ? 1 : 0;
     135                 :          0 :         if (phydev->drv->config_intr)
     136                 :          0 :                 return phydev->drv->config_intr(phydev);
     137                 :            : 
     138                 :            :         return 0;
     139                 :            : }
     140                 :            : 
     141                 :            : /**
     142                 :            :  * phy_restart_aneg - restart auto-negotiation
     143                 :            :  * @phydev: target phy_device struct
     144                 :            :  *
     145                 :            :  * Restart the autonegotiation on @phydev.  Returns >= 0 on success or
     146                 :            :  * negative errno on error.
     147                 :            :  */
     148                 :          0 : int phy_restart_aneg(struct phy_device *phydev)
     149                 :            : {
     150                 :            :         int ret;
     151                 :            : 
     152                 :          0 :         if (phydev->is_c45 && !(phydev->c45_ids.devices_in_package & BIT(0)))
     153                 :          0 :                 ret = genphy_c45_restart_aneg(phydev);
     154                 :            :         else
     155                 :          0 :                 ret = genphy_restart_aneg(phydev);
     156                 :            : 
     157                 :          0 :         return ret;
     158                 :            : }
     159                 :            : EXPORT_SYMBOL_GPL(phy_restart_aneg);
     160                 :            : 
     161                 :            : /**
     162                 :            :  * phy_aneg_done - return auto-negotiation status
     163                 :            :  * @phydev: target phy_device struct
     164                 :            :  *
     165                 :            :  * Description: Return the auto-negotiation status from this @phydev
     166                 :            :  * Returns > 0 on success or < 0 on error. 0 means that auto-negotiation
     167                 :            :  * is still pending.
     168                 :            :  */
     169                 :          0 : int phy_aneg_done(struct phy_device *phydev)
     170                 :            : {
     171                 :          0 :         if (phydev->drv && phydev->drv->aneg_done)
     172                 :          0 :                 return phydev->drv->aneg_done(phydev);
     173                 :          0 :         else if (phydev->is_c45)
     174                 :          0 :                 return genphy_c45_aneg_done(phydev);
     175                 :            :         else
     176                 :          0 :                 return genphy_aneg_done(phydev);
     177                 :            : }
     178                 :            : EXPORT_SYMBOL(phy_aneg_done);
     179                 :            : 
     180                 :            : /**
     181                 :            :  * phy_find_valid - find a PHY setting that matches the requested parameters
     182                 :            :  * @speed: desired speed
     183                 :            :  * @duplex: desired duplex
     184                 :            :  * @supported: mask of supported link modes
     185                 :            :  *
     186                 :            :  * Locate a supported phy setting that is, in priority order:
     187                 :            :  * - an exact match for the specified speed and duplex mode
     188                 :            :  * - a match for the specified speed, or slower speed
     189                 :            :  * - the slowest supported speed
     190                 :            :  * Returns the matched phy_setting entry, or %NULL if no supported phy
     191                 :            :  * settings were found.
     192                 :            :  */
     193                 :            : static const struct phy_setting *
     194                 :            : phy_find_valid(int speed, int duplex, unsigned long *supported)
     195                 :            : {
     196                 :          0 :         return phy_lookup_setting(speed, duplex, supported, false);
     197                 :            : }
     198                 :            : 
     199                 :            : /**
     200                 :            :  * phy_supported_speeds - return all speeds currently supported by a phy device
     201                 :            :  * @phy: The phy device to return supported speeds of.
     202                 :            :  * @speeds: buffer to store supported speeds in.
     203                 :            :  * @size:   size of speeds buffer.
     204                 :            :  *
     205                 :            :  * Description: Returns the number of supported speeds, and fills the speeds
     206                 :            :  * buffer with the supported speeds. If speeds buffer is too small to contain
     207                 :            :  * all currently supported speeds, will return as many speeds as can fit.
     208                 :            :  */
     209                 :          0 : unsigned int phy_supported_speeds(struct phy_device *phy,
     210                 :            :                                   unsigned int *speeds,
     211                 :            :                                   unsigned int size)
     212                 :            : {
     213                 :          0 :         return phy_speeds(speeds, size, phy->supported);
     214                 :            : }
     215                 :            : 
     216                 :            : /**
     217                 :            :  * phy_check_valid - check if there is a valid PHY setting which matches
     218                 :            :  *                   speed, duplex, and feature mask
     219                 :            :  * @speed: speed to match
     220                 :            :  * @duplex: duplex to match
     221                 :            :  * @features: A mask of the valid settings
     222                 :            :  *
     223                 :            :  * Description: Returns true if there is a valid setting, false otherwise.
     224                 :            :  */
     225                 :            : static inline bool phy_check_valid(int speed, int duplex,
     226                 :            :                                    unsigned long *features)
     227                 :            : {
     228                 :          0 :         return !!phy_lookup_setting(speed, duplex, features, true);
     229                 :            : }
     230                 :            : 
     231                 :            : /**
     232                 :            :  * phy_sanitize_settings - make sure the PHY is set to supported speed and duplex
     233                 :            :  * @phydev: the target phy_device struct
     234                 :            :  *
     235                 :            :  * Description: Make sure the PHY is set to supported speeds and
     236                 :            :  *   duplexes.  Drop down by one in this order:  1000/FULL,
     237                 :            :  *   1000/HALF, 100/FULL, 100/HALF, 10/FULL, 10/HALF.
     238                 :            :  */
     239                 :          0 : static void phy_sanitize_settings(struct phy_device *phydev)
     240                 :            : {
     241                 :            :         const struct phy_setting *setting;
     242                 :            : 
     243                 :          0 :         setting = phy_find_valid(phydev->speed, phydev->duplex,
     244                 :          0 :                                  phydev->supported);
     245                 :          0 :         if (setting) {
     246                 :          0 :                 phydev->speed = setting->speed;
     247                 :          0 :                 phydev->duplex = setting->duplex;
     248                 :            :         } else {
     249                 :            :                 /* We failed to find anything (no supported speeds?) */
     250                 :          0 :                 phydev->speed = SPEED_UNKNOWN;
     251                 :          0 :                 phydev->duplex = DUPLEX_UNKNOWN;
     252                 :            :         }
     253                 :          0 : }
     254                 :            : 
     255                 :            : /**
     256                 :            :  * phy_ethtool_sset - generic ethtool sset function, handles all the details
     257                 :            :  * @phydev: target phy_device struct
     258                 :            :  * @cmd: ethtool_cmd
     259                 :            :  *
     260                 :            :  * A few notes about parameter checking:
     261                 :            :  *
     262                 :            :  * - We don't set port or transceiver, so we don't care what they
     263                 :            :  *   were set to.
     264                 :            :  * - phy_start_aneg() will make sure forced settings are sane, and
     265                 :            :  *   choose the next best ones from the ones selected, so we don't
     266                 :            :  *   care if ethtool tries to give us bad values.
     267                 :            :  */
     268                 :          0 : int phy_ethtool_sset(struct phy_device *phydev, struct ethtool_cmd *cmd)
     269                 :            : {
     270                 :            :         __ETHTOOL_DECLARE_LINK_MODE_MASK(advertising);
     271                 :            :         u32 speed = ethtool_cmd_speed(cmd);
     272                 :            : 
     273                 :          0 :         if (cmd->phy_address != phydev->mdio.addr)
     274                 :            :                 return -EINVAL;
     275                 :            : 
     276                 :            :         /* We make sure that we don't pass unsupported values in to the PHY */
     277                 :          0 :         ethtool_convert_legacy_u32_to_link_mode(advertising, cmd->advertising);
     278                 :          0 :         linkmode_and(advertising, advertising, phydev->supported);
     279                 :            : 
     280                 :            :         /* Verify the settings we care about. */
     281                 :          0 :         if (cmd->autoneg != AUTONEG_ENABLE && cmd->autoneg != AUTONEG_DISABLE)
     282                 :            :                 return -EINVAL;
     283                 :            : 
     284                 :          0 :         if (cmd->autoneg == AUTONEG_ENABLE && cmd->advertising == 0)
     285                 :            :                 return -EINVAL;
     286                 :            : 
     287                 :          0 :         if (cmd->autoneg == AUTONEG_DISABLE &&
     288                 :          0 :             ((speed != SPEED_1000 &&
     289                 :          0 :               speed != SPEED_100 &&
     290                 :          0 :               speed != SPEED_10) ||
     291                 :          0 :              (cmd->duplex != DUPLEX_HALF &&
     292                 :            :               cmd->duplex != DUPLEX_FULL)))
     293                 :            :                 return -EINVAL;
     294                 :            : 
     295                 :          0 :         phydev->autoneg = cmd->autoneg;
     296                 :            : 
     297                 :          0 :         phydev->speed = speed;
     298                 :            : 
     299                 :          0 :         linkmode_copy(phydev->advertising, advertising);
     300                 :            : 
     301                 :          0 :         linkmode_mod_bit(ETHTOOL_LINK_MODE_Autoneg_BIT,
     302                 :          0 :                          phydev->advertising, AUTONEG_ENABLE == cmd->autoneg);
     303                 :            : 
     304                 :          0 :         phydev->duplex = cmd->duplex;
     305                 :            : 
     306                 :          0 :         phydev->mdix_ctrl = cmd->eth_tp_mdix_ctrl;
     307                 :            : 
     308                 :            :         /* Restart the PHY */
     309                 :          0 :         phy_start_aneg(phydev);
     310                 :            : 
     311                 :          0 :         return 0;
     312                 :            : }
     313                 :            : EXPORT_SYMBOL(phy_ethtool_sset);
     314                 :            : 
     315                 :          0 : int phy_ethtool_ksettings_set(struct phy_device *phydev,
     316                 :            :                               const struct ethtool_link_ksettings *cmd)
     317                 :            : {
     318                 :            :         __ETHTOOL_DECLARE_LINK_MODE_MASK(advertising);
     319                 :          0 :         u8 autoneg = cmd->base.autoneg;
     320                 :          0 :         u8 duplex = cmd->base.duplex;
     321                 :          0 :         u32 speed = cmd->base.speed;
     322                 :            : 
     323                 :          0 :         if (cmd->base.phy_address != phydev->mdio.addr)
     324                 :            :                 return -EINVAL;
     325                 :            : 
     326                 :          0 :         linkmode_copy(advertising, cmd->link_modes.advertising);
     327                 :            : 
     328                 :            :         /* We make sure that we don't pass unsupported values in to the PHY */
     329                 :          0 :         linkmode_and(advertising, advertising, phydev->supported);
     330                 :            : 
     331                 :            :         /* Verify the settings we care about. */
     332                 :          0 :         if (autoneg != AUTONEG_ENABLE && autoneg != AUTONEG_DISABLE)
     333                 :            :                 return -EINVAL;
     334                 :            : 
     335                 :          0 :         if (autoneg == AUTONEG_ENABLE && linkmode_empty(advertising))
     336                 :            :                 return -EINVAL;
     337                 :            : 
     338                 :          0 :         if (autoneg == AUTONEG_DISABLE &&
     339                 :          0 :             ((speed != SPEED_1000 &&
     340                 :          0 :               speed != SPEED_100 &&
     341                 :          0 :               speed != SPEED_10) ||
     342                 :            :              (duplex != DUPLEX_HALF &&
     343                 :            :               duplex != DUPLEX_FULL)))
     344                 :            :                 return -EINVAL;
     345                 :            : 
     346                 :          0 :         phydev->autoneg = autoneg;
     347                 :            : 
     348                 :          0 :         phydev->speed = speed;
     349                 :            : 
     350                 :          0 :         linkmode_copy(phydev->advertising, advertising);
     351                 :            : 
     352                 :          0 :         linkmode_mod_bit(ETHTOOL_LINK_MODE_Autoneg_BIT,
     353                 :            :                          phydev->advertising, autoneg == AUTONEG_ENABLE);
     354                 :            : 
     355                 :          0 :         phydev->duplex = duplex;
     356                 :            : 
     357                 :          0 :         phydev->mdix_ctrl = cmd->base.eth_tp_mdix_ctrl;
     358                 :            : 
     359                 :            :         /* Restart the PHY */
     360                 :          0 :         phy_start_aneg(phydev);
     361                 :            : 
     362                 :          0 :         return 0;
     363                 :            : }
     364                 :            : EXPORT_SYMBOL(phy_ethtool_ksettings_set);
     365                 :            : 
     366                 :          0 : void phy_ethtool_ksettings_get(struct phy_device *phydev,
     367                 :            :                                struct ethtool_link_ksettings *cmd)
     368                 :            : {
     369                 :          0 :         linkmode_copy(cmd->link_modes.supported, phydev->supported);
     370                 :          0 :         linkmode_copy(cmd->link_modes.advertising, phydev->advertising);
     371                 :          0 :         linkmode_copy(cmd->link_modes.lp_advertising, phydev->lp_advertising);
     372                 :            : 
     373                 :          0 :         cmd->base.speed = phydev->speed;
     374                 :          0 :         cmd->base.duplex = phydev->duplex;
     375                 :          0 :         if (phydev->interface == PHY_INTERFACE_MODE_MOCA)
     376                 :          0 :                 cmd->base.port = PORT_BNC;
     377                 :            :         else
     378                 :          0 :                 cmd->base.port = PORT_MII;
     379                 :          0 :         cmd->base.transceiver = phy_is_internal(phydev) ?
     380                 :            :                                 XCVR_INTERNAL : XCVR_EXTERNAL;
     381                 :          0 :         cmd->base.phy_address = phydev->mdio.addr;
     382                 :          0 :         cmd->base.autoneg = phydev->autoneg;
     383                 :          0 :         cmd->base.eth_tp_mdix_ctrl = phydev->mdix_ctrl;
     384                 :          0 :         cmd->base.eth_tp_mdix = phydev->mdix;
     385                 :          0 : }
     386                 :            : EXPORT_SYMBOL(phy_ethtool_ksettings_get);
     387                 :            : 
     388                 :            : /**
     389                 :            :  * phy_mii_ioctl - generic PHY MII ioctl interface
     390                 :            :  * @phydev: the phy_device struct
     391                 :            :  * @ifr: &struct ifreq for socket ioctl's
     392                 :            :  * @cmd: ioctl cmd to execute
     393                 :            :  *
     394                 :            :  * Note that this function is currently incompatible with the
     395                 :            :  * PHYCONTROL layer.  It changes registers without regard to
     396                 :            :  * current state.  Use at own risk.
     397                 :            :  */
     398                 :          0 : int phy_mii_ioctl(struct phy_device *phydev, struct ifreq *ifr, int cmd)
     399                 :            : {
     400                 :            :         struct mii_ioctl_data *mii_data = if_mii(ifr);
     401                 :          0 :         u16 val = mii_data->val_in;
     402                 :            :         bool change_autoneg = false;
     403                 :            :         int prtad, devad;
     404                 :            : 
     405                 :          0 :         switch (cmd) {
     406                 :            :         case SIOCGMIIPHY:
     407                 :          0 :                 mii_data->phy_id = phydev->mdio.addr;
     408                 :            :                 /* fall through */
     409                 :            : 
     410                 :            :         case SIOCGMIIREG:
     411                 :          0 :                 if (mdio_phy_id_is_c45(mii_data->phy_id)) {
     412                 :          0 :                         prtad = mdio_phy_id_prtad(mii_data->phy_id);
     413                 :          0 :                         devad = mdio_phy_id_devad(mii_data->phy_id);
     414                 :          0 :                         devad = MII_ADDR_C45 | devad << 16 | mii_data->reg_num;
     415                 :            :                 } else {
     416                 :          0 :                         prtad = mii_data->phy_id;
     417                 :          0 :                         devad = mii_data->reg_num;
     418                 :            :                 }
     419                 :          0 :                 mii_data->val_out = mdiobus_read(phydev->mdio.bus, prtad,
     420                 :            :                                                  devad);
     421                 :          0 :                 return 0;
     422                 :            : 
     423                 :            :         case SIOCSMIIREG:
     424                 :          0 :                 if (mdio_phy_id_is_c45(mii_data->phy_id)) {
     425                 :          0 :                         prtad = mdio_phy_id_prtad(mii_data->phy_id);
     426                 :          0 :                         devad = mdio_phy_id_devad(mii_data->phy_id);
     427                 :          0 :                         devad = MII_ADDR_C45 | devad << 16 | mii_data->reg_num;
     428                 :            :                 } else {
     429                 :          0 :                         prtad = mii_data->phy_id;
     430                 :          0 :                         devad = mii_data->reg_num;
     431                 :            :                 }
     432                 :          0 :                 if (prtad == phydev->mdio.addr) {
     433                 :          0 :                         switch (devad) {
     434                 :            :                         case MII_BMCR:
     435                 :          0 :                                 if ((val & (BMCR_RESET | BMCR_ANENABLE)) == 0) {
     436                 :          0 :                                         if (phydev->autoneg == AUTONEG_ENABLE)
     437                 :            :                                                 change_autoneg = true;
     438                 :          0 :                                         phydev->autoneg = AUTONEG_DISABLE;
     439                 :          0 :                                         if (val & BMCR_FULLDPLX)
     440                 :          0 :                                                 phydev->duplex = DUPLEX_FULL;
     441                 :            :                                         else
     442                 :          0 :                                                 phydev->duplex = DUPLEX_HALF;
     443                 :          0 :                                         if (val & BMCR_SPEED1000)
     444                 :          0 :                                                 phydev->speed = SPEED_1000;
     445                 :          0 :                                         else if (val & BMCR_SPEED100)
     446                 :          0 :                                                 phydev->speed = SPEED_100;
     447                 :          0 :                                         else phydev->speed = SPEED_10;
     448                 :            :                                 }
     449                 :            :                                 else {
     450                 :          0 :                                         if (phydev->autoneg == AUTONEG_DISABLE)
     451                 :            :                                                 change_autoneg = true;
     452                 :          0 :                                         phydev->autoneg = AUTONEG_ENABLE;
     453                 :            :                                 }
     454                 :            :                                 break;
     455                 :            :                         case MII_ADVERTISE:
     456                 :          0 :                                 mii_adv_mod_linkmode_adv_t(phydev->advertising,
     457                 :            :                                                            val);
     458                 :            :                                 change_autoneg = true;
     459                 :          0 :                                 break;
     460                 :            :                         case MII_CTRL1000:
     461                 :          0 :                                 mii_ctrl1000_mod_linkmode_adv_t(phydev->advertising,
     462                 :            :                                                                 val);
     463                 :            :                                 change_autoneg = true;
     464                 :          0 :                                 break;
     465                 :            :                         default:
     466                 :            :                                 /* do nothing */
     467                 :            :                                 break;
     468                 :            :                         }
     469                 :            :                 }
     470                 :            : 
     471                 :          0 :                 mdiobus_write(phydev->mdio.bus, prtad, devad, val);
     472                 :            : 
     473                 :          0 :                 if (prtad == phydev->mdio.addr &&
     474                 :          0 :                     devad == MII_BMCR &&
     475                 :            :                     val & BMCR_RESET)
     476                 :          0 :                         return phy_init_hw(phydev);
     477                 :            : 
     478                 :          0 :                 if (change_autoneg)
     479                 :          0 :                         return phy_start_aneg(phydev);
     480                 :            : 
     481                 :            :                 return 0;
     482                 :            : 
     483                 :            :         case SIOCSHWTSTAMP:
     484                 :          0 :                 if (phydev->drv && phydev->drv->hwtstamp)
     485                 :          0 :                         return phydev->drv->hwtstamp(phydev, ifr);
     486                 :            :                 /* fall through */
     487                 :            : 
     488                 :            :         default:
     489                 :            :                 return -EOPNOTSUPP;
     490                 :            :         }
     491                 :            : }
     492                 :            : EXPORT_SYMBOL(phy_mii_ioctl);
     493                 :            : 
     494                 :          0 : void phy_queue_state_machine(struct phy_device *phydev, unsigned long jiffies)
     495                 :            : {
     496                 :          0 :         mod_delayed_work(system_power_efficient_wq, &phydev->state_queue,
     497                 :            :                          jiffies);
     498                 :          0 : }
     499                 :            : EXPORT_SYMBOL(phy_queue_state_machine);
     500                 :            : 
     501                 :            : static void phy_trigger_machine(struct phy_device *phydev)
     502                 :            : {
     503                 :            :         phy_queue_state_machine(phydev, 0);
     504                 :            : }
     505                 :            : 
     506                 :          0 : static int phy_config_aneg(struct phy_device *phydev)
     507                 :            : {
     508                 :          0 :         if (phydev->drv->config_aneg)
     509                 :          0 :                 return phydev->drv->config_aneg(phydev);
     510                 :            : 
     511                 :            :         /* Clause 45 PHYs that don't implement Clause 22 registers are not
     512                 :            :          * allowed to call genphy_config_aneg()
     513                 :            :          */
     514                 :          0 :         if (phydev->is_c45 && !(phydev->c45_ids.devices_in_package & BIT(0)))
     515                 :          0 :                 return genphy_c45_config_aneg(phydev);
     516                 :            : 
     517                 :          0 :         return genphy_config_aneg(phydev);
     518                 :            : }
     519                 :            : 
     520                 :            : /**
     521                 :            :  * phy_check_link_status - check link status and set state accordingly
     522                 :            :  * @phydev: the phy_device struct
     523                 :            :  *
     524                 :            :  * Description: Check for link and whether autoneg was triggered / is running
     525                 :            :  * and set state accordingly
     526                 :            :  */
     527                 :          0 : static int phy_check_link_status(struct phy_device *phydev)
     528                 :            : {
     529                 :            :         int err;
     530                 :            : 
     531                 :          0 :         WARN_ON(!mutex_is_locked(&phydev->lock));
     532                 :            : 
     533                 :            :         /* Keep previous state if loopback is enabled because some PHYs
     534                 :            :          * report that Link is Down when loopback is enabled.
     535                 :            :          */
     536                 :          0 :         if (phydev->loopback_enabled)
     537                 :            :                 return 0;
     538                 :            : 
     539                 :          0 :         err = phy_read_status(phydev);
     540                 :          0 :         if (err)
     541                 :            :                 return err;
     542                 :            : 
     543                 :          0 :         if (phydev->link && phydev->state != PHY_RUNNING) {
     544                 :          0 :                 phydev->state = PHY_RUNNING;
     545                 :            :                 phy_link_up(phydev);
     546                 :          0 :         } else if (!phydev->link && phydev->state != PHY_NOLINK) {
     547                 :          0 :                 phydev->state = PHY_NOLINK;
     548                 :            :                 phy_link_down(phydev, true);
     549                 :            :         }
     550                 :            : 
     551                 :            :         return 0;
     552                 :            : }
     553                 :            : 
     554                 :            : /**
     555                 :            :  * phy_start_aneg - start auto-negotiation for this PHY device
     556                 :            :  * @phydev: the phy_device struct
     557                 :            :  *
     558                 :            :  * Description: Sanitizes the settings (if we're not autonegotiating
     559                 :            :  *   them), and then calls the driver's config_aneg function.
     560                 :            :  *   If the PHYCONTROL Layer is operating, we change the state to
     561                 :            :  *   reflect the beginning of Auto-negotiation or forcing.
     562                 :            :  */
     563                 :          0 : int phy_start_aneg(struct phy_device *phydev)
     564                 :            : {
     565                 :            :         int err;
     566                 :            : 
     567                 :          0 :         if (!phydev->drv)
     568                 :            :                 return -EIO;
     569                 :            : 
     570                 :          0 :         mutex_lock(&phydev->lock);
     571                 :            : 
     572                 :          0 :         if (AUTONEG_DISABLE == phydev->autoneg)
     573                 :          0 :                 phy_sanitize_settings(phydev);
     574                 :            : 
     575                 :          0 :         err = phy_config_aneg(phydev);
     576                 :          0 :         if (err < 0)
     577                 :            :                 goto out_unlock;
     578                 :            : 
     579                 :          0 :         if (phy_is_started(phydev))
     580                 :          0 :                 err = phy_check_link_status(phydev);
     581                 :            : out_unlock:
     582                 :          0 :         mutex_unlock(&phydev->lock);
     583                 :            : 
     584                 :          0 :         return err;
     585                 :            : }
     586                 :            : EXPORT_SYMBOL(phy_start_aneg);
     587                 :            : 
     588                 :          0 : static int phy_poll_aneg_done(struct phy_device *phydev)
     589                 :            : {
     590                 :            :         unsigned int retries = 100;
     591                 :            :         int ret;
     592                 :            : 
     593                 :            :         do {
     594                 :          0 :                 msleep(100);
     595                 :          0 :                 ret = phy_aneg_done(phydev);
     596                 :          0 :         } while (!ret && --retries);
     597                 :            : 
     598                 :          0 :         if (!ret)
     599                 :            :                 return -ETIMEDOUT;
     600                 :            : 
     601                 :          0 :         return ret < 0 ? ret : 0;
     602                 :            : }
     603                 :            : 
     604                 :            : /**
     605                 :            :  * phy_speed_down - set speed to lowest speed supported by both link partners
     606                 :            :  * @phydev: the phy_device struct
     607                 :            :  * @sync: perform action synchronously
     608                 :            :  *
     609                 :            :  * Description: Typically used to save energy when waiting for a WoL packet
     610                 :            :  *
     611                 :            :  * WARNING: Setting sync to false may cause the system being unable to suspend
     612                 :            :  * in case the PHY generates an interrupt when finishing the autonegotiation.
     613                 :            :  * This interrupt may wake up the system immediately after suspend.
     614                 :            :  * Therefore use sync = false only if you're sure it's safe with the respective
     615                 :            :  * network chip.
     616                 :            :  */
     617                 :          0 : int phy_speed_down(struct phy_device *phydev, bool sync)
     618                 :            : {
     619                 :            :         __ETHTOOL_DECLARE_LINK_MODE_MASK(adv_tmp);
     620                 :            :         int ret;
     621                 :            : 
     622                 :          0 :         if (phydev->autoneg != AUTONEG_ENABLE)
     623                 :            :                 return 0;
     624                 :            : 
     625                 :          0 :         linkmode_copy(adv_tmp, phydev->advertising);
     626                 :            : 
     627                 :          0 :         ret = phy_speed_down_core(phydev);
     628                 :          0 :         if (ret)
     629                 :            :                 return ret;
     630                 :            : 
     631                 :          0 :         linkmode_copy(phydev->adv_old, adv_tmp);
     632                 :            : 
     633                 :          0 :         if (linkmode_equal(phydev->advertising, adv_tmp))
     634                 :            :                 return 0;
     635                 :            : 
     636                 :          0 :         ret = phy_config_aneg(phydev);
     637                 :          0 :         if (ret)
     638                 :            :                 return ret;
     639                 :            : 
     640                 :          0 :         return sync ? phy_poll_aneg_done(phydev) : 0;
     641                 :            : }
     642                 :            : EXPORT_SYMBOL_GPL(phy_speed_down);
     643                 :            : 
     644                 :            : /**
     645                 :            :  * phy_speed_up - (re)set advertised speeds to all supported speeds
     646                 :            :  * @phydev: the phy_device struct
     647                 :            :  *
     648                 :            :  * Description: Used to revert the effect of phy_speed_down
     649                 :            :  */
     650                 :          0 : int phy_speed_up(struct phy_device *phydev)
     651                 :            : {
     652                 :            :         __ETHTOOL_DECLARE_LINK_MODE_MASK(adv_tmp);
     653                 :            : 
     654                 :          0 :         if (phydev->autoneg != AUTONEG_ENABLE)
     655                 :            :                 return 0;
     656                 :            : 
     657                 :          0 :         if (linkmode_empty(phydev->adv_old))
     658                 :            :                 return 0;
     659                 :            : 
     660                 :          0 :         linkmode_copy(adv_tmp, phydev->advertising);
     661                 :            :         linkmode_copy(phydev->advertising, phydev->adv_old);
     662                 :            :         linkmode_zero(phydev->adv_old);
     663                 :            : 
     664                 :          0 :         if (linkmode_equal(phydev->advertising, adv_tmp))
     665                 :            :                 return 0;
     666                 :            : 
     667                 :          0 :         return phy_config_aneg(phydev);
     668                 :            : }
     669                 :            : EXPORT_SYMBOL_GPL(phy_speed_up);
     670                 :            : 
     671                 :            : /**
     672                 :            :  * phy_start_machine - start PHY state machine tracking
     673                 :            :  * @phydev: the phy_device struct
     674                 :            :  *
     675                 :            :  * Description: The PHY infrastructure can run a state machine
     676                 :            :  *   which tracks whether the PHY is starting up, negotiating,
     677                 :            :  *   etc.  This function starts the delayed workqueue which tracks
     678                 :            :  *   the state of the PHY. If you want to maintain your own state machine,
     679                 :            :  *   do not call this function.
     680                 :            :  */
     681                 :          0 : void phy_start_machine(struct phy_device *phydev)
     682                 :            : {
     683                 :            :         phy_trigger_machine(phydev);
     684                 :          0 : }
     685                 :            : EXPORT_SYMBOL_GPL(phy_start_machine);
     686                 :            : 
     687                 :            : /**
     688                 :            :  * phy_stop_machine - stop the PHY state machine tracking
     689                 :            :  * @phydev: target phy_device struct
     690                 :            :  *
     691                 :            :  * Description: Stops the state machine delayed workqueue, sets the
     692                 :            :  *   state to UP (unless it wasn't up yet). This function must be
     693                 :            :  *   called BEFORE phy_detach.
     694                 :            :  */
     695                 :          0 : void phy_stop_machine(struct phy_device *phydev)
     696                 :            : {
     697                 :          0 :         cancel_delayed_work_sync(&phydev->state_queue);
     698                 :            : 
     699                 :          0 :         mutex_lock(&phydev->lock);
     700                 :          0 :         if (phy_is_started(phydev))
     701                 :          0 :                 phydev->state = PHY_UP;
     702                 :          0 :         mutex_unlock(&phydev->lock);
     703                 :          0 : }
     704                 :            : 
     705                 :            : /**
     706                 :            :  * phy_error - enter HALTED state for this PHY device
     707                 :            :  * @phydev: target phy_device struct
     708                 :            :  *
     709                 :            :  * Moves the PHY to the HALTED state in response to a read
     710                 :            :  * or write error, and tells the controller the link is down.
     711                 :            :  * Must not be called from interrupt context, or while the
     712                 :            :  * phydev->lock is held.
     713                 :            :  */
     714                 :          0 : static void phy_error(struct phy_device *phydev)
     715                 :            : {
     716                 :          0 :         WARN_ON(1);
     717                 :            : 
     718                 :          0 :         mutex_lock(&phydev->lock);
     719                 :          0 :         phydev->state = PHY_HALTED;
     720                 :          0 :         mutex_unlock(&phydev->lock);
     721                 :            : 
     722                 :            :         phy_trigger_machine(phydev);
     723                 :          0 : }
     724                 :            : 
     725                 :            : /**
     726                 :            :  * phy_disable_interrupts - Disable the PHY interrupts from the PHY side
     727                 :            :  * @phydev: target phy_device struct
     728                 :            :  */
     729                 :          0 : static int phy_disable_interrupts(struct phy_device *phydev)
     730                 :            : {
     731                 :            :         int err;
     732                 :            : 
     733                 :            :         /* Disable PHY interrupts */
     734                 :            :         err = phy_config_interrupt(phydev, PHY_INTERRUPT_DISABLED);
     735                 :          0 :         if (err)
     736                 :            :                 return err;
     737                 :            : 
     738                 :            :         /* Clear the interrupt */
     739                 :          0 :         return phy_clear_interrupt(phydev);
     740                 :            : }
     741                 :            : 
     742                 :            : /**
     743                 :            :  * phy_interrupt - PHY interrupt handler
     744                 :            :  * @irq: interrupt line
     745                 :            :  * @phy_dat: phy_device pointer
     746                 :            :  *
     747                 :            :  * Description: Handle PHY interrupt
     748                 :            :  */
     749                 :          0 : static irqreturn_t phy_interrupt(int irq, void *phy_dat)
     750                 :            : {
     751                 :            :         struct phy_device *phydev = phy_dat;
     752                 :            : 
     753                 :          0 :         if (phydev->drv->did_interrupt && !phydev->drv->did_interrupt(phydev))
     754                 :            :                 return IRQ_NONE;
     755                 :            : 
     756                 :          0 :         if (phydev->drv->handle_interrupt) {
     757                 :          0 :                 if (phydev->drv->handle_interrupt(phydev))
     758                 :            :                         goto phy_err;
     759                 :            :         } else {
     760                 :            :                 /* reschedule state queue work to run as soon as possible */
     761                 :            :                 phy_trigger_machine(phydev);
     762                 :            :         }
     763                 :            : 
     764                 :            :         /* did_interrupt() may have cleared the interrupt already */
     765                 :          0 :         if (!phydev->drv->did_interrupt && phy_clear_interrupt(phydev))
     766                 :            :                 goto phy_err;
     767                 :            :         return IRQ_HANDLED;
     768                 :            : 
     769                 :            : phy_err:
     770                 :          0 :         phy_error(phydev);
     771                 :          0 :         return IRQ_NONE;
     772                 :            : }
     773                 :            : 
     774                 :            : /**
     775                 :            :  * phy_enable_interrupts - Enable the interrupts from the PHY side
     776                 :            :  * @phydev: target phy_device struct
     777                 :            :  */
     778                 :          0 : static int phy_enable_interrupts(struct phy_device *phydev)
     779                 :            : {
     780                 :            :         int err = phy_clear_interrupt(phydev);
     781                 :            : 
     782                 :          0 :         if (err < 0)
     783                 :            :                 return err;
     784                 :            : 
     785                 :          0 :         return phy_config_interrupt(phydev, PHY_INTERRUPT_ENABLED);
     786                 :            : }
     787                 :            : 
     788                 :            : /**
     789                 :            :  * phy_request_interrupt - request and enable interrupt for a PHY device
     790                 :            :  * @phydev: target phy_device struct
     791                 :            :  *
     792                 :            :  * Description: Request and enable the interrupt for the given PHY.
     793                 :            :  *   If this fails, then we set irq to PHY_POLL.
     794                 :            :  *   This should only be called with a valid IRQ number.
     795                 :            :  */
     796                 :          0 : void phy_request_interrupt(struct phy_device *phydev)
     797                 :            : {
     798                 :            :         int err;
     799                 :            : 
     800                 :          0 :         err = request_threaded_irq(phydev->irq, NULL, phy_interrupt,
     801                 :            :                                    IRQF_ONESHOT | IRQF_SHARED,
     802                 :            :                                    phydev_name(phydev), phydev);
     803                 :          0 :         if (err) {
     804                 :          0 :                 phydev_warn(phydev, "Error %d requesting IRQ %d, falling back to polling\n",
     805                 :            :                             err, phydev->irq);
     806                 :          0 :                 phydev->irq = PHY_POLL;
     807                 :            :         } else {
     808                 :          0 :                 if (phy_enable_interrupts(phydev)) {
     809                 :          0 :                         phydev_warn(phydev, "Can't enable interrupt, falling back to polling\n");
     810                 :          0 :                         phy_free_interrupt(phydev);
     811                 :          0 :                         phydev->irq = PHY_POLL;
     812                 :            :                 }
     813                 :            :         }
     814                 :          0 : }
     815                 :            : EXPORT_SYMBOL(phy_request_interrupt);
     816                 :            : 
     817                 :            : /**
     818                 :            :  * phy_free_interrupt - disable and free interrupt for a PHY device
     819                 :            :  * @phydev: target phy_device struct
     820                 :            :  *
     821                 :            :  * Description: Disable and free the interrupt for the given PHY.
     822                 :            :  *   This should only be called with a valid IRQ number.
     823                 :            :  */
     824                 :          0 : void phy_free_interrupt(struct phy_device *phydev)
     825                 :            : {
     826                 :          0 :         phy_disable_interrupts(phydev);
     827                 :          0 :         free_irq(phydev->irq, phydev);
     828                 :          0 : }
     829                 :            : EXPORT_SYMBOL(phy_free_interrupt);
     830                 :            : 
     831                 :            : /**
     832                 :            :  * phy_stop - Bring down the PHY link, and stop checking the status
     833                 :            :  * @phydev: target phy_device struct
     834                 :            :  */
     835                 :          0 : void phy_stop(struct phy_device *phydev)
     836                 :            : {
     837                 :          0 :         if (!phy_is_started(phydev)) {
     838                 :          0 :                 WARN(1, "called from state %s\n",
     839                 :            :                      phy_state_to_str(phydev->state));
     840                 :          0 :                 return;
     841                 :            :         }
     842                 :            : 
     843                 :          0 :         mutex_lock(&phydev->lock);
     844                 :            : 
     845                 :          0 :         phydev->state = PHY_HALTED;
     846                 :            : 
     847                 :          0 :         mutex_unlock(&phydev->lock);
     848                 :            : 
     849                 :          0 :         phy_state_machine(&phydev->state_queue.work);
     850                 :          0 :         phy_stop_machine(phydev);
     851                 :            : 
     852                 :            :         /* Cannot call flush_scheduled_work() here as desired because
     853                 :            :          * of rtnl_lock(), but PHY_HALTED shall guarantee irq handler
     854                 :            :          * will not reenable interrupts.
     855                 :            :          */
     856                 :            : }
     857                 :            : EXPORT_SYMBOL(phy_stop);
     858                 :            : 
     859                 :            : /**
     860                 :            :  * phy_start - start or restart a PHY device
     861                 :            :  * @phydev: target phy_device struct
     862                 :            :  *
     863                 :            :  * Description: Indicates the attached device's readiness to
     864                 :            :  *   handle PHY-related work.  Used during startup to start the
     865                 :            :  *   PHY, and after a call to phy_stop() to resume operation.
     866                 :            :  *   Also used to indicate the MDIO bus has cleared an error
     867                 :            :  *   condition.
     868                 :            :  */
     869                 :          0 : void phy_start(struct phy_device *phydev)
     870                 :            : {
     871                 :          0 :         mutex_lock(&phydev->lock);
     872                 :            : 
     873                 :          0 :         if (phydev->state != PHY_READY && phydev->state != PHY_HALTED) {
     874                 :          0 :                 WARN(1, "called from state %s\n",
     875                 :            :                      phy_state_to_str(phydev->state));
     876                 :          0 :                 goto out;
     877                 :            :         }
     878                 :            : 
     879                 :            :         /* if phy was suspended, bring the physical link up again */
     880                 :          0 :         __phy_resume(phydev);
     881                 :            : 
     882                 :          0 :         phydev->state = PHY_UP;
     883                 :            : 
     884                 :            :         phy_start_machine(phydev);
     885                 :            : out:
     886                 :          0 :         mutex_unlock(&phydev->lock);
     887                 :          0 : }
     888                 :            : EXPORT_SYMBOL(phy_start);
     889                 :            : 
     890                 :            : /**
     891                 :            :  * phy_state_machine - Handle the state machine
     892                 :            :  * @work: work_struct that describes the work to be done
     893                 :            :  */
     894                 :          0 : void phy_state_machine(struct work_struct *work)
     895                 :            : {
     896                 :            :         struct delayed_work *dwork = to_delayed_work(work);
     897                 :            :         struct phy_device *phydev =
     898                 :          0 :                         container_of(dwork, struct phy_device, state_queue);
     899                 :            :         bool needs_aneg = false, do_suspend = false;
     900                 :            :         enum phy_state old_state;
     901                 :            :         int err = 0;
     902                 :            : 
     903                 :          0 :         mutex_lock(&phydev->lock);
     904                 :            : 
     905                 :          0 :         old_state = phydev->state;
     906                 :            : 
     907                 :          0 :         switch (phydev->state) {
     908                 :            :         case PHY_DOWN:
     909                 :            :         case PHY_READY:
     910                 :            :                 break;
     911                 :            :         case PHY_UP:
     912                 :            :                 needs_aneg = true;
     913                 :            : 
     914                 :          0 :                 break;
     915                 :            :         case PHY_NOLINK:
     916                 :            :         case PHY_RUNNING:
     917                 :          0 :                 err = phy_check_link_status(phydev);
     918                 :          0 :                 break;
     919                 :            :         case PHY_HALTED:
     920                 :          0 :                 if (phydev->link) {
     921                 :          0 :                         phydev->link = 0;
     922                 :            :                         phy_link_down(phydev, true);
     923                 :            :                 }
     924                 :            :                 do_suspend = true;
     925                 :            :                 break;
     926                 :            :         }
     927                 :            : 
     928                 :          0 :         mutex_unlock(&phydev->lock);
     929                 :            : 
     930                 :          0 :         if (needs_aneg)
     931                 :          0 :                 err = phy_start_aneg(phydev);
     932                 :          0 :         else if (do_suspend)
     933                 :          0 :                 phy_suspend(phydev);
     934                 :            : 
     935                 :          0 :         if (err < 0)
     936                 :          0 :                 phy_error(phydev);
     937                 :            : 
     938                 :          0 :         if (old_state != phydev->state) {
     939                 :            :                 phydev_dbg(phydev, "PHY state change %s -> %s\n",
     940                 :            :                            phy_state_to_str(old_state),
     941                 :            :                            phy_state_to_str(phydev->state));
     942                 :          0 :                 if (phydev->drv && phydev->drv->link_change_notify)
     943                 :          0 :                         phydev->drv->link_change_notify(phydev);
     944                 :            :         }
     945                 :            : 
     946                 :            :         /* Only re-schedule a PHY state machine change if we are polling the
     947                 :            :          * PHY, if PHY_IGNORE_INTERRUPT is set, then we will be moving
     948                 :            :          * between states from phy_mac_interrupt().
     949                 :            :          *
     950                 :            :          * In state PHY_HALTED the PHY gets suspended, so rescheduling the
     951                 :            :          * state machine would be pointless and possibly error prone when
     952                 :            :          * called from phy_disconnect() synchronously.
     953                 :            :          */
     954                 :          0 :         mutex_lock(&phydev->lock);
     955                 :          0 :         if (phy_polling_mode(phydev) && phy_is_started(phydev))
     956                 :            :                 phy_queue_state_machine(phydev, PHY_STATE_TIME);
     957                 :          0 :         mutex_unlock(&phydev->lock);
     958                 :          0 : }
     959                 :            : 
     960                 :            : /**
     961                 :            :  * phy_mac_interrupt - MAC says the link has changed
     962                 :            :  * @phydev: phy_device struct with changed link
     963                 :            :  *
     964                 :            :  * The MAC layer is able to indicate there has been a change in the PHY link
     965                 :            :  * status. Trigger the state machine and work a work queue.
     966                 :            :  */
     967                 :          0 : void phy_mac_interrupt(struct phy_device *phydev)
     968                 :            : {
     969                 :            :         /* Trigger a state machine change */
     970                 :            :         phy_trigger_machine(phydev);
     971                 :          0 : }
     972                 :            : EXPORT_SYMBOL(phy_mac_interrupt);
     973                 :            : 
     974                 :          0 : static void mmd_eee_adv_to_linkmode(unsigned long *advertising, u16 eee_adv)
     975                 :            : {
     976                 :            :         linkmode_zero(advertising);
     977                 :            : 
     978                 :          0 :         if (eee_adv & MDIO_EEE_100TX)
     979                 :            :                 linkmode_set_bit(ETHTOOL_LINK_MODE_100baseT_Full_BIT,
     980                 :            :                                  advertising);
     981                 :          0 :         if (eee_adv & MDIO_EEE_1000T)
     982                 :            :                 linkmode_set_bit(ETHTOOL_LINK_MODE_1000baseT_Full_BIT,
     983                 :            :                                  advertising);
     984                 :          0 :         if (eee_adv & MDIO_EEE_10GT)
     985                 :            :                 linkmode_set_bit(ETHTOOL_LINK_MODE_10000baseT_Full_BIT,
     986                 :            :                                  advertising);
     987                 :          0 :         if (eee_adv & MDIO_EEE_1000KX)
     988                 :            :                 linkmode_set_bit(ETHTOOL_LINK_MODE_1000baseKX_Full_BIT,
     989                 :            :                                  advertising);
     990                 :          0 :         if (eee_adv & MDIO_EEE_10GKX4)
     991                 :            :                 linkmode_set_bit(ETHTOOL_LINK_MODE_10000baseKX4_Full_BIT,
     992                 :            :                                  advertising);
     993                 :          0 :         if (eee_adv & MDIO_EEE_10GKR)
     994                 :            :                 linkmode_set_bit(ETHTOOL_LINK_MODE_10000baseKR_Full_BIT,
     995                 :            :                                  advertising);
     996                 :          0 : }
     997                 :            : 
     998                 :            : /**
     999                 :            :  * phy_init_eee - init and check the EEE feature
    1000                 :            :  * @phydev: target phy_device struct
    1001                 :            :  * @clk_stop_enable: PHY may stop the clock during LPI
    1002                 :            :  *
    1003                 :            :  * Description: it checks if the Energy-Efficient Ethernet (EEE)
    1004                 :            :  * is supported by looking at the MMD registers 3.20 and 7.60/61
    1005                 :            :  * and it programs the MMD register 3.0 setting the "Clock stop enable"
    1006                 :            :  * bit if required.
    1007                 :            :  */
    1008                 :          0 : int phy_init_eee(struct phy_device *phydev, bool clk_stop_enable)
    1009                 :            : {
    1010                 :          0 :         if (!phydev->drv)
    1011                 :            :                 return -EIO;
    1012                 :            : 
    1013                 :            :         /* According to 802.3az,the EEE is supported only in full duplex-mode.
    1014                 :            :          */
    1015                 :          0 :         if (phydev->duplex == DUPLEX_FULL) {
    1016                 :            :                 __ETHTOOL_DECLARE_LINK_MODE_MASK(common);
    1017                 :            :                 __ETHTOOL_DECLARE_LINK_MODE_MASK(lp);
    1018                 :            :                 __ETHTOOL_DECLARE_LINK_MODE_MASK(adv);
    1019                 :            :                 int eee_lp, eee_cap, eee_adv;
    1020                 :            :                 int status;
    1021                 :            :                 u32 cap;
    1022                 :            : 
    1023                 :            :                 /* Read phy status to properly get the right settings */
    1024                 :          0 :                 status = phy_read_status(phydev);
    1025                 :          0 :                 if (status)
    1026                 :          0 :                         return status;
    1027                 :            : 
    1028                 :            :                 /* First check if the EEE ability is supported */
    1029                 :          0 :                 eee_cap = phy_read_mmd(phydev, MDIO_MMD_PCS, MDIO_PCS_EEE_ABLE);
    1030                 :          0 :                 if (eee_cap <= 0)
    1031                 :            :                         goto eee_exit_err;
    1032                 :            : 
    1033                 :          0 :                 cap = mmd_eee_cap_to_ethtool_sup_t(eee_cap);
    1034                 :          0 :                 if (!cap)
    1035                 :            :                         goto eee_exit_err;
    1036                 :            : 
    1037                 :            :                 /* Check which link settings negotiated and verify it in
    1038                 :            :                  * the EEE advertising registers.
    1039                 :            :                  */
    1040                 :          0 :                 eee_lp = phy_read_mmd(phydev, MDIO_MMD_AN, MDIO_AN_EEE_LPABLE);
    1041                 :          0 :                 if (eee_lp <= 0)
    1042                 :            :                         goto eee_exit_err;
    1043                 :            : 
    1044                 :          0 :                 eee_adv = phy_read_mmd(phydev, MDIO_MMD_AN, MDIO_AN_EEE_ADV);
    1045                 :          0 :                 if (eee_adv <= 0)
    1046                 :            :                         goto eee_exit_err;
    1047                 :            : 
    1048                 :          0 :                 mmd_eee_adv_to_linkmode(adv, eee_adv);
    1049                 :          0 :                 mmd_eee_adv_to_linkmode(lp, eee_lp);
    1050                 :            :                 linkmode_and(common, adv, lp);
    1051                 :            : 
    1052                 :          0 :                 if (!phy_check_valid(phydev->speed, phydev->duplex, common))
    1053                 :            :                         goto eee_exit_err;
    1054                 :            : 
    1055                 :          0 :                 if (clk_stop_enable)
    1056                 :            :                         /* Configure the PHY to stop receiving xMII
    1057                 :            :                          * clock while it is signaling LPI.
    1058                 :            :                          */
    1059                 :            :                         phy_set_bits_mmd(phydev, MDIO_MMD_PCS, MDIO_CTRL1,
    1060                 :            :                                          MDIO_PCS_CTRL1_CLKSTOP_EN);
    1061                 :            : 
    1062                 :            :                 return 0; /* EEE supported */
    1063                 :            :         }
    1064                 :            : eee_exit_err:
    1065                 :            :         return -EPROTONOSUPPORT;
    1066                 :            : }
    1067                 :            : EXPORT_SYMBOL(phy_init_eee);
    1068                 :            : 
    1069                 :            : /**
    1070                 :            :  * phy_get_eee_err - report the EEE wake error count
    1071                 :            :  * @phydev: target phy_device struct
    1072                 :            :  *
    1073                 :            :  * Description: it is to report the number of time where the PHY
    1074                 :            :  * failed to complete its normal wake sequence.
    1075                 :            :  */
    1076                 :          0 : int phy_get_eee_err(struct phy_device *phydev)
    1077                 :            : {
    1078                 :          0 :         if (!phydev->drv)
    1079                 :            :                 return -EIO;
    1080                 :            : 
    1081                 :          0 :         return phy_read_mmd(phydev, MDIO_MMD_PCS, MDIO_PCS_EEE_WK_ERR);
    1082                 :            : }
    1083                 :            : EXPORT_SYMBOL(phy_get_eee_err);
    1084                 :            : 
    1085                 :            : /**
    1086                 :            :  * phy_ethtool_get_eee - get EEE supported and status
    1087                 :            :  * @phydev: target phy_device struct
    1088                 :            :  * @data: ethtool_eee data
    1089                 :            :  *
    1090                 :            :  * Description: it reportes the Supported/Advertisement/LP Advertisement
    1091                 :            :  * capabilities.
    1092                 :            :  */
    1093                 :          0 : int phy_ethtool_get_eee(struct phy_device *phydev, struct ethtool_eee *data)
    1094                 :            : {
    1095                 :            :         int val;
    1096                 :            : 
    1097                 :          0 :         if (!phydev->drv)
    1098                 :            :                 return -EIO;
    1099                 :            : 
    1100                 :            :         /* Get Supported EEE */
    1101                 :          0 :         val = phy_read_mmd(phydev, MDIO_MMD_PCS, MDIO_PCS_EEE_ABLE);
    1102                 :          0 :         if (val < 0)
    1103                 :            :                 return val;
    1104                 :          0 :         data->supported = mmd_eee_cap_to_ethtool_sup_t(val);
    1105                 :            : 
    1106                 :            :         /* Get advertisement EEE */
    1107                 :          0 :         val = phy_read_mmd(phydev, MDIO_MMD_AN, MDIO_AN_EEE_ADV);
    1108                 :          0 :         if (val < 0)
    1109                 :            :                 return val;
    1110                 :          0 :         data->advertised = mmd_eee_adv_to_ethtool_adv_t(val);
    1111                 :          0 :         data->eee_enabled = !!data->advertised;
    1112                 :            : 
    1113                 :            :         /* Get LP advertisement EEE */
    1114                 :          0 :         val = phy_read_mmd(phydev, MDIO_MMD_AN, MDIO_AN_EEE_LPABLE);
    1115                 :          0 :         if (val < 0)
    1116                 :            :                 return val;
    1117                 :          0 :         data->lp_advertised = mmd_eee_adv_to_ethtool_adv_t(val);
    1118                 :            : 
    1119                 :          0 :         data->eee_active = !!(data->advertised & data->lp_advertised);
    1120                 :            : 
    1121                 :          0 :         return 0;
    1122                 :            : }
    1123                 :            : EXPORT_SYMBOL(phy_ethtool_get_eee);
    1124                 :            : 
    1125                 :            : /**
    1126                 :            :  * phy_ethtool_set_eee - set EEE supported and status
    1127                 :            :  * @phydev: target phy_device struct
    1128                 :            :  * @data: ethtool_eee data
    1129                 :            :  *
    1130                 :            :  * Description: it is to program the Advertisement EEE register.
    1131                 :            :  */
    1132                 :          0 : int phy_ethtool_set_eee(struct phy_device *phydev, struct ethtool_eee *data)
    1133                 :            : {
    1134                 :            :         int cap, old_adv, adv = 0, ret;
    1135                 :            : 
    1136                 :          0 :         if (!phydev->drv)
    1137                 :            :                 return -EIO;
    1138                 :            : 
    1139                 :            :         /* Get Supported EEE */
    1140                 :          0 :         cap = phy_read_mmd(phydev, MDIO_MMD_PCS, MDIO_PCS_EEE_ABLE);
    1141                 :          0 :         if (cap < 0)
    1142                 :            :                 return cap;
    1143                 :            : 
    1144                 :          0 :         old_adv = phy_read_mmd(phydev, MDIO_MMD_AN, MDIO_AN_EEE_ADV);
    1145                 :          0 :         if (old_adv < 0)
    1146                 :            :                 return old_adv;
    1147                 :            : 
    1148                 :          0 :         if (data->eee_enabled) {
    1149                 :          0 :                 adv = !data->advertised ? cap :
    1150                 :          0 :                       ethtool_adv_to_mmd_eee_adv_t(data->advertised) & cap;
    1151                 :            :                 /* Mask prohibited EEE modes */
    1152                 :          0 :                 adv &= ~phydev->eee_broken_modes;
    1153                 :            :         }
    1154                 :            : 
    1155                 :          0 :         if (old_adv != adv) {
    1156                 :          0 :                 ret = phy_write_mmd(phydev, MDIO_MMD_AN, MDIO_AN_EEE_ADV, adv);
    1157                 :          0 :                 if (ret < 0)
    1158                 :            :                         return ret;
    1159                 :            : 
    1160                 :            :                 /* Restart autonegotiation so the new modes get sent to the
    1161                 :            :                  * link partner.
    1162                 :            :                  */
    1163                 :          0 :                 if (phydev->autoneg == AUTONEG_ENABLE) {
    1164                 :          0 :                         ret = phy_restart_aneg(phydev);
    1165                 :          0 :                         if (ret < 0)
    1166                 :          0 :                                 return ret;
    1167                 :            :                 }
    1168                 :            :         }
    1169                 :            : 
    1170                 :            :         return 0;
    1171                 :            : }
    1172                 :            : EXPORT_SYMBOL(phy_ethtool_set_eee);
    1173                 :            : 
    1174                 :          0 : int phy_ethtool_set_wol(struct phy_device *phydev, struct ethtool_wolinfo *wol)
    1175                 :            : {
    1176                 :          0 :         if (phydev->drv && phydev->drv->set_wol)
    1177                 :          0 :                 return phydev->drv->set_wol(phydev, wol);
    1178                 :            : 
    1179                 :            :         return -EOPNOTSUPP;
    1180                 :            : }
    1181                 :            : EXPORT_SYMBOL(phy_ethtool_set_wol);
    1182                 :            : 
    1183                 :          0 : void phy_ethtool_get_wol(struct phy_device *phydev, struct ethtool_wolinfo *wol)
    1184                 :            : {
    1185                 :          0 :         if (phydev->drv && phydev->drv->get_wol)
    1186                 :          0 :                 phydev->drv->get_wol(phydev, wol);
    1187                 :          0 : }
    1188                 :            : EXPORT_SYMBOL(phy_ethtool_get_wol);
    1189                 :            : 
    1190                 :          0 : int phy_ethtool_get_link_ksettings(struct net_device *ndev,
    1191                 :            :                                    struct ethtool_link_ksettings *cmd)
    1192                 :            : {
    1193                 :          0 :         struct phy_device *phydev = ndev->phydev;
    1194                 :            : 
    1195                 :          0 :         if (!phydev)
    1196                 :            :                 return -ENODEV;
    1197                 :            : 
    1198                 :          0 :         phy_ethtool_ksettings_get(phydev, cmd);
    1199                 :            : 
    1200                 :          0 :         return 0;
    1201                 :            : }
    1202                 :            : EXPORT_SYMBOL(phy_ethtool_get_link_ksettings);
    1203                 :            : 
    1204                 :          0 : int phy_ethtool_set_link_ksettings(struct net_device *ndev,
    1205                 :            :                                    const struct ethtool_link_ksettings *cmd)
    1206                 :            : {
    1207                 :          0 :         struct phy_device *phydev = ndev->phydev;
    1208                 :            : 
    1209                 :          0 :         if (!phydev)
    1210                 :            :                 return -ENODEV;
    1211                 :            : 
    1212                 :          0 :         return phy_ethtool_ksettings_set(phydev, cmd);
    1213                 :            : }
    1214                 :            : EXPORT_SYMBOL(phy_ethtool_set_link_ksettings);
    1215                 :            : 
    1216                 :          0 : int phy_ethtool_nway_reset(struct net_device *ndev)
    1217                 :            : {
    1218                 :          0 :         struct phy_device *phydev = ndev->phydev;
    1219                 :            : 
    1220                 :          0 :         if (!phydev)
    1221                 :            :                 return -ENODEV;
    1222                 :            : 
    1223                 :          0 :         if (!phydev->drv)
    1224                 :            :                 return -EIO;
    1225                 :            : 
    1226                 :          0 :         return phy_restart_aneg(phydev);
    1227                 :            : }
    1228                 :            : EXPORT_SYMBOL(phy_ethtool_nway_reset);
    

Generated by: LCOV version 1.14