2019-01-22 02:05:50 +08:00
|
|
|
// SPDX-License-Identifier: GPL-2.0+
|
2014-01-05 08:17:06 +08:00
|
|
|
/* Framework for configuring and reading PHY devices
|
2005-07-31 07:31:23 +08:00
|
|
|
* Based on code in sungem_phy.c and gianfar_phy.c
|
|
|
|
*
|
|
|
|
* Author: Andy Fleming
|
|
|
|
*
|
|
|
|
* Copyright (c) 2004 Freescale Semiconductor, Inc.
|
2007-09-29 13:42:14 +08:00
|
|
|
* Copyright (c) 2006, 2007 Maciej W. Rozycki
|
2005-07-31 07:31:23 +08:00
|
|
|
*/
|
2012-06-09 15:49:07 +08:00
|
|
|
|
2005-07-31 07:31:23 +08:00
|
|
|
#include <linux/kernel.h>
|
|
|
|
#include <linux/string.h>
|
|
|
|
#include <linux/errno.h>
|
|
|
|
#include <linux/unistd.h>
|
|
|
|
#include <linux/interrupt.h>
|
|
|
|
#include <linux/delay.h>
|
|
|
|
#include <linux/netdevice.h>
|
|
|
|
#include <linux/etherdevice.h>
|
|
|
|
#include <linux/skbuff.h>
|
|
|
|
#include <linux/mm.h>
|
|
|
|
#include <linux/module.h>
|
|
|
|
#include <linux/mii.h>
|
|
|
|
#include <linux/ethtool.h>
|
|
|
|
#include <linux/phy.h>
|
2017-01-25 18:39:49 +08:00
|
|
|
#include <linux/phy_led_triggers.h>
|
2019-11-16 03:56:51 +08:00
|
|
|
#include <linux/sfp.h>
|
2006-10-03 23:18:35 +08:00
|
|
|
#include <linux/workqueue.h>
|
2012-06-28 05:14:38 +08:00
|
|
|
#include <linux/mdio.h>
|
2014-01-05 08:17:06 +08:00
|
|
|
#include <linux/io.h>
|
|
|
|
#include <linux/uaccess.h>
|
2011-07-27 07:09:06 +08:00
|
|
|
#include <linux/atomic.h>
|
2014-01-05 08:17:06 +08:00
|
|
|
|
2019-05-30 21:11:06 +08:00
|
|
|
#define PHY_STATE_TIME HZ
|
|
|
|
|
2015-05-17 01:17:56 +08:00
|
|
|
#define PHY_STATE_STR(_state) \
|
|
|
|
case PHY_##_state: \
|
|
|
|
return __stringify(_state); \
|
|
|
|
|
|
|
|
static const char *phy_state_to_str(enum phy_state st)
|
|
|
|
{
|
|
|
|
switch (st) {
|
|
|
|
PHY_STATE_STR(DOWN)
|
|
|
|
PHY_STATE_STR(READY)
|
|
|
|
PHY_STATE_STR(UP)
|
|
|
|
PHY_STATE_STR(RUNNING)
|
|
|
|
PHY_STATE_STR(NOLINK)
|
|
|
|
PHY_STATE_STR(HALTED)
|
|
|
|
}
|
|
|
|
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
2018-11-08 03:45:58 +08:00
|
|
|
static void phy_link_up(struct phy_device *phydev)
|
|
|
|
{
|
|
|
|
phydev->phy_link_change(phydev, true, true);
|
|
|
|
phy_led_trigger_change_speed(phydev);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void phy_link_down(struct phy_device *phydev, bool do_carrier)
|
|
|
|
{
|
|
|
|
phydev->phy_link_change(phydev, false, do_carrier);
|
|
|
|
phy_led_trigger_change_speed(phydev);
|
|
|
|
}
|
2015-05-17 01:17:56 +08:00
|
|
|
|
2019-05-06 01:03:51 +08:00
|
|
|
static const char *phy_pause_str(struct phy_device *phydev)
|
|
|
|
{
|
|
|
|
bool local_pause, local_asym_pause;
|
|
|
|
|
|
|
|
if (phydev->autoneg == AUTONEG_DISABLE)
|
|
|
|
goto no_pause;
|
|
|
|
|
|
|
|
local_pause = linkmode_test_bit(ETHTOOL_LINK_MODE_Pause_BIT,
|
|
|
|
phydev->advertising);
|
|
|
|
local_asym_pause = linkmode_test_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT,
|
|
|
|
phydev->advertising);
|
|
|
|
|
|
|
|
if (local_pause && phydev->pause)
|
|
|
|
return "rx/tx";
|
|
|
|
|
|
|
|
if (local_asym_pause && phydev->asym_pause) {
|
|
|
|
if (local_pause)
|
|
|
|
return "rx";
|
|
|
|
if (phydev->pause)
|
|
|
|
return "tx";
|
|
|
|
}
|
|
|
|
|
|
|
|
no_pause:
|
|
|
|
return "off";
|
|
|
|
}
|
|
|
|
|
2007-03-06 18:41:48 +08:00
|
|
|
/**
|
|
|
|
* phy_print_status - Convenience function to print out the current phy status
|
|
|
|
* @phydev: the phy_device struct
|
2005-08-25 07:46:21 +08:00
|
|
|
*/
|
|
|
|
void phy_print_status(struct phy_device *phydev)
|
|
|
|
{
|
2014-01-05 08:17:06 +08:00
|
|
|
if (phydev->link) {
|
2014-02-12 09:27:34 +08:00
|
|
|
netdev_info(phydev->attached_dev,
|
2020-03-21 00:51:38 +08:00
|
|
|
"Link is Up - %s/%s %s- flow control %s\n",
|
2014-02-12 09:27:35 +08:00
|
|
|
phy_speed_to_str(phydev->speed),
|
2017-07-25 22:02:42 +08:00
|
|
|
phy_duplex_to_str(phydev->duplex),
|
2020-03-21 00:51:38 +08:00
|
|
|
phydev->downshifted_rate ? "(downshifted) " : "",
|
2019-05-06 01:03:51 +08:00
|
|
|
phy_pause_str(phydev));
|
2014-01-05 08:17:06 +08:00
|
|
|
} else {
|
2014-02-12 09:27:33 +08:00
|
|
|
netdev_info(phydev->attached_dev, "Link is Down\n");
|
2014-01-05 08:17:06 +08:00
|
|
|
}
|
2005-08-25 07:46:21 +08:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(phy_print_status);
|
2005-07-31 07:31:23 +08:00
|
|
|
|
2007-03-06 18:41:48 +08:00
|
|
|
/**
|
|
|
|
* phy_clear_interrupt - Ack the phy device's interrupt
|
|
|
|
* @phydev: the phy_device struct
|
|
|
|
*
|
|
|
|
* If the @phydev driver has an ack_interrupt function, call it to
|
|
|
|
* ack and clear the phy device's interrupt.
|
|
|
|
*
|
2014-02-12 09:27:38 +08:00
|
|
|
* Returns 0 on success or < 0 on error.
|
2007-03-06 18:41:48 +08:00
|
|
|
*/
|
2010-10-21 16:37:41 +08:00
|
|
|
static int phy_clear_interrupt(struct phy_device *phydev)
|
2005-07-31 07:31:23 +08:00
|
|
|
{
|
|
|
|
if (phydev->drv->ack_interrupt)
|
2014-01-05 08:21:52 +08:00
|
|
|
return phydev->drv->ack_interrupt(phydev);
|
2005-07-31 07:31:23 +08:00
|
|
|
|
2014-01-05 08:21:52 +08:00
|
|
|
return 0;
|
2005-07-31 07:31:23 +08:00
|
|
|
}
|
|
|
|
|
2007-03-06 18:41:48 +08:00
|
|
|
/**
|
|
|
|
* phy_config_interrupt - configure the PHY device for the requested interrupts
|
|
|
|
* @phydev: the phy_device struct
|
|
|
|
* @interrupts: interrupt flags to configure for this @phydev
|
|
|
|
*
|
2014-02-12 09:27:38 +08:00
|
|
|
* Returns 0 on success or < 0 on error.
|
2007-03-06 18:41:48 +08:00
|
|
|
*/
|
2018-11-10 01:35:52 +08:00
|
|
|
static int phy_config_interrupt(struct phy_device *phydev, bool interrupts)
|
2005-07-31 07:31:23 +08:00
|
|
|
{
|
2018-11-10 01:35:52 +08:00
|
|
|
phydev->interrupts = interrupts ? 1 : 0;
|
2005-07-31 07:31:23 +08:00
|
|
|
if (phydev->drv->config_intr)
|
2014-01-05 08:21:52 +08:00
|
|
|
return phydev->drv->config_intr(phydev);
|
2005-07-31 07:31:23 +08:00
|
|
|
|
2014-01-05 08:21:52 +08:00
|
|
|
return 0;
|
2005-07-31 07:31:23 +08:00
|
|
|
}
|
|
|
|
|
2017-06-05 19:23:00 +08:00
|
|
|
/**
|
|
|
|
* phy_restart_aneg - restart auto-negotiation
|
|
|
|
* @phydev: target phy_device struct
|
|
|
|
*
|
|
|
|
* Restart the autonegotiation on @phydev. Returns >= 0 on success or
|
|
|
|
* negative errno on error.
|
|
|
|
*/
|
|
|
|
int phy_restart_aneg(struct phy_device *phydev)
|
|
|
|
{
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
if (phydev->is_c45 && !(phydev->c45_ids.devices_in_package & BIT(0)))
|
|
|
|
ret = genphy_c45_restart_aneg(phydev);
|
|
|
|
else
|
|
|
|
ret = genphy_restart_aneg(phydev);
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(phy_restart_aneg);
|
2005-07-31 07:31:23 +08:00
|
|
|
|
2007-03-06 18:41:48 +08:00
|
|
|
/**
|
|
|
|
* phy_aneg_done - return auto-negotiation status
|
|
|
|
* @phydev: target phy_device struct
|
2005-07-31 07:31:23 +08:00
|
|
|
*
|
2014-02-12 09:27:37 +08:00
|
|
|
* Description: Return the auto-negotiation status from this @phydev
|
|
|
|
* Returns > 0 on success or < 0 on error. 0 means that auto-negotiation
|
|
|
|
* is still pending.
|
2005-07-31 07:31:23 +08:00
|
|
|
*/
|
2016-11-11 07:10:46 +08:00
|
|
|
int phy_aneg_done(struct phy_device *phydev)
|
2005-07-31 07:31:23 +08:00
|
|
|
{
|
2017-02-24 06:22:19 +08:00
|
|
|
if (phydev->drv && phydev->drv->aneg_done)
|
2014-02-12 09:27:37 +08:00
|
|
|
return phydev->drv->aneg_done(phydev);
|
2019-03-03 00:10:00 +08:00
|
|
|
else if (phydev->is_c45)
|
|
|
|
return genphy_c45_aneg_done(phydev);
|
|
|
|
else
|
|
|
|
return genphy_aneg_done(phydev);
|
2005-07-31 07:31:23 +08:00
|
|
|
}
|
2016-11-11 07:10:46 +08:00
|
|
|
EXPORT_SYMBOL(phy_aneg_done);
|
2005-07-31 07:31:23 +08:00
|
|
|
|
2007-03-06 18:41:48 +08:00
|
|
|
/**
|
net: phy: improve phylib correctness for non-autoneg settings
phylib has some undesirable behaviour when forcing a link mode through
ethtool. phylib uses this code:
idx = phy_find_valid(phy_find_setting(phydev->speed, phydev->duplex),
features);
to find an index in the settings table. phy_find_setting() starts at
index 0, and scans upwards looking for an exact speed and duplex match.
When it doesn't find it, it returns MAX_NUM_SETTINGS - 1, which is
10baseT-Half duplex.
phy_find_valid() then scans from the point (and effectively only checks
one entry) before bailing out, returning MAX_NUM_SETTINGS - 1.
phy_sanitize_settings() then sets ->speed to SPEED_10 and ->duplex to
DUPLEX_HALF whether or not 10baseT-Half is supported or not. This goes
against all the comments against these functions, and 10baseT-Half may
not even be supported by the hardware.
Rework these functions, introducing a new method of scanning the table.
There are two modes of lookup that phylib wants: exact, and inexact.
- in exact mode, we return either an exact match or failure
- in inexact mode, we return an exact match if it exists, a match at
the highest speed that is not greater than the requested speed
(ignoring duplex), or failing that, the lowest supported speed, or
failure.
The biggest difference is that we always check whether the entry is
supported before further consideration, so all unsupported entries are
not considered as candidates.
This results in arguably saner behaviour, better matches the comments,
and is probably what users would expect.
This becomes important as ethernet speeds increase, PHYs exist which do
not support the 10Mbit speeds, and half-duplex is likely to become
obsolete - it's already not even an option on 10Gbit and faster links.
Signed-off-by: Russell King <rmk+kernel@armlinux.org.uk>
Signed-off-by: David S. Miller <davem@davemloft.net>
2017-04-13 23:49:15 +08:00
|
|
|
* phy_find_valid - find a PHY setting that matches the requested parameters
|
|
|
|
* @speed: desired speed
|
|
|
|
* @duplex: desired duplex
|
|
|
|
* @supported: mask of supported link modes
|
2005-07-31 07:31:23 +08:00
|
|
|
*
|
net: phy: improve phylib correctness for non-autoneg settings
phylib has some undesirable behaviour when forcing a link mode through
ethtool. phylib uses this code:
idx = phy_find_valid(phy_find_setting(phydev->speed, phydev->duplex),
features);
to find an index in the settings table. phy_find_setting() starts at
index 0, and scans upwards looking for an exact speed and duplex match.
When it doesn't find it, it returns MAX_NUM_SETTINGS - 1, which is
10baseT-Half duplex.
phy_find_valid() then scans from the point (and effectively only checks
one entry) before bailing out, returning MAX_NUM_SETTINGS - 1.
phy_sanitize_settings() then sets ->speed to SPEED_10 and ->duplex to
DUPLEX_HALF whether or not 10baseT-Half is supported or not. This goes
against all the comments against these functions, and 10baseT-Half may
not even be supported by the hardware.
Rework these functions, introducing a new method of scanning the table.
There are two modes of lookup that phylib wants: exact, and inexact.
- in exact mode, we return either an exact match or failure
- in inexact mode, we return an exact match if it exists, a match at
the highest speed that is not greater than the requested speed
(ignoring duplex), or failing that, the lowest supported speed, or
failure.
The biggest difference is that we always check whether the entry is
supported before further consideration, so all unsupported entries are
not considered as candidates.
This results in arguably saner behaviour, better matches the comments,
and is probably what users would expect.
This becomes important as ethernet speeds increase, PHYs exist which do
not support the 10Mbit speeds, and half-duplex is likely to become
obsolete - it's already not even an option on 10Gbit and faster links.
Signed-off-by: Russell King <rmk+kernel@armlinux.org.uk>
Signed-off-by: David S. Miller <davem@davemloft.net>
2017-04-13 23:49:15 +08:00
|
|
|
* Locate a supported phy setting that is, in priority order:
|
|
|
|
* - an exact match for the specified speed and duplex mode
|
|
|
|
* - a match for the specified speed, or slower speed
|
|
|
|
* - the slowest supported speed
|
|
|
|
* Returns the matched phy_setting entry, or %NULL if no supported phy
|
|
|
|
* settings were found.
|
2005-07-31 07:31:23 +08:00
|
|
|
*/
|
net: phy: improve phylib correctness for non-autoneg settings
phylib has some undesirable behaviour when forcing a link mode through
ethtool. phylib uses this code:
idx = phy_find_valid(phy_find_setting(phydev->speed, phydev->duplex),
features);
to find an index in the settings table. phy_find_setting() starts at
index 0, and scans upwards looking for an exact speed and duplex match.
When it doesn't find it, it returns MAX_NUM_SETTINGS - 1, which is
10baseT-Half duplex.
phy_find_valid() then scans from the point (and effectively only checks
one entry) before bailing out, returning MAX_NUM_SETTINGS - 1.
phy_sanitize_settings() then sets ->speed to SPEED_10 and ->duplex to
DUPLEX_HALF whether or not 10baseT-Half is supported or not. This goes
against all the comments against these functions, and 10baseT-Half may
not even be supported by the hardware.
Rework these functions, introducing a new method of scanning the table.
There are two modes of lookup that phylib wants: exact, and inexact.
- in exact mode, we return either an exact match or failure
- in inexact mode, we return an exact match if it exists, a match at
the highest speed that is not greater than the requested speed
(ignoring duplex), or failing that, the lowest supported speed, or
failure.
The biggest difference is that we always check whether the entry is
supported before further consideration, so all unsupported entries are
not considered as candidates.
This results in arguably saner behaviour, better matches the comments,
and is probably what users would expect.
This becomes important as ethernet speeds increase, PHYs exist which do
not support the 10Mbit speeds, and half-duplex is likely to become
obsolete - it's already not even an option on 10Gbit and faster links.
Signed-off-by: Russell King <rmk+kernel@armlinux.org.uk>
Signed-off-by: David S. Miller <davem@davemloft.net>
2017-04-13 23:49:15 +08:00
|
|
|
static const struct phy_setting *
|
2018-11-11 06:43:33 +08:00
|
|
|
phy_find_valid(int speed, int duplex, unsigned long *supported)
|
2005-07-31 07:31:23 +08:00
|
|
|
{
|
2018-11-11 06:43:33 +08:00
|
|
|
return phy_lookup_setting(speed, duplex, supported, false);
|
2005-07-31 07:31:23 +08:00
|
|
|
}
|
|
|
|
|
2016-10-17 23:49:54 +08:00
|
|
|
/**
|
|
|
|
* phy_supported_speeds - return all speeds currently supported by a phy device
|
|
|
|
* @phy: The phy device to return supported speeds of.
|
|
|
|
* @speeds: buffer to store supported speeds in.
|
|
|
|
* @size: size of speeds buffer.
|
|
|
|
*
|
|
|
|
* Description: Returns the number of supported speeds, and fills the speeds
|
|
|
|
* buffer with the supported speeds. If speeds buffer is too small to contain
|
|
|
|
* all currently supported speeds, will return as many speeds as can fit.
|
|
|
|
*/
|
|
|
|
unsigned int phy_supported_speeds(struct phy_device *phy,
|
|
|
|
unsigned int *speeds,
|
|
|
|
unsigned int size)
|
|
|
|
{
|
2018-11-11 06:43:33 +08:00
|
|
|
return phy_speeds(speeds, size, phy->supported);
|
2016-10-17 23:49:54 +08:00
|
|
|
}
|
|
|
|
|
2015-02-18 01:36:22 +08:00
|
|
|
/**
|
|
|
|
* phy_check_valid - check if there is a valid PHY setting which matches
|
|
|
|
* speed, duplex, and feature mask
|
|
|
|
* @speed: speed to match
|
|
|
|
* @duplex: duplex to match
|
|
|
|
* @features: A mask of the valid settings
|
|
|
|
*
|
|
|
|
* Description: Returns true if there is a valid setting, false otherwise.
|
|
|
|
*/
|
2018-11-11 06:43:33 +08:00
|
|
|
static inline bool phy_check_valid(int speed, int duplex,
|
|
|
|
unsigned long *features)
|
2015-02-18 01:36:22 +08:00
|
|
|
{
|
2018-11-11 06:43:33 +08:00
|
|
|
return !!phy_lookup_setting(speed, duplex, features, true);
|
2015-02-18 01:36:22 +08:00
|
|
|
}
|
|
|
|
|
2007-03-06 18:41:48 +08:00
|
|
|
/**
|
|
|
|
* phy_sanitize_settings - make sure the PHY is set to supported speed and duplex
|
|
|
|
* @phydev: the target phy_device struct
|
2005-07-31 07:31:23 +08:00
|
|
|
*
|
2007-03-06 18:41:48 +08:00
|
|
|
* Description: Make sure the PHY is set to supported speeds and
|
2005-07-31 07:31:23 +08:00
|
|
|
* duplexes. Drop down by one in this order: 1000/FULL,
|
2007-03-06 18:41:48 +08:00
|
|
|
* 1000/HALF, 100/FULL, 100/HALF, 10/FULL, 10/HALF.
|
2005-07-31 07:31:23 +08:00
|
|
|
*/
|
2010-10-21 16:37:41 +08:00
|
|
|
static void phy_sanitize_settings(struct phy_device *phydev)
|
2005-07-31 07:31:23 +08:00
|
|
|
{
|
net: phy: improve phylib correctness for non-autoneg settings
phylib has some undesirable behaviour when forcing a link mode through
ethtool. phylib uses this code:
idx = phy_find_valid(phy_find_setting(phydev->speed, phydev->duplex),
features);
to find an index in the settings table. phy_find_setting() starts at
index 0, and scans upwards looking for an exact speed and duplex match.
When it doesn't find it, it returns MAX_NUM_SETTINGS - 1, which is
10baseT-Half duplex.
phy_find_valid() then scans from the point (and effectively only checks
one entry) before bailing out, returning MAX_NUM_SETTINGS - 1.
phy_sanitize_settings() then sets ->speed to SPEED_10 and ->duplex to
DUPLEX_HALF whether or not 10baseT-Half is supported or not. This goes
against all the comments against these functions, and 10baseT-Half may
not even be supported by the hardware.
Rework these functions, introducing a new method of scanning the table.
There are two modes of lookup that phylib wants: exact, and inexact.
- in exact mode, we return either an exact match or failure
- in inexact mode, we return an exact match if it exists, a match at
the highest speed that is not greater than the requested speed
(ignoring duplex), or failing that, the lowest supported speed, or
failure.
The biggest difference is that we always check whether the entry is
supported before further consideration, so all unsupported entries are
not considered as candidates.
This results in arguably saner behaviour, better matches the comments,
and is probably what users would expect.
This becomes important as ethernet speeds increase, PHYs exist which do
not support the 10Mbit speeds, and half-duplex is likely to become
obsolete - it's already not even an option on 10Gbit and faster links.
Signed-off-by: Russell King <rmk+kernel@armlinux.org.uk>
Signed-off-by: David S. Miller <davem@davemloft.net>
2017-04-13 23:49:15 +08:00
|
|
|
const struct phy_setting *setting;
|
2005-07-31 07:31:23 +08:00
|
|
|
|
2018-11-11 06:43:33 +08:00
|
|
|
setting = phy_find_valid(phydev->speed, phydev->duplex,
|
|
|
|
phydev->supported);
|
net: phy: improve phylib correctness for non-autoneg settings
phylib has some undesirable behaviour when forcing a link mode through
ethtool. phylib uses this code:
idx = phy_find_valid(phy_find_setting(phydev->speed, phydev->duplex),
features);
to find an index in the settings table. phy_find_setting() starts at
index 0, and scans upwards looking for an exact speed and duplex match.
When it doesn't find it, it returns MAX_NUM_SETTINGS - 1, which is
10baseT-Half duplex.
phy_find_valid() then scans from the point (and effectively only checks
one entry) before bailing out, returning MAX_NUM_SETTINGS - 1.
phy_sanitize_settings() then sets ->speed to SPEED_10 and ->duplex to
DUPLEX_HALF whether or not 10baseT-Half is supported or not. This goes
against all the comments against these functions, and 10baseT-Half may
not even be supported by the hardware.
Rework these functions, introducing a new method of scanning the table.
There are two modes of lookup that phylib wants: exact, and inexact.
- in exact mode, we return either an exact match or failure
- in inexact mode, we return an exact match if it exists, a match at
the highest speed that is not greater than the requested speed
(ignoring duplex), or failing that, the lowest supported speed, or
failure.
The biggest difference is that we always check whether the entry is
supported before further consideration, so all unsupported entries are
not considered as candidates.
This results in arguably saner behaviour, better matches the comments,
and is probably what users would expect.
This becomes important as ethernet speeds increase, PHYs exist which do
not support the 10Mbit speeds, and half-duplex is likely to become
obsolete - it's already not even an option on 10Gbit and faster links.
Signed-off-by: Russell King <rmk+kernel@armlinux.org.uk>
Signed-off-by: David S. Miller <davem@davemloft.net>
2017-04-13 23:49:15 +08:00
|
|
|
if (setting) {
|
|
|
|
phydev->speed = setting->speed;
|
|
|
|
phydev->duplex = setting->duplex;
|
|
|
|
} else {
|
|
|
|
/* We failed to find anything (no supported speeds?) */
|
|
|
|
phydev->speed = SPEED_UNKNOWN;
|
|
|
|
phydev->duplex = DUPLEX_UNKNOWN;
|
|
|
|
}
|
2005-07-31 07:31:23 +08:00
|
|
|
}
|
|
|
|
|
2016-04-15 06:35:00 +08:00
|
|
|
int phy_ethtool_ksettings_set(struct phy_device *phydev,
|
|
|
|
const struct ethtool_link_ksettings *cmd)
|
|
|
|
{
|
2018-11-11 06:43:33 +08:00
|
|
|
__ETHTOOL_DECLARE_LINK_MODE_MASK(advertising);
|
2016-04-15 06:35:00 +08:00
|
|
|
u8 autoneg = cmd->base.autoneg;
|
|
|
|
u8 duplex = cmd->base.duplex;
|
|
|
|
u32 speed = cmd->base.speed;
|
|
|
|
|
|
|
|
if (cmd->base.phy_address != phydev->mdio.addr)
|
|
|
|
return -EINVAL;
|
|
|
|
|
2018-11-11 06:43:33 +08:00
|
|
|
linkmode_copy(advertising, cmd->link_modes.advertising);
|
2016-04-15 06:35:00 +08:00
|
|
|
|
|
|
|
/* We make sure that we don't pass unsupported values in to the PHY */
|
2018-11-11 06:43:33 +08:00
|
|
|
linkmode_and(advertising, advertising, phydev->supported);
|
2016-04-15 06:35:00 +08:00
|
|
|
|
|
|
|
/* Verify the settings we care about. */
|
|
|
|
if (autoneg != AUTONEG_ENABLE && autoneg != AUTONEG_DISABLE)
|
|
|
|
return -EINVAL;
|
|
|
|
|
2018-11-13 07:45:56 +08:00
|
|
|
if (autoneg == AUTONEG_ENABLE && linkmode_empty(advertising))
|
2016-04-15 06:35:00 +08:00
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
if (autoneg == AUTONEG_DISABLE &&
|
|
|
|
((speed != SPEED_1000 &&
|
|
|
|
speed != SPEED_100 &&
|
|
|
|
speed != SPEED_10) ||
|
|
|
|
(duplex != DUPLEX_HALF &&
|
|
|
|
duplex != DUPLEX_FULL)))
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
phydev->autoneg = autoneg;
|
|
|
|
|
|
|
|
phydev->speed = speed;
|
|
|
|
|
2018-11-11 06:43:33 +08:00
|
|
|
linkmode_copy(phydev->advertising, advertising);
|
2016-04-15 06:35:00 +08:00
|
|
|
|
2019-07-08 20:34:17 +08:00
|
|
|
linkmode_mod_bit(ETHTOOL_LINK_MODE_Autoneg_BIT,
|
|
|
|
phydev->advertising, autoneg == AUTONEG_ENABLE);
|
2016-04-15 06:35:00 +08:00
|
|
|
|
|
|
|
phydev->duplex = duplex;
|
|
|
|
|
2016-11-29 17:46:47 +08:00
|
|
|
phydev->mdix_ctrl = cmd->base.eth_tp_mdix_ctrl;
|
2016-04-15 06:35:00 +08:00
|
|
|
|
|
|
|
/* Restart the PHY */
|
|
|
|
phy_start_aneg(phydev);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(phy_ethtool_ksettings_set);
|
|
|
|
|
2017-06-13 15:09:46 +08:00
|
|
|
void phy_ethtool_ksettings_get(struct phy_device *phydev,
|
|
|
|
struct ethtool_link_ksettings *cmd)
|
2016-04-15 06:35:00 +08:00
|
|
|
{
|
2018-11-11 06:43:33 +08:00
|
|
|
linkmode_copy(cmd->link_modes.supported, phydev->supported);
|
|
|
|
linkmode_copy(cmd->link_modes.advertising, phydev->advertising);
|
2018-11-11 06:43:34 +08:00
|
|
|
linkmode_copy(cmd->link_modes.lp_advertising, phydev->lp_advertising);
|
2016-04-15 06:35:00 +08:00
|
|
|
|
|
|
|
cmd->base.speed = phydev->speed;
|
|
|
|
cmd->base.duplex = phydev->duplex;
|
|
|
|
if (phydev->interface == PHY_INTERFACE_MODE_MOCA)
|
|
|
|
cmd->base.port = PORT_BNC;
|
|
|
|
else
|
|
|
|
cmd->base.port = PORT_MII;
|
2017-09-21 06:52:14 +08:00
|
|
|
cmd->base.transceiver = phy_is_internal(phydev) ?
|
|
|
|
XCVR_INTERNAL : XCVR_EXTERNAL;
|
2016-04-15 06:35:00 +08:00
|
|
|
cmd->base.phy_address = phydev->mdio.addr;
|
|
|
|
cmd->base.autoneg = phydev->autoneg;
|
2016-11-29 17:46:47 +08:00
|
|
|
cmd->base.eth_tp_mdix_ctrl = phydev->mdix_ctrl;
|
|
|
|
cmd->base.eth_tp_mdix = phydev->mdix;
|
2016-04-15 06:35:00 +08:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(phy_ethtool_ksettings_get);
|
2005-07-31 07:31:23 +08:00
|
|
|
|
2007-03-06 18:41:48 +08:00
|
|
|
/**
|
|
|
|
* phy_mii_ioctl - generic PHY MII ioctl interface
|
|
|
|
* @phydev: the phy_device struct
|
2010-08-09 21:41:59 +08:00
|
|
|
* @ifr: &struct ifreq for socket ioctl's
|
2007-03-06 18:41:48 +08:00
|
|
|
* @cmd: ioctl cmd to execute
|
|
|
|
*
|
|
|
|
* Note that this function is currently incompatible with the
|
2005-07-31 07:31:23 +08:00
|
|
|
* PHYCONTROL layer. It changes registers without regard to
|
2007-03-06 18:41:48 +08:00
|
|
|
* current state. Use at own risk.
|
2005-07-31 07:31:23 +08:00
|
|
|
*/
|
2014-01-05 08:17:06 +08:00
|
|
|
int phy_mii_ioctl(struct phy_device *phydev, struct ifreq *ifr, int cmd)
|
2005-07-31 07:31:23 +08:00
|
|
|
{
|
2010-07-17 16:48:55 +08:00
|
|
|
struct mii_ioctl_data *mii_data = if_mii(ifr);
|
2005-07-31 07:31:23 +08:00
|
|
|
u16 val = mii_data->val_in;
|
2014-11-12 04:39:39 +08:00
|
|
|
bool change_autoneg = false;
|
2019-05-28 17:57:29 +08:00
|
|
|
int prtad, devad;
|
2005-07-31 07:31:23 +08:00
|
|
|
|
|
|
|
switch (cmd) {
|
|
|
|
case SIOCGMIIPHY:
|
2016-01-07 03:11:16 +08:00
|
|
|
mii_data->phy_id = phydev->mdio.addr;
|
2008-09-18 11:06:52 +08:00
|
|
|
/* fall through */
|
|
|
|
|
2005-07-31 07:31:23 +08:00
|
|
|
case SIOCGMIIREG:
|
2019-05-28 17:57:29 +08:00
|
|
|
if (mdio_phy_id_is_c45(mii_data->phy_id)) {
|
|
|
|
prtad = mdio_phy_id_prtad(mii_data->phy_id);
|
|
|
|
devad = mdio_phy_id_devad(mii_data->phy_id);
|
|
|
|
devad = MII_ADDR_C45 | devad << 16 | mii_data->reg_num;
|
|
|
|
} else {
|
|
|
|
prtad = mii_data->phy_id;
|
|
|
|
devad = mii_data->reg_num;
|
|
|
|
}
|
|
|
|
mii_data->val_out = mdiobus_read(phydev->mdio.bus, prtad,
|
|
|
|
devad);
|
2014-01-05 08:21:52 +08:00
|
|
|
return 0;
|
2005-07-31 07:31:23 +08:00
|
|
|
|
|
|
|
case SIOCSMIIREG:
|
2019-05-28 17:57:29 +08:00
|
|
|
if (mdio_phy_id_is_c45(mii_data->phy_id)) {
|
|
|
|
prtad = mdio_phy_id_prtad(mii_data->phy_id);
|
|
|
|
devad = mdio_phy_id_devad(mii_data->phy_id);
|
|
|
|
devad = MII_ADDR_C45 | devad << 16 | mii_data->reg_num;
|
|
|
|
} else {
|
|
|
|
prtad = mii_data->phy_id;
|
|
|
|
devad = mii_data->reg_num;
|
|
|
|
}
|
|
|
|
if (prtad == phydev->mdio.addr) {
|
|
|
|
switch (devad) {
|
2005-07-31 07:31:23 +08:00
|
|
|
case MII_BMCR:
|
2014-11-12 04:39:39 +08:00
|
|
|
if ((val & (BMCR_RESET | BMCR_ANENABLE)) == 0) {
|
|
|
|
if (phydev->autoneg == AUTONEG_ENABLE)
|
|
|
|
change_autoneg = true;
|
2005-07-31 07:31:23 +08:00
|
|
|
phydev->autoneg = AUTONEG_DISABLE;
|
2014-11-12 04:39:39 +08:00
|
|
|
if (val & BMCR_FULLDPLX)
|
|
|
|
phydev->duplex = DUPLEX_FULL;
|
|
|
|
else
|
|
|
|
phydev->duplex = DUPLEX_HALF;
|
|
|
|
if (val & BMCR_SPEED1000)
|
|
|
|
phydev->speed = SPEED_1000;
|
|
|
|
else if (val & BMCR_SPEED100)
|
|
|
|
phydev->speed = SPEED_100;
|
|
|
|
else phydev->speed = SPEED_10;
|
|
|
|
}
|
|
|
|
else {
|
|
|
|
if (phydev->autoneg == AUTONEG_DISABLE)
|
|
|
|
change_autoneg = true;
|
2005-07-31 07:31:23 +08:00
|
|
|
phydev->autoneg = AUTONEG_ENABLE;
|
2014-11-12 04:39:39 +08:00
|
|
|
}
|
2005-07-31 07:31:23 +08:00
|
|
|
break;
|
|
|
|
case MII_ADVERTISE:
|
2018-12-06 04:49:45 +08:00
|
|
|
mii_adv_mod_linkmode_adv_t(phydev->advertising,
|
|
|
|
val);
|
2014-11-12 04:39:39 +08:00
|
|
|
change_autoneg = true;
|
2005-07-31 07:31:23 +08:00
|
|
|
break;
|
2019-10-05 00:05:58 +08:00
|
|
|
case MII_CTRL1000:
|
|
|
|
mii_ctrl1000_mod_linkmode_adv_t(phydev->advertising,
|
|
|
|
val);
|
|
|
|
change_autoneg = true;
|
|
|
|
break;
|
2005-07-31 07:31:23 +08:00
|
|
|
default:
|
|
|
|
/* do nothing */
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2019-05-28 17:57:29 +08:00
|
|
|
mdiobus_write(phydev->mdio.bus, prtad, devad, val);
|
2011-03-10 14:52:13 +08:00
|
|
|
|
2019-05-28 17:57:29 +08:00
|
|
|
if (prtad == phydev->mdio.addr &&
|
|
|
|
devad == MII_BMCR &&
|
2013-12-07 05:01:31 +08:00
|
|
|
val & BMCR_RESET)
|
2014-01-05 08:21:52 +08:00
|
|
|
return phy_init_hw(phydev);
|
2014-11-12 04:39:39 +08:00
|
|
|
|
|
|
|
if (change_autoneg)
|
|
|
|
return phy_start_aneg(phydev);
|
|
|
|
|
2014-01-05 08:21:52 +08:00
|
|
|
return 0;
|
2007-11-29 03:56:34 +08:00
|
|
|
|
2010-07-17 16:49:36 +08:00
|
|
|
case SIOCSHWTSTAMP:
|
2019-12-26 10:16:15 +08:00
|
|
|
if (phydev->mii_ts && phydev->mii_ts->hwtstamp)
|
|
|
|
return phydev->mii_ts->hwtstamp(phydev->mii_ts, ifr);
|
2010-07-17 16:49:36 +08:00
|
|
|
/* fall through */
|
|
|
|
|
2007-11-29 03:56:34 +08:00
|
|
|
default:
|
2008-09-18 11:06:52 +08:00
|
|
|
return -EOPNOTSUPP;
|
2005-07-31 07:31:23 +08:00
|
|
|
}
|
|
|
|
}
|
2007-09-18 04:21:40 +08:00
|
|
|
EXPORT_SYMBOL(phy_mii_ioctl);
|
2005-07-31 07:31:23 +08:00
|
|
|
|
2020-01-19 21:31:55 +08:00
|
|
|
/**
|
2020-01-21 05:17:11 +08:00
|
|
|
* phy_do_ioctl - generic ndo_do_ioctl implementation
|
2020-01-19 21:31:55 +08:00
|
|
|
* @dev: the net_device struct
|
|
|
|
* @ifr: &struct ifreq for socket ioctl's
|
|
|
|
* @cmd: ioctl cmd to execute
|
|
|
|
*/
|
2020-01-21 05:17:11 +08:00
|
|
|
int phy_do_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
|
2020-01-19 21:31:55 +08:00
|
|
|
{
|
2020-01-21 05:17:11 +08:00
|
|
|
if (!dev->phydev)
|
2020-01-19 21:31:55 +08:00
|
|
|
return -ENODEV;
|
|
|
|
|
|
|
|
return phy_mii_ioctl(dev->phydev, ifr, cmd);
|
|
|
|
}
|
2020-01-21 05:17:11 +08:00
|
|
|
EXPORT_SYMBOL(phy_do_ioctl);
|
|
|
|
|
|
|
|
/* same as phy_do_ioctl, but ensures that net_device is running */
|
|
|
|
int phy_do_ioctl_running(struct net_device *dev, struct ifreq *ifr, int cmd)
|
|
|
|
{
|
|
|
|
if (!netif_running(dev))
|
|
|
|
return -ENODEV;
|
|
|
|
|
|
|
|
return phy_do_ioctl(dev, ifr, cmd);
|
|
|
|
}
|
2020-01-21 05:16:07 +08:00
|
|
|
EXPORT_SYMBOL(phy_do_ioctl_running);
|
2020-01-19 21:31:55 +08:00
|
|
|
|
2019-05-30 21:11:06 +08:00
|
|
|
void phy_queue_state_machine(struct phy_device *phydev, unsigned long jiffies)
|
2018-11-07 15:15:58 +08:00
|
|
|
{
|
|
|
|
mod_delayed_work(system_power_efficient_wq, &phydev->state_queue,
|
2019-05-30 21:11:06 +08:00
|
|
|
jiffies);
|
2018-11-07 15:15:58 +08:00
|
|
|
}
|
2019-05-30 21:11:06 +08:00
|
|
|
EXPORT_SYMBOL(phy_queue_state_machine);
|
2018-11-07 15:15:58 +08:00
|
|
|
|
|
|
|
static void phy_trigger_machine(struct phy_device *phydev)
|
|
|
|
{
|
|
|
|
phy_queue_state_machine(phydev, 0);
|
|
|
|
}
|
|
|
|
|
2018-07-13 03:31:54 +08:00
|
|
|
static int phy_config_aneg(struct phy_device *phydev)
|
|
|
|
{
|
|
|
|
if (phydev->drv->config_aneg)
|
|
|
|
return phydev->drv->config_aneg(phydev);
|
2018-07-23 23:06:15 +08:00
|
|
|
|
|
|
|
/* Clause 45 PHYs that don't implement Clause 22 registers are not
|
|
|
|
* allowed to call genphy_config_aneg()
|
|
|
|
*/
|
|
|
|
if (phydev->is_c45 && !(phydev->c45_ids.devices_in_package & BIT(0)))
|
2019-08-21 19:00:46 +08:00
|
|
|
return genphy_c45_config_aneg(phydev);
|
2018-07-23 23:06:15 +08:00
|
|
|
|
|
|
|
return genphy_config_aneg(phydev);
|
2018-07-13 03:31:54 +08:00
|
|
|
}
|
|
|
|
|
2018-11-08 03:45:58 +08:00
|
|
|
/**
|
|
|
|
* phy_check_link_status - check link status and set state accordingly
|
|
|
|
* @phydev: the phy_device struct
|
|
|
|
*
|
|
|
|
* Description: Check for link and whether autoneg was triggered / is running
|
|
|
|
* and set state accordingly
|
|
|
|
*/
|
|
|
|
static int phy_check_link_status(struct phy_device *phydev)
|
|
|
|
{
|
|
|
|
int err;
|
|
|
|
|
|
|
|
WARN_ON(!mutex_is_locked(&phydev->lock));
|
|
|
|
|
2019-09-05 19:43:10 +08:00
|
|
|
/* Keep previous state if loopback is enabled because some PHYs
|
|
|
|
* report that Link is Down when loopback is enabled.
|
|
|
|
*/
|
|
|
|
if (phydev->loopback_enabled)
|
|
|
|
return 0;
|
|
|
|
|
2018-11-08 03:45:58 +08:00
|
|
|
err = phy_read_status(phydev);
|
|
|
|
if (err)
|
|
|
|
return err;
|
|
|
|
|
|
|
|
if (phydev->link && phydev->state != PHY_RUNNING) {
|
2020-03-21 00:51:38 +08:00
|
|
|
phy_check_downshift(phydev);
|
2018-11-08 03:45:58 +08:00
|
|
|
phydev->state = PHY_RUNNING;
|
|
|
|
phy_link_up(phydev);
|
|
|
|
} else if (!phydev->link && phydev->state != PHY_NOLINK) {
|
|
|
|
phydev->state = PHY_NOLINK;
|
|
|
|
phy_link_down(phydev, true);
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2007-03-06 18:41:48 +08:00
|
|
|
/**
|
2018-10-16 03:25:13 +08:00
|
|
|
* phy_start_aneg - start auto-negotiation for this PHY device
|
2007-03-06 18:41:48 +08:00
|
|
|
* @phydev: the phy_device struct
|
2005-08-25 07:46:21 +08:00
|
|
|
*
|
2007-03-06 18:41:48 +08:00
|
|
|
* Description: Sanitizes the settings (if we're not autonegotiating
|
|
|
|
* them), and then calls the driver's config_aneg function.
|
|
|
|
* If the PHYCONTROL Layer is operating, we change the state to
|
|
|
|
* reflect the beginning of Auto-negotiation or forcing.
|
2005-08-25 07:46:21 +08:00
|
|
|
*/
|
2018-10-16 03:25:13 +08:00
|
|
|
int phy_start_aneg(struct phy_device *phydev)
|
2005-08-25 07:46:21 +08:00
|
|
|
{
|
|
|
|
int err;
|
|
|
|
|
2017-02-18 08:07:34 +08:00
|
|
|
if (!phydev->drv)
|
|
|
|
return -EIO;
|
|
|
|
|
2008-01-30 00:05:09 +08:00
|
|
|
mutex_lock(&phydev->lock);
|
2005-08-25 07:46:21 +08:00
|
|
|
|
|
|
|
if (AUTONEG_DISABLE == phydev->autoneg)
|
|
|
|
phy_sanitize_settings(phydev);
|
|
|
|
|
2018-07-13 03:31:54 +08:00
|
|
|
err = phy_config_aneg(phydev);
|
2005-08-25 07:46:21 +08:00
|
|
|
if (err < 0)
|
|
|
|
goto out_unlock;
|
|
|
|
|
2019-06-05 05:02:34 +08:00
|
|
|
if (phy_is_started(phydev))
|
|
|
|
err = phy_check_link_status(phydev);
|
2005-08-25 07:46:21 +08:00
|
|
|
out_unlock:
|
2008-01-30 00:05:09 +08:00
|
|
|
mutex_unlock(&phydev->lock);
|
2017-04-20 19:00:04 +08:00
|
|
|
|
2005-08-25 07:46:21 +08:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(phy_start_aneg);
|
|
|
|
|
2018-07-13 03:32:53 +08:00
|
|
|
static int phy_poll_aneg_done(struct phy_device *phydev)
|
|
|
|
{
|
|
|
|
unsigned int retries = 100;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
do {
|
|
|
|
msleep(100);
|
|
|
|
ret = phy_aneg_done(phydev);
|
|
|
|
} while (!ret && --retries);
|
|
|
|
|
|
|
|
if (!ret)
|
|
|
|
return -ETIMEDOUT;
|
|
|
|
|
|
|
|
return ret < 0 ? ret : 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* phy_speed_down - set speed to lowest speed supported by both link partners
|
|
|
|
* @phydev: the phy_device struct
|
|
|
|
* @sync: perform action synchronously
|
|
|
|
*
|
|
|
|
* Description: Typically used to save energy when waiting for a WoL packet
|
|
|
|
*
|
|
|
|
* WARNING: Setting sync to false may cause the system being unable to suspend
|
|
|
|
* in case the PHY generates an interrupt when finishing the autonegotiation.
|
|
|
|
* This interrupt may wake up the system immediately after suspend.
|
|
|
|
* Therefore use sync = false only if you're sure it's safe with the respective
|
|
|
|
* network chip.
|
|
|
|
*/
|
|
|
|
int phy_speed_down(struct phy_device *phydev, bool sync)
|
|
|
|
{
|
2019-08-13 05:52:19 +08:00
|
|
|
__ETHTOOL_DECLARE_LINK_MODE_MASK(adv_tmp);
|
2018-07-13 03:32:53 +08:00
|
|
|
int ret;
|
|
|
|
|
|
|
|
if (phydev->autoneg != AUTONEG_ENABLE)
|
|
|
|
return 0;
|
|
|
|
|
2019-08-13 05:52:19 +08:00
|
|
|
linkmode_copy(adv_tmp, phydev->advertising);
|
|
|
|
|
|
|
|
ret = phy_speed_down_core(phydev);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
2018-07-13 03:32:53 +08:00
|
|
|
|
2019-08-13 05:52:19 +08:00
|
|
|
linkmode_copy(phydev->adv_old, adv_tmp);
|
|
|
|
|
|
|
|
if (linkmode_equal(phydev->advertising, adv_tmp))
|
2018-07-13 03:32:53 +08:00
|
|
|
return 0;
|
|
|
|
|
|
|
|
ret = phy_config_aneg(phydev);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
return sync ? phy_poll_aneg_done(phydev) : 0;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(phy_speed_down);
|
|
|
|
|
|
|
|
/**
|
|
|
|
* phy_speed_up - (re)set advertised speeds to all supported speeds
|
|
|
|
* @phydev: the phy_device struct
|
|
|
|
*
|
|
|
|
* Description: Used to revert the effect of phy_speed_down
|
|
|
|
*/
|
|
|
|
int phy_speed_up(struct phy_device *phydev)
|
|
|
|
{
|
2019-08-13 05:52:19 +08:00
|
|
|
__ETHTOOL_DECLARE_LINK_MODE_MASK(adv_tmp);
|
2018-07-13 03:32:53 +08:00
|
|
|
|
|
|
|
if (phydev->autoneg != AUTONEG_ENABLE)
|
|
|
|
return 0;
|
|
|
|
|
2019-08-13 05:52:19 +08:00
|
|
|
if (linkmode_empty(phydev->adv_old))
|
|
|
|
return 0;
|
2018-07-13 03:32:53 +08:00
|
|
|
|
2019-08-13 05:52:19 +08:00
|
|
|
linkmode_copy(adv_tmp, phydev->advertising);
|
|
|
|
linkmode_copy(phydev->advertising, phydev->adv_old);
|
|
|
|
linkmode_zero(phydev->adv_old);
|
2018-11-11 06:43:33 +08:00
|
|
|
|
2019-08-13 05:52:19 +08:00
|
|
|
if (linkmode_equal(phydev->advertising, adv_tmp))
|
2018-07-13 03:32:53 +08:00
|
|
|
return 0;
|
|
|
|
|
|
|
|
return phy_config_aneg(phydev);
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(phy_speed_up);
|
|
|
|
|
2007-03-06 18:41:48 +08:00
|
|
|
/**
|
|
|
|
* phy_start_machine - start PHY state machine tracking
|
|
|
|
* @phydev: the phy_device struct
|
2005-07-31 07:31:23 +08:00
|
|
|
*
|
2007-03-06 18:41:48 +08:00
|
|
|
* Description: The PHY infrastructure can run a state machine
|
2005-07-31 07:31:23 +08:00
|
|
|
* which tracks whether the PHY is starting up, negotiating,
|
2017-07-27 03:05:38 +08:00
|
|
|
* etc. This function starts the delayed workqueue which tracks
|
|
|
|
* the state of the PHY. If you want to maintain your own state machine,
|
2014-01-05 08:27:17 +08:00
|
|
|
* do not call this function.
|
2007-03-06 18:41:48 +08:00
|
|
|
*/
|
2014-01-05 08:27:17 +08:00
|
|
|
void phy_start_machine(struct phy_device *phydev)
|
2005-07-31 07:31:23 +08:00
|
|
|
{
|
2018-10-12 01:31:47 +08:00
|
|
|
phy_trigger_machine(phydev);
|
2005-07-31 07:31:23 +08:00
|
|
|
}
|
2017-07-25 22:03:03 +08:00
|
|
|
EXPORT_SYMBOL_GPL(phy_start_machine);
|
2005-07-31 07:31:23 +08:00
|
|
|
|
2007-03-06 18:41:48 +08:00
|
|
|
/**
|
|
|
|
* phy_stop_machine - stop the PHY state machine tracking
|
|
|
|
* @phydev: target phy_device struct
|
2005-07-31 07:31:23 +08:00
|
|
|
*
|
2017-07-27 03:05:38 +08:00
|
|
|
* Description: Stops the state machine delayed workqueue, sets the
|
|
|
|
* state to UP (unless it wasn't up yet). This function must be
|
|
|
|
* called BEFORE phy_detach.
|
2005-07-31 07:31:23 +08:00
|
|
|
*/
|
|
|
|
void phy_stop_machine(struct phy_device *phydev)
|
|
|
|
{
|
2009-03-14 06:41:19 +08:00
|
|
|
cancel_delayed_work_sync(&phydev->state_queue);
|
2005-07-31 07:31:23 +08:00
|
|
|
|
2008-01-30 00:05:09 +08:00
|
|
|
mutex_lock(&phydev->lock);
|
2019-02-14 03:11:40 +08:00
|
|
|
if (phy_is_started(phydev))
|
2005-07-31 07:31:23 +08:00
|
|
|
phydev->state = PHY_UP;
|
2008-01-30 00:05:09 +08:00
|
|
|
mutex_unlock(&phydev->lock);
|
2005-07-31 07:31:23 +08:00
|
|
|
}
|
|
|
|
|
2007-03-06 18:41:48 +08:00
|
|
|
/**
|
|
|
|
* phy_error - enter HALTED state for this PHY device
|
|
|
|
* @phydev: target phy_device struct
|
2005-07-31 07:31:23 +08:00
|
|
|
*
|
|
|
|
* Moves the PHY to the HALTED state in response to a read
|
|
|
|
* or write error, and tells the controller the link is down.
|
|
|
|
* Must not be called from interrupt context, or while the
|
|
|
|
* phydev->lock is held.
|
|
|
|
*/
|
2008-05-03 02:00:51 +08:00
|
|
|
static void phy_error(struct phy_device *phydev)
|
2005-07-31 07:31:23 +08:00
|
|
|
{
|
2018-12-17 02:18:26 +08:00
|
|
|
WARN_ON(1);
|
|
|
|
|
2008-01-30 00:05:09 +08:00
|
|
|
mutex_lock(&phydev->lock);
|
2005-07-31 07:31:23 +08:00
|
|
|
phydev->state = PHY_HALTED;
|
2008-01-30 00:05:09 +08:00
|
|
|
mutex_unlock(&phydev->lock);
|
net: phy: Trigger state machine on state change and not polling.
The phy_start() is used to indicate the PHY is now ready to do its
work. The state is changed, normally to PHY_UP which means that both
the MAC and the PHY are ready.
If the phy driver is using polling, when the next poll happens, the
state machine notices the PHY is now in PHY_UP, and kicks off
auto-negotiation, if needed.
If however, the PHY is using interrupts, there is no polling. The phy
is stuck in PHY_UP until the next interrupt comes along. And there is
no reason for the PHY to interrupt.
Have phy_start() schedule the state machine to run, which both speeds
up the polling use case, and makes the interrupt use case actually
work.
This problems exists whenever there is a state change which will not
cause an interrupt. Trigger the state machine in these cases,
e.g. phy_error().
Signed-off-by: Andrew Lunn <andrew@lunn.ch>
Cc: Kyle Roeschley <kyle.roeschley@ni.com>
Tested-by: Kyle Roeschley <kyle.roeschley@ni.com>
Signed-off-by: David S. Miller <davem@davemloft.net>
2016-10-13 04:14:53 +08:00
|
|
|
|
2018-09-28 14:51:09 +08:00
|
|
|
phy_trigger_machine(phydev);
|
2005-07-31 07:31:23 +08:00
|
|
|
}
|
|
|
|
|
2018-03-09 06:23:03 +08:00
|
|
|
/**
|
|
|
|
* phy_disable_interrupts - Disable the PHY interrupts from the PHY side
|
|
|
|
* @phydev: target phy_device struct
|
|
|
|
*/
|
|
|
|
static int phy_disable_interrupts(struct phy_device *phydev)
|
|
|
|
{
|
|
|
|
int err;
|
|
|
|
|
|
|
|
/* Disable PHY interrupts */
|
|
|
|
err = phy_config_interrupt(phydev, PHY_INTERRUPT_DISABLED);
|
|
|
|
if (err)
|
2018-03-23 23:24:57 +08:00
|
|
|
return err;
|
2018-03-09 06:23:03 +08:00
|
|
|
|
|
|
|
/* Clear the interrupt */
|
2018-03-23 23:24:57 +08:00
|
|
|
return phy_clear_interrupt(phydev);
|
2018-03-09 06:23:03 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
2018-11-10 01:58:01 +08:00
|
|
|
* phy_interrupt - PHY interrupt handler
|
|
|
|
* @irq: interrupt line
|
|
|
|
* @phy_dat: phy_device pointer
|
|
|
|
*
|
|
|
|
* Description: Handle PHY interrupt
|
2018-03-09 06:23:03 +08:00
|
|
|
*/
|
2018-11-10 01:58:01 +08:00
|
|
|
static irqreturn_t phy_interrupt(int irq, void *phy_dat)
|
2018-03-09 06:23:03 +08:00
|
|
|
{
|
2018-11-10 01:58:01 +08:00
|
|
|
struct phy_device *phydev = phy_dat;
|
2020-03-17 05:32:33 +08:00
|
|
|
struct phy_driver *drv = phydev->drv;
|
2018-03-09 06:23:03 +08:00
|
|
|
|
2020-03-17 05:32:33 +08:00
|
|
|
if (drv->handle_interrupt)
|
|
|
|
return drv->handle_interrupt(phydev);
|
|
|
|
|
|
|
|
if (drv->did_interrupt && !drv->did_interrupt(phydev))
|
2018-11-10 01:58:01 +08:00
|
|
|
return IRQ_NONE;
|
2018-03-09 06:23:03 +08:00
|
|
|
|
2020-03-17 05:32:33 +08:00
|
|
|
/* reschedule state queue work to run as soon as possible */
|
|
|
|
phy_trigger_machine(phydev);
|
2018-03-09 06:23:03 +08:00
|
|
|
|
2020-03-02 04:36:09 +08:00
|
|
|
/* did_interrupt() may have cleared the interrupt already */
|
2020-03-17 05:32:33 +08:00
|
|
|
if (!drv->did_interrupt && phy_clear_interrupt(phydev)) {
|
|
|
|
phy_error(phydev);
|
|
|
|
return IRQ_NONE;
|
|
|
|
}
|
2018-03-09 06:23:03 +08:00
|
|
|
|
2020-03-17 05:32:33 +08:00
|
|
|
return IRQ_HANDLED;
|
2018-03-09 06:23:03 +08:00
|
|
|
}
|
|
|
|
|
2007-03-06 18:41:48 +08:00
|
|
|
/**
|
|
|
|
* phy_enable_interrupts - Enable the interrupts from the PHY side
|
|
|
|
* @phydev: target phy_device struct
|
|
|
|
*/
|
2010-10-21 16:37:41 +08:00
|
|
|
static int phy_enable_interrupts(struct phy_device *phydev)
|
2005-07-31 07:31:23 +08:00
|
|
|
{
|
2014-01-05 08:23:19 +08:00
|
|
|
int err = phy_clear_interrupt(phydev);
|
2005-07-31 07:31:23 +08:00
|
|
|
|
2005-08-25 07:46:21 +08:00
|
|
|
if (err < 0)
|
|
|
|
return err;
|
2005-07-31 07:31:23 +08:00
|
|
|
|
2014-01-05 08:23:19 +08:00
|
|
|
return phy_config_interrupt(phydev, PHY_INTERRUPT_ENABLED);
|
2005-07-31 07:31:23 +08:00
|
|
|
}
|
|
|
|
|
2007-03-06 18:41:48 +08:00
|
|
|
/**
|
2019-05-30 21:09:15 +08:00
|
|
|
* phy_request_interrupt - request and enable interrupt for a PHY device
|
2007-03-06 18:41:48 +08:00
|
|
|
* @phydev: target phy_device struct
|
2005-08-25 07:46:21 +08:00
|
|
|
*
|
2019-05-30 21:09:15 +08:00
|
|
|
* Description: Request and enable the interrupt for the given PHY.
|
2007-03-06 18:41:48 +08:00
|
|
|
* If this fails, then we set irq to PHY_POLL.
|
2005-08-25 07:46:21 +08:00
|
|
|
* This should only be called with a valid IRQ number.
|
|
|
|
*/
|
2019-01-23 14:31:58 +08:00
|
|
|
void phy_request_interrupt(struct phy_device *phydev)
|
2005-08-25 07:46:21 +08:00
|
|
|
{
|
2019-01-23 14:31:58 +08:00
|
|
|
int err;
|
|
|
|
|
|
|
|
err = request_threaded_irq(phydev->irq, NULL, phy_interrupt,
|
|
|
|
IRQF_ONESHOT | IRQF_SHARED,
|
|
|
|
phydev_name(phydev), phydev);
|
|
|
|
if (err) {
|
|
|
|
phydev_warn(phydev, "Error %d requesting IRQ %d, falling back to polling\n",
|
|
|
|
err, phydev->irq);
|
2005-08-25 07:46:21 +08:00
|
|
|
phydev->irq = PHY_POLL;
|
2019-05-30 21:09:15 +08:00
|
|
|
} else {
|
|
|
|
if (phy_enable_interrupts(phydev)) {
|
|
|
|
phydev_warn(phydev, "Can't enable interrupt, falling back to polling\n");
|
|
|
|
phy_free_interrupt(phydev);
|
|
|
|
phydev->irq = PHY_POLL;
|
|
|
|
}
|
2005-08-25 07:46:21 +08:00
|
|
|
}
|
|
|
|
}
|
2019-01-23 14:31:58 +08:00
|
|
|
EXPORT_SYMBOL(phy_request_interrupt);
|
2005-08-25 07:46:21 +08:00
|
|
|
|
2019-05-30 21:09:15 +08:00
|
|
|
/**
|
|
|
|
* phy_free_interrupt - disable and free interrupt for a PHY device
|
|
|
|
* @phydev: target phy_device struct
|
|
|
|
*
|
|
|
|
* Description: Disable and free the interrupt for the given PHY.
|
|
|
|
* This should only be called with a valid IRQ number.
|
|
|
|
*/
|
|
|
|
void phy_free_interrupt(struct phy_device *phydev)
|
|
|
|
{
|
|
|
|
phy_disable_interrupts(phydev);
|
|
|
|
free_irq(phydev->irq, phydev);
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(phy_free_interrupt);
|
|
|
|
|
2007-03-06 18:41:48 +08:00
|
|
|
/**
|
|
|
|
* phy_stop - Bring down the PHY link, and stop checking the status
|
|
|
|
* @phydev: target phy_device struct
|
|
|
|
*/
|
2005-08-25 07:46:21 +08:00
|
|
|
void phy_stop(struct phy_device *phydev)
|
|
|
|
{
|
2019-02-14 03:11:40 +08:00
|
|
|
if (!phy_is_started(phydev)) {
|
2018-12-17 01:30:14 +08:00
|
|
|
WARN(1, "called from state %s\n",
|
|
|
|
phy_state_to_str(phydev->state));
|
|
|
|
return;
|
|
|
|
}
|
2005-08-25 07:46:21 +08:00
|
|
|
|
2019-02-14 03:11:40 +08:00
|
|
|
mutex_lock(&phydev->lock);
|
|
|
|
|
2019-11-16 03:56:51 +08:00
|
|
|
if (phydev->sfp_bus)
|
|
|
|
sfp_upstream_stop(phydev->sfp_bus);
|
|
|
|
|
2007-09-29 13:42:15 +08:00
|
|
|
phydev->state = PHY_HALTED;
|
|
|
|
|
2008-01-30 00:05:09 +08:00
|
|
|
mutex_unlock(&phydev->lock);
|
2006-10-03 23:18:35 +08:00
|
|
|
|
2018-09-19 03:56:32 +08:00
|
|
|
phy_state_machine(&phydev->state_queue.work);
|
2019-01-18 03:08:39 +08:00
|
|
|
phy_stop_machine(phydev);
|
2018-09-19 03:56:32 +08:00
|
|
|
|
2014-01-05 08:17:06 +08:00
|
|
|
/* Cannot call flush_scheduled_work() here as desired because
|
2018-11-10 01:58:01 +08:00
|
|
|
* of rtnl_lock(), but PHY_HALTED shall guarantee irq handler
|
2006-10-03 23:18:35 +08:00
|
|
|
* will not reenable interrupts.
|
|
|
|
*/
|
2005-08-25 07:46:21 +08:00
|
|
|
}
|
2014-01-05 08:17:06 +08:00
|
|
|
EXPORT_SYMBOL(phy_stop);
|
2005-08-25 07:46:21 +08:00
|
|
|
|
2007-03-06 18:41:48 +08:00
|
|
|
/**
|
|
|
|
* phy_start - start or restart a PHY device
|
|
|
|
* @phydev: target phy_device struct
|
2005-08-25 07:46:21 +08:00
|
|
|
*
|
2007-03-06 18:41:48 +08:00
|
|
|
* Description: Indicates the attached device's readiness to
|
2005-08-25 07:46:21 +08:00
|
|
|
* handle PHY-related work. Used during startup to start the
|
|
|
|
* PHY, and after a call to phy_stop() to resume operation.
|
|
|
|
* Also used to indicate the MDIO bus has cleared an error
|
|
|
|
* condition.
|
|
|
|
*/
|
|
|
|
void phy_start(struct phy_device *phydev)
|
|
|
|
{
|
2008-01-30 00:05:09 +08:00
|
|
|
mutex_lock(&phydev->lock);
|
2005-08-25 07:46:21 +08:00
|
|
|
|
2019-01-23 14:30:38 +08:00
|
|
|
if (phydev->state != PHY_READY && phydev->state != PHY_HALTED) {
|
|
|
|
WARN(1, "called from state %s\n",
|
|
|
|
phy_state_to_str(phydev->state));
|
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
|
2019-11-16 03:56:51 +08:00
|
|
|
if (phydev->sfp_bus)
|
|
|
|
sfp_upstream_start(phydev->sfp_bus);
|
|
|
|
|
2019-01-23 14:31:23 +08:00
|
|
|
/* if phy was suspended, bring the physical link up again */
|
|
|
|
__phy_resume(phydev);
|
2015-05-18 11:38:38 +08:00
|
|
|
|
2019-05-02 04:14:21 +08:00
|
|
|
phydev->state = PHY_UP;
|
2019-01-23 14:31:23 +08:00
|
|
|
|
|
|
|
phy_start_machine(phydev);
|
2019-01-23 14:30:38 +08:00
|
|
|
out:
|
2008-01-30 00:05:09 +08:00
|
|
|
mutex_unlock(&phydev->lock);
|
2005-08-25 07:46:21 +08:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(phy_start);
|
2005-08-11 14:07:25 +08:00
|
|
|
|
2008-01-30 00:05:09 +08:00
|
|
|
/**
|
|
|
|
* phy_state_machine - Handle the state machine
|
|
|
|
* @work: work_struct that describes the work to be done
|
|
|
|
*/
|
2010-01-18 13:37:16 +08:00
|
|
|
void phy_state_machine(struct work_struct *work)
|
2005-07-31 07:31:23 +08:00
|
|
|
{
|
2009-04-03 07:56:54 +08:00
|
|
|
struct delayed_work *dwork = to_delayed_work(work);
|
2008-01-30 00:05:09 +08:00
|
|
|
struct phy_device *phydev =
|
2009-03-14 06:41:19 +08:00
|
|
|
container_of(dwork, struct phy_device, state_queue);
|
2015-05-18 11:38:38 +08:00
|
|
|
bool needs_aneg = false, do_suspend = false;
|
2015-05-17 01:17:56 +08:00
|
|
|
enum phy_state old_state;
|
2005-07-31 07:31:23 +08:00
|
|
|
int err = 0;
|
|
|
|
|
2008-01-30 00:05:09 +08:00
|
|
|
mutex_lock(&phydev->lock);
|
2005-07-31 07:31:23 +08:00
|
|
|
|
2015-05-17 01:17:56 +08:00
|
|
|
old_state = phydev->state;
|
|
|
|
|
2013-12-18 13:38:12 +08:00
|
|
|
switch (phydev->state) {
|
|
|
|
case PHY_DOWN:
|
|
|
|
case PHY_READY:
|
|
|
|
break;
|
|
|
|
case PHY_UP:
|
2014-05-15 13:35:34 +08:00
|
|
|
needs_aneg = true;
|
2005-07-31 07:31:23 +08:00
|
|
|
|
2013-12-18 13:38:12 +08:00
|
|
|
break;
|
|
|
|
case PHY_NOLINK:
|
2018-11-08 03:47:53 +08:00
|
|
|
case PHY_RUNNING:
|
|
|
|
err = phy_check_link_status(phydev);
|
2013-12-18 13:38:12 +08:00
|
|
|
break;
|
|
|
|
case PHY_HALTED:
|
|
|
|
if (phydev->link) {
|
|
|
|
phydev->link = 0;
|
2017-07-25 22:02:58 +08:00
|
|
|
phy_link_down(phydev, true);
|
2013-12-18 13:38:12 +08:00
|
|
|
}
|
2019-08-28 09:34:47 +08:00
|
|
|
do_suspend = true;
|
2013-12-18 13:38:12 +08:00
|
|
|
break;
|
2005-07-31 07:31:23 +08:00
|
|
|
}
|
|
|
|
|
2008-01-30 00:05:09 +08:00
|
|
|
mutex_unlock(&phydev->lock);
|
2005-07-31 07:31:23 +08:00
|
|
|
|
|
|
|
if (needs_aneg)
|
2018-10-16 03:25:13 +08:00
|
|
|
err = phy_start_aneg(phydev);
|
2014-05-15 13:35:34 +08:00
|
|
|
else if (do_suspend)
|
2013-12-13 17:20:29 +08:00
|
|
|
phy_suspend(phydev);
|
|
|
|
|
2005-07-31 07:31:23 +08:00
|
|
|
if (err < 0)
|
|
|
|
phy_error(phydev);
|
|
|
|
|
2019-03-20 02:56:51 +08:00
|
|
|
if (old_state != phydev->state) {
|
2017-07-28 19:18:30 +08:00
|
|
|
phydev_dbg(phydev, "PHY state change %s -> %s\n",
|
|
|
|
phy_state_to_str(old_state),
|
|
|
|
phy_state_to_str(phydev->state));
|
2019-03-20 02:56:51 +08:00
|
|
|
if (phydev->drv && phydev->drv->link_change_notify)
|
|
|
|
phydev->drv->link_change_notify(phydev);
|
|
|
|
}
|
2015-05-17 01:17:56 +08:00
|
|
|
|
2016-01-19 11:33:06 +08:00
|
|
|
/* Only re-schedule a PHY state machine change if we are polling the
|
|
|
|
* PHY, if PHY_IGNORE_INTERRUPT is set, then we will be moving
|
2018-09-21 04:34:25 +08:00
|
|
|
* between states from phy_mac_interrupt().
|
|
|
|
*
|
|
|
|
* In state PHY_HALTED the PHY gets suspended, so rescheduling the
|
|
|
|
* state machine would be pointless and possibly error prone when
|
|
|
|
* called from phy_disconnect() synchronously.
|
2016-01-19 11:33:06 +08:00
|
|
|
*/
|
2019-02-14 03:12:54 +08:00
|
|
|
mutex_lock(&phydev->lock);
|
2018-12-17 01:30:14 +08:00
|
|
|
if (phy_polling_mode(phydev) && phy_is_started(phydev))
|
2018-09-28 14:51:09 +08:00
|
|
|
phy_queue_state_machine(phydev, PHY_STATE_TIME);
|
2019-02-14 03:12:54 +08:00
|
|
|
mutex_unlock(&phydev->lock);
|
2008-01-30 00:05:09 +08:00
|
|
|
}
|
2012-06-28 05:14:38 +08:00
|
|
|
|
2016-10-17 01:56:51 +08:00
|
|
|
/**
|
|
|
|
* phy_mac_interrupt - MAC says the link has changed
|
|
|
|
* @phydev: phy_device struct with changed link
|
|
|
|
*
|
2018-01-11 04:21:31 +08:00
|
|
|
* The MAC layer is able to indicate there has been a change in the PHY link
|
|
|
|
* status. Trigger the state machine and work a work queue.
|
2016-10-17 01:56:51 +08:00
|
|
|
*/
|
2018-01-11 04:21:31 +08:00
|
|
|
void phy_mac_interrupt(struct phy_device *phydev)
|
2013-05-20 06:53:43 +08:00
|
|
|
{
|
2016-01-19 11:33:07 +08:00
|
|
|
/* Trigger a state machine change */
|
2018-11-10 01:56:52 +08:00
|
|
|
phy_trigger_machine(phydev);
|
2013-05-20 06:53:43 +08:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(phy_mac_interrupt);
|
|
|
|
|
2018-11-11 06:43:33 +08:00
|
|
|
static void mmd_eee_adv_to_linkmode(unsigned long *advertising, u16 eee_adv)
|
|
|
|
{
|
|
|
|
linkmode_zero(advertising);
|
|
|
|
|
|
|
|
if (eee_adv & MDIO_EEE_100TX)
|
|
|
|
linkmode_set_bit(ETHTOOL_LINK_MODE_100baseT_Full_BIT,
|
|
|
|
advertising);
|
|
|
|
if (eee_adv & MDIO_EEE_1000T)
|
|
|
|
linkmode_set_bit(ETHTOOL_LINK_MODE_1000baseT_Full_BIT,
|
|
|
|
advertising);
|
|
|
|
if (eee_adv & MDIO_EEE_10GT)
|
|
|
|
linkmode_set_bit(ETHTOOL_LINK_MODE_10000baseT_Full_BIT,
|
|
|
|
advertising);
|
|
|
|
if (eee_adv & MDIO_EEE_1000KX)
|
|
|
|
linkmode_set_bit(ETHTOOL_LINK_MODE_1000baseKX_Full_BIT,
|
|
|
|
advertising);
|
|
|
|
if (eee_adv & MDIO_EEE_10GKX4)
|
|
|
|
linkmode_set_bit(ETHTOOL_LINK_MODE_10000baseKX4_Full_BIT,
|
|
|
|
advertising);
|
|
|
|
if (eee_adv & MDIO_EEE_10GKR)
|
|
|
|
linkmode_set_bit(ETHTOOL_LINK_MODE_10000baseKR_Full_BIT,
|
|
|
|
advertising);
|
|
|
|
}
|
|
|
|
|
2012-06-28 05:14:38 +08:00
|
|
|
/**
|
|
|
|
* phy_init_eee - init and check the EEE feature
|
|
|
|
* @phydev: target phy_device struct
|
|
|
|
* @clk_stop_enable: PHY may stop the clock during LPI
|
|
|
|
*
|
|
|
|
* Description: it checks if the Energy-Efficient Ethernet (EEE)
|
|
|
|
* is supported by looking at the MMD registers 3.20 and 7.60/61
|
|
|
|
* and it programs the MMD register 3.0 setting the "Clock stop enable"
|
|
|
|
* bit if required.
|
|
|
|
*/
|
|
|
|
int phy_init_eee(struct phy_device *phydev, bool clk_stop_enable)
|
|
|
|
{
|
2017-02-18 08:07:34 +08:00
|
|
|
if (!phydev->drv)
|
|
|
|
return -EIO;
|
|
|
|
|
2012-06-28 05:14:38 +08:00
|
|
|
/* According to 802.3az,the EEE is supported only in full duplex-mode.
|
|
|
|
*/
|
2017-03-31 17:37:18 +08:00
|
|
|
if (phydev->duplex == DUPLEX_FULL) {
|
2018-11-11 06:43:33 +08:00
|
|
|
__ETHTOOL_DECLARE_LINK_MODE_MASK(common);
|
|
|
|
__ETHTOOL_DECLARE_LINK_MODE_MASK(lp);
|
|
|
|
__ETHTOOL_DECLARE_LINK_MODE_MASK(adv);
|
2012-06-28 05:14:38 +08:00
|
|
|
int eee_lp, eee_cap, eee_adv;
|
2014-03-05 08:35:44 +08:00
|
|
|
int status;
|
2018-11-11 06:43:33 +08:00
|
|
|
u32 cap;
|
2012-06-28 05:14:38 +08:00
|
|
|
|
|
|
|
/* Read phy status to properly get the right settings */
|
|
|
|
status = phy_read_status(phydev);
|
|
|
|
if (status)
|
|
|
|
return status;
|
|
|
|
|
|
|
|
/* First check if the EEE ability is supported */
|
2017-03-22 00:36:53 +08:00
|
|
|
eee_cap = phy_read_mmd(phydev, MDIO_MMD_PCS, MDIO_PCS_EEE_ABLE);
|
2014-08-26 15:26:52 +08:00
|
|
|
if (eee_cap <= 0)
|
|
|
|
goto eee_exit_err;
|
2012-06-28 05:14:38 +08:00
|
|
|
|
2012-08-20 12:55:29 +08:00
|
|
|
cap = mmd_eee_cap_to_ethtool_sup_t(eee_cap);
|
2012-06-28 05:14:38 +08:00
|
|
|
if (!cap)
|
2014-08-26 15:26:52 +08:00
|
|
|
goto eee_exit_err;
|
2012-06-28 05:14:38 +08:00
|
|
|
|
|
|
|
/* Check which link settings negotiated and verify it in
|
|
|
|
* the EEE advertising registers.
|
|
|
|
*/
|
2017-03-22 00:36:53 +08:00
|
|
|
eee_lp = phy_read_mmd(phydev, MDIO_MMD_AN, MDIO_AN_EEE_LPABLE);
|
2014-08-26 15:26:52 +08:00
|
|
|
if (eee_lp <= 0)
|
|
|
|
goto eee_exit_err;
|
2012-06-28 05:14:38 +08:00
|
|
|
|
2017-03-22 00:36:53 +08:00
|
|
|
eee_adv = phy_read_mmd(phydev, MDIO_MMD_AN, MDIO_AN_EEE_ADV);
|
2014-08-26 15:26:52 +08:00
|
|
|
if (eee_adv <= 0)
|
|
|
|
goto eee_exit_err;
|
2012-06-28 05:14:38 +08:00
|
|
|
|
2018-11-11 06:43:33 +08:00
|
|
|
mmd_eee_adv_to_linkmode(adv, eee_adv);
|
|
|
|
mmd_eee_adv_to_linkmode(lp, eee_lp);
|
|
|
|
linkmode_and(common, adv, lp);
|
|
|
|
|
|
|
|
if (!phy_check_valid(phydev->speed, phydev->duplex, common))
|
2014-08-26 15:26:52 +08:00
|
|
|
goto eee_exit_err;
|
2012-06-28 05:14:38 +08:00
|
|
|
|
2019-02-06 14:38:43 +08:00
|
|
|
if (clk_stop_enable)
|
2012-06-28 05:14:38 +08:00
|
|
|
/* Configure the PHY to stop receiving xMII
|
|
|
|
* clock while it is signaling LPI.
|
|
|
|
*/
|
2019-02-06 14:38:43 +08:00
|
|
|
phy_set_bits_mmd(phydev, MDIO_MMD_PCS, MDIO_CTRL1,
|
|
|
|
MDIO_PCS_CTRL1_CLKSTOP_EN);
|
2012-06-28 05:14:38 +08:00
|
|
|
|
2014-01-05 08:21:52 +08:00
|
|
|
return 0; /* EEE supported */
|
2012-06-28 05:14:38 +08:00
|
|
|
}
|
2014-08-26 15:26:52 +08:00
|
|
|
eee_exit_err:
|
2014-01-05 08:21:52 +08:00
|
|
|
return -EPROTONOSUPPORT;
|
2012-06-28 05:14:38 +08:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(phy_init_eee);
|
|
|
|
|
|
|
|
/**
|
|
|
|
* phy_get_eee_err - report the EEE wake error count
|
|
|
|
* @phydev: target phy_device struct
|
|
|
|
*
|
|
|
|
* Description: it is to report the number of time where the PHY
|
|
|
|
* failed to complete its normal wake sequence.
|
|
|
|
*/
|
|
|
|
int phy_get_eee_err(struct phy_device *phydev)
|
|
|
|
{
|
2017-02-18 08:07:34 +08:00
|
|
|
if (!phydev->drv)
|
|
|
|
return -EIO;
|
|
|
|
|
2017-03-22 00:36:53 +08:00
|
|
|
return phy_read_mmd(phydev, MDIO_MMD_PCS, MDIO_PCS_EEE_WK_ERR);
|
2012-06-28 05:14:38 +08:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(phy_get_eee_err);
|
|
|
|
|
|
|
|
/**
|
|
|
|
* phy_ethtool_get_eee - get EEE supported and status
|
|
|
|
* @phydev: target phy_device struct
|
|
|
|
* @data: ethtool_eee data
|
|
|
|
*
|
|
|
|
* Description: it reportes the Supported/Advertisement/LP Advertisement
|
|
|
|
* capabilities.
|
|
|
|
*/
|
|
|
|
int phy_ethtool_get_eee(struct phy_device *phydev, struct ethtool_eee *data)
|
|
|
|
{
|
|
|
|
int val;
|
|
|
|
|
2017-02-18 08:07:34 +08:00
|
|
|
if (!phydev->drv)
|
|
|
|
return -EIO;
|
|
|
|
|
2012-06-28 05:14:38 +08:00
|
|
|
/* Get Supported EEE */
|
2017-03-22 00:36:53 +08:00
|
|
|
val = phy_read_mmd(phydev, MDIO_MMD_PCS, MDIO_PCS_EEE_ABLE);
|
2012-06-28 05:14:38 +08:00
|
|
|
if (val < 0)
|
|
|
|
return val;
|
2012-08-20 12:55:29 +08:00
|
|
|
data->supported = mmd_eee_cap_to_ethtool_sup_t(val);
|
2012-06-28 05:14:38 +08:00
|
|
|
|
|
|
|
/* Get advertisement EEE */
|
2017-03-22 00:36:53 +08:00
|
|
|
val = phy_read_mmd(phydev, MDIO_MMD_AN, MDIO_AN_EEE_ADV);
|
2012-06-28 05:14:38 +08:00
|
|
|
if (val < 0)
|
|
|
|
return val;
|
2012-08-20 12:55:29 +08:00
|
|
|
data->advertised = mmd_eee_adv_to_ethtool_adv_t(val);
|
2018-11-28 05:30:14 +08:00
|
|
|
data->eee_enabled = !!data->advertised;
|
2012-06-28 05:14:38 +08:00
|
|
|
|
|
|
|
/* Get LP advertisement EEE */
|
2017-03-22 00:36:53 +08:00
|
|
|
val = phy_read_mmd(phydev, MDIO_MMD_AN, MDIO_AN_EEE_LPABLE);
|
2012-06-28 05:14:38 +08:00
|
|
|
if (val < 0)
|
|
|
|
return val;
|
2012-08-20 12:55:29 +08:00
|
|
|
data->lp_advertised = mmd_eee_adv_to_ethtool_adv_t(val);
|
2012-06-28 05:14:38 +08:00
|
|
|
|
2018-11-28 05:30:14 +08:00
|
|
|
data->eee_active = !!(data->advertised & data->lp_advertised);
|
|
|
|
|
2012-06-28 05:14:38 +08:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(phy_ethtool_get_eee);
|
|
|
|
|
|
|
|
/**
|
|
|
|
* phy_ethtool_set_eee - set EEE supported and status
|
|
|
|
* @phydev: target phy_device struct
|
|
|
|
* @data: ethtool_eee data
|
|
|
|
*
|
|
|
|
* Description: it is to program the Advertisement EEE register.
|
|
|
|
*/
|
|
|
|
int phy_ethtool_set_eee(struct phy_device *phydev, struct ethtool_eee *data)
|
|
|
|
{
|
2018-11-28 05:30:14 +08:00
|
|
|
int cap, old_adv, adv = 0, ret;
|
2012-06-28 05:14:38 +08:00
|
|
|
|
2017-02-18 08:07:34 +08:00
|
|
|
if (!phydev->drv)
|
|
|
|
return -EIO;
|
|
|
|
|
2017-03-31 17:37:07 +08:00
|
|
|
/* Get Supported EEE */
|
|
|
|
cap = phy_read_mmd(phydev, MDIO_MMD_PCS, MDIO_PCS_EEE_ABLE);
|
|
|
|
if (cap < 0)
|
|
|
|
return cap;
|
2016-11-28 17:46:46 +08:00
|
|
|
|
2017-03-31 17:37:12 +08:00
|
|
|
old_adv = phy_read_mmd(phydev, MDIO_MMD_AN, MDIO_AN_EEE_ADV);
|
|
|
|
if (old_adv < 0)
|
|
|
|
return old_adv;
|
|
|
|
|
2018-11-28 05:30:14 +08:00
|
|
|
if (data->eee_enabled) {
|
|
|
|
adv = !data->advertised ? cap :
|
|
|
|
ethtool_adv_to_mmd_eee_adv_t(data->advertised) & cap;
|
|
|
|
/* Mask prohibited EEE modes */
|
|
|
|
adv &= ~phydev->eee_broken_modes;
|
|
|
|
}
|
2017-03-31 17:37:07 +08:00
|
|
|
|
2017-03-31 17:37:12 +08:00
|
|
|
if (old_adv != adv) {
|
|
|
|
ret = phy_write_mmd(phydev, MDIO_MMD_AN, MDIO_AN_EEE_ADV, adv);
|
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
/* Restart autonegotiation so the new modes get sent to the
|
|
|
|
* link partner.
|
|
|
|
*/
|
2020-05-13 03:45:53 +08:00
|
|
|
if (phydev->autoneg == AUTONEG_ENABLE) {
|
|
|
|
ret = phy_restart_aneg(phydev);
|
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
|
|
|
}
|
2017-03-31 17:37:12 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
2012-06-28 05:14:38 +08:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(phy_ethtool_set_eee);
|
2013-03-11 21:56:44 +08:00
|
|
|
|
|
|
|
int phy_ethtool_set_wol(struct phy_device *phydev, struct ethtool_wolinfo *wol)
|
|
|
|
{
|
2017-02-18 08:07:34 +08:00
|
|
|
if (phydev->drv && phydev->drv->set_wol)
|
2013-03-11 21:56:44 +08:00
|
|
|
return phydev->drv->set_wol(phydev, wol);
|
|
|
|
|
|
|
|
return -EOPNOTSUPP;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(phy_ethtool_set_wol);
|
|
|
|
|
|
|
|
void phy_ethtool_get_wol(struct phy_device *phydev, struct ethtool_wolinfo *wol)
|
|
|
|
{
|
2017-02-18 08:07:34 +08:00
|
|
|
if (phydev->drv && phydev->drv->get_wol)
|
2013-03-11 21:56:44 +08:00
|
|
|
phydev->drv->get_wol(phydev, wol);
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(phy_ethtool_get_wol);
|
2016-05-10 06:19:41 +08:00
|
|
|
|
|
|
|
int phy_ethtool_get_link_ksettings(struct net_device *ndev,
|
|
|
|
struct ethtool_link_ksettings *cmd)
|
|
|
|
{
|
|
|
|
struct phy_device *phydev = ndev->phydev;
|
|
|
|
|
|
|
|
if (!phydev)
|
|
|
|
return -ENODEV;
|
|
|
|
|
2017-06-13 15:09:46 +08:00
|
|
|
phy_ethtool_ksettings_get(phydev, cmd);
|
|
|
|
|
|
|
|
return 0;
|
2016-05-10 06:19:41 +08:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(phy_ethtool_get_link_ksettings);
|
|
|
|
|
|
|
|
int phy_ethtool_set_link_ksettings(struct net_device *ndev,
|
|
|
|
const struct ethtool_link_ksettings *cmd)
|
|
|
|
{
|
|
|
|
struct phy_device *phydev = ndev->phydev;
|
|
|
|
|
|
|
|
if (!phydev)
|
|
|
|
return -ENODEV;
|
|
|
|
|
|
|
|
return phy_ethtool_ksettings_set(phydev, cmd);
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(phy_ethtool_set_link_ksettings);
|
2016-11-16 02:06:30 +08:00
|
|
|
|
|
|
|
int phy_ethtool_nway_reset(struct net_device *ndev)
|
|
|
|
{
|
|
|
|
struct phy_device *phydev = ndev->phydev;
|
|
|
|
|
|
|
|
if (!phydev)
|
|
|
|
return -ENODEV;
|
|
|
|
|
2017-02-18 08:07:34 +08:00
|
|
|
if (!phydev->drv)
|
|
|
|
return -EIO;
|
|
|
|
|
2017-06-05 19:23:00 +08:00
|
|
|
return phy_restart_aneg(phydev);
|
2016-11-16 02:06:30 +08:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(phy_ethtool_nway_reset);
|