2019-05-19 20:08:55 +08:00
|
|
|
// SPDX-License-Identifier: GPL-2.0-only
|
2017-07-25 22:03:18 +08:00
|
|
|
#include <linux/export.h>
|
|
|
|
#include <linux/kref.h>
|
|
|
|
#include <linux/list.h>
|
|
|
|
#include <linux/mutex.h>
|
|
|
|
#include <linux/phylink.h>
|
2019-10-15 18:38:39 +08:00
|
|
|
#include <linux/property.h>
|
2017-07-25 22:03:18 +08:00
|
|
|
#include <linux/rtnetlink.h>
|
|
|
|
#include <linux/slab.h>
|
|
|
|
|
|
|
|
#include "sfp.h"
|
|
|
|
|
2019-11-20 19:42:42 +08:00
|
|
|
struct sfp_quirk {
|
|
|
|
const char *vendor;
|
|
|
|
const char *part;
|
|
|
|
void (*modes)(const struct sfp_eeprom_id *id, unsigned long *modes);
|
|
|
|
};
|
|
|
|
|
2017-12-01 18:24:53 +08:00
|
|
|
/**
|
|
|
|
* struct sfp_bus - internal representation of a sfp bus
|
|
|
|
*/
|
2017-07-25 22:03:18 +08:00
|
|
|
struct sfp_bus {
|
2017-12-01 18:24:53 +08:00
|
|
|
/* private: */
|
2017-07-25 22:03:18 +08:00
|
|
|
struct kref kref;
|
|
|
|
struct list_head node;
|
2017-12-01 18:25:03 +08:00
|
|
|
struct fwnode_handle *fwnode;
|
2017-07-25 22:03:18 +08:00
|
|
|
|
|
|
|
const struct sfp_socket_ops *socket_ops;
|
|
|
|
struct device *sfp_dev;
|
|
|
|
struct sfp *sfp;
|
2019-11-20 19:42:42 +08:00
|
|
|
const struct sfp_quirk *sfp_quirk;
|
2017-07-25 22:03:18 +08:00
|
|
|
|
|
|
|
const struct sfp_upstream_ops *upstream_ops;
|
|
|
|
void *upstream;
|
|
|
|
struct phy_device *phydev;
|
|
|
|
|
|
|
|
bool registered;
|
|
|
|
bool started;
|
|
|
|
};
|
|
|
|
|
2019-11-20 19:42:47 +08:00
|
|
|
static void sfp_quirk_2500basex(const struct sfp_eeprom_id *id,
|
|
|
|
unsigned long *modes)
|
|
|
|
{
|
|
|
|
phylink_set(modes, 2500baseX_Full);
|
|
|
|
}
|
|
|
|
|
2019-11-20 19:42:42 +08:00
|
|
|
static const struct sfp_quirk sfp_quirks[] = {
|
2019-11-20 19:42:47 +08:00
|
|
|
{
|
|
|
|
// Alcatel Lucent G-010S-P can operate at 2500base-X, but
|
|
|
|
// incorrectly report 2500MBd NRZ in their EEPROM
|
|
|
|
.vendor = "ALCATELLUCENT",
|
|
|
|
.part = "G010SP",
|
|
|
|
.modes = sfp_quirk_2500basex,
|
|
|
|
}, {
|
|
|
|
// Alcatel Lucent G-010S-A can operate at 2500base-X, but
|
|
|
|
// report 3.2GBd NRZ in their EEPROM
|
|
|
|
.vendor = "ALCATELLUCENT",
|
|
|
|
.part = "3FE46541AA",
|
|
|
|
.modes = sfp_quirk_2500basex,
|
|
|
|
}, {
|
|
|
|
// Huawei MA5671A can operate at 2500base-X, but report 1.2GBd
|
|
|
|
// NRZ in their EEPROM
|
|
|
|
.vendor = "HUAWEI",
|
|
|
|
.part = "MA5671A",
|
|
|
|
.modes = sfp_quirk_2500basex,
|
|
|
|
},
|
2019-11-20 19:42:42 +08:00
|
|
|
};
|
|
|
|
|
|
|
|
static size_t sfp_strlen(const char *str, size_t maxlen)
|
|
|
|
{
|
|
|
|
size_t size, i;
|
|
|
|
|
|
|
|
/* Trailing characters should be filled with space chars */
|
|
|
|
for (i = 0, size = 0; i < maxlen; i++)
|
|
|
|
if (str[i] != ' ')
|
|
|
|
size = i + 1;
|
|
|
|
|
|
|
|
return size;
|
|
|
|
}
|
|
|
|
|
|
|
|
static bool sfp_match(const char *qs, const char *str, size_t len)
|
|
|
|
{
|
|
|
|
if (!qs)
|
|
|
|
return true;
|
|
|
|
if (strlen(qs) != len)
|
|
|
|
return false;
|
|
|
|
return !strncmp(qs, str, len);
|
|
|
|
}
|
|
|
|
|
|
|
|
static const struct sfp_quirk *sfp_lookup_quirk(const struct sfp_eeprom_id *id)
|
|
|
|
{
|
|
|
|
const struct sfp_quirk *q;
|
|
|
|
unsigned int i;
|
|
|
|
size_t vs, ps;
|
|
|
|
|
|
|
|
vs = sfp_strlen(id->base.vendor_name, ARRAY_SIZE(id->base.vendor_name));
|
|
|
|
ps = sfp_strlen(id->base.vendor_pn, ARRAY_SIZE(id->base.vendor_pn));
|
|
|
|
|
|
|
|
for (i = 0, q = sfp_quirks; i < ARRAY_SIZE(sfp_quirks); i++, q++)
|
|
|
|
if (sfp_match(q->vendor, id->base.vendor_name, vs) &&
|
|
|
|
sfp_match(q->part, id->base.vendor_pn, ps))
|
|
|
|
return q;
|
|
|
|
|
|
|
|
return NULL;
|
|
|
|
}
|
2019-12-11 18:56:45 +08:00
|
|
|
|
2017-12-01 18:24:53 +08:00
|
|
|
/**
|
|
|
|
* sfp_parse_port() - Parse the EEPROM base ID, setting the port type
|
|
|
|
* @bus: a pointer to the &struct sfp_bus structure for the sfp module
|
|
|
|
* @id: a pointer to the module's &struct sfp_eeprom_id
|
|
|
|
* @support: optional pointer to an array of unsigned long for the
|
|
|
|
* ethtool support mask
|
|
|
|
*
|
|
|
|
* Parse the EEPROM identification given in @id, and return one of
|
|
|
|
* %PORT_TP, %PORT_FIBRE or %PORT_OTHER. If @support is non-%NULL,
|
|
|
|
* also set the ethtool %ETHTOOL_LINK_MODE_xxx_BIT corresponding with
|
|
|
|
* the connector type.
|
|
|
|
*
|
|
|
|
* If the port type is not known, returns %PORT_OTHER.
|
|
|
|
*/
|
2017-07-25 22:03:18 +08:00
|
|
|
int sfp_parse_port(struct sfp_bus *bus, const struct sfp_eeprom_id *id,
|
|
|
|
unsigned long *support)
|
|
|
|
{
|
|
|
|
int port;
|
|
|
|
|
|
|
|
/* port is the physical connector, set this from the connector field. */
|
|
|
|
switch (id->base.connector) {
|
2019-12-11 18:56:04 +08:00
|
|
|
case SFF8024_CONNECTOR_SC:
|
|
|
|
case SFF8024_CONNECTOR_FIBERJACK:
|
|
|
|
case SFF8024_CONNECTOR_LC:
|
|
|
|
case SFF8024_CONNECTOR_MT_RJ:
|
|
|
|
case SFF8024_CONNECTOR_MU:
|
|
|
|
case SFF8024_CONNECTOR_OPTICAL_PIGTAIL:
|
|
|
|
case SFF8024_CONNECTOR_MPO_1X12:
|
|
|
|
case SFF8024_CONNECTOR_MPO_2X16:
|
2017-07-25 22:03:18 +08:00
|
|
|
port = PORT_FIBRE;
|
|
|
|
break;
|
|
|
|
|
2019-12-11 18:56:04 +08:00
|
|
|
case SFF8024_CONNECTOR_RJ45:
|
2017-07-25 22:03:18 +08:00
|
|
|
port = PORT_TP;
|
|
|
|
break;
|
|
|
|
|
2019-12-11 18:56:04 +08:00
|
|
|
case SFF8024_CONNECTOR_COPPER_PIGTAIL:
|
2017-12-29 20:15:28 +08:00
|
|
|
port = PORT_DA;
|
|
|
|
break;
|
|
|
|
|
2019-12-11 18:56:04 +08:00
|
|
|
case SFF8024_CONNECTOR_UNSPEC:
|
2017-07-25 22:03:18 +08:00
|
|
|
if (id->base.e1000_base_t) {
|
|
|
|
port = PORT_TP;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
/* fallthrough */
|
2019-12-11 18:56:04 +08:00
|
|
|
case SFF8024_CONNECTOR_SG: /* guess */
|
|
|
|
case SFF8024_CONNECTOR_HSSDC_II:
|
|
|
|
case SFF8024_CONNECTOR_NOSEPARATE:
|
|
|
|
case SFF8024_CONNECTOR_MXC_2X16:
|
2017-07-25 22:03:18 +08:00
|
|
|
port = PORT_OTHER;
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
dev_warn(bus->sfp_dev, "SFP: unknown connector id 0x%02x\n",
|
|
|
|
id->base.connector);
|
|
|
|
port = PORT_OTHER;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
2017-12-29 20:15:28 +08:00
|
|
|
if (support) {
|
|
|
|
switch (port) {
|
|
|
|
case PORT_FIBRE:
|
|
|
|
phylink_set(support, FIBRE);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case PORT_TP:
|
|
|
|
phylink_set(support, TP);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-07-25 22:03:18 +08:00
|
|
|
return port;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(sfp_parse_port);
|
|
|
|
|
2019-12-11 18:56:45 +08:00
|
|
|
/**
|
|
|
|
* sfp_may_have_phy() - indicate whether the module may have a PHY
|
|
|
|
* @bus: a pointer to the &struct sfp_bus structure for the sfp module
|
|
|
|
* @id: a pointer to the module's &struct sfp_eeprom_id
|
|
|
|
*
|
|
|
|
* Parse the EEPROM identification given in @id, and return whether
|
|
|
|
* this module may have a PHY.
|
|
|
|
*/
|
|
|
|
bool sfp_may_have_phy(struct sfp_bus *bus, const struct sfp_eeprom_id *id)
|
|
|
|
{
|
|
|
|
if (id->base.e1000_base_t)
|
|
|
|
return true;
|
|
|
|
|
|
|
|
if (id->base.phys_id != SFF8024_ID_DWDM_SFP) {
|
|
|
|
switch (id->base.extended_cc) {
|
|
|
|
case SFF8024_ECC_10GBASE_T_SFI:
|
|
|
|
case SFF8024_ECC_10GBASE_T_SR:
|
|
|
|
case SFF8024_ECC_5GBASE_T:
|
|
|
|
case SFF8024_ECC_2_5GBASE_T:
|
|
|
|
return true;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
return false;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(sfp_may_have_phy);
|
|
|
|
|
2017-12-01 18:24:53 +08:00
|
|
|
/**
|
|
|
|
* sfp_parse_support() - Parse the eeprom id for supported link modes
|
|
|
|
* @bus: a pointer to the &struct sfp_bus structure for the sfp module
|
|
|
|
* @id: a pointer to the module's &struct sfp_eeprom_id
|
|
|
|
* @support: pointer to an array of unsigned long for the ethtool support mask
|
|
|
|
*
|
|
|
|
* Parse the EEPROM identification information and derive the supported
|
|
|
|
* ethtool link modes for the module.
|
|
|
|
*/
|
2017-07-25 22:03:18 +08:00
|
|
|
void sfp_parse_support(struct sfp_bus *bus, const struct sfp_eeprom_id *id,
|
|
|
|
unsigned long *support)
|
|
|
|
{
|
2017-12-29 20:15:23 +08:00
|
|
|
unsigned int br_min, br_nom, br_max;
|
2018-02-27 23:52:57 +08:00
|
|
|
__ETHTOOL_DECLARE_LINK_MODE_MASK(modes) = { 0, };
|
2017-07-25 22:03:18 +08:00
|
|
|
|
2017-12-29 20:15:23 +08:00
|
|
|
/* Decode the bitrate information to MBd */
|
|
|
|
br_min = br_nom = br_max = 0;
|
|
|
|
if (id->base.br_nominal) {
|
|
|
|
if (id->base.br_nominal != 255) {
|
|
|
|
br_nom = id->base.br_nominal * 100;
|
2018-05-04 23:10:54 +08:00
|
|
|
br_min = br_nom - id->base.br_nominal * id->ext.br_min;
|
2017-12-29 20:15:23 +08:00
|
|
|
br_max = br_nom + id->base.br_nominal * id->ext.br_max;
|
|
|
|
} else if (id->ext.br_max) {
|
|
|
|
br_nom = 250 * id->ext.br_max;
|
|
|
|
br_max = br_nom + br_nom * id->ext.br_min / 100;
|
|
|
|
br_min = br_nom - br_nom * id->ext.br_min / 100;
|
|
|
|
}
|
net: phy: sfp: handle cases where neither BR, min nor BR, max is given
When computing the bitrate using values read from an SFP module EEPROM,
we use the nominal BR plus BR,min and BR,max to determine the
boundaries. But in some cases BR,min and BR,max aren't provided, which
led the SFP code to end up having the nominal value for both the minimum
and maximum bitrate values. When using a passive cable, the nominal
value should be used as the maximum one, and there is no minimum one
so we should use 0.
Signed-off-by: Antoine Tenart <antoine.tenart@bootlin.com>
Acked-by: Russell King <rmk+kernel@armlinux.org.uk>
Signed-off-by: David S. Miller <davem@davemloft.net>
2018-05-04 23:21:03 +08:00
|
|
|
|
|
|
|
/* When using passive cables, in case neither BR,min nor BR,max
|
|
|
|
* are specified, set br_min to 0 as the nominal value is then
|
|
|
|
* used as the maximum.
|
|
|
|
*/
|
|
|
|
if (br_min == br_max && id->base.sfp_ct_passive)
|
|
|
|
br_min = 0;
|
2017-12-29 20:15:23 +08:00
|
|
|
}
|
|
|
|
|
2017-07-25 22:03:18 +08:00
|
|
|
/* Set ethtool support from the compliance fields. */
|
|
|
|
if (id->base.e10g_base_sr)
|
2018-02-27 23:52:57 +08:00
|
|
|
phylink_set(modes, 10000baseSR_Full);
|
2017-07-25 22:03:18 +08:00
|
|
|
if (id->base.e10g_base_lr)
|
2018-02-27 23:52:57 +08:00
|
|
|
phylink_set(modes, 10000baseLR_Full);
|
2017-07-25 22:03:18 +08:00
|
|
|
if (id->base.e10g_base_lrm)
|
2018-02-27 23:52:57 +08:00
|
|
|
phylink_set(modes, 10000baseLRM_Full);
|
2017-07-25 22:03:18 +08:00
|
|
|
if (id->base.e10g_base_er)
|
2018-02-27 23:52:57 +08:00
|
|
|
phylink_set(modes, 10000baseER_Full);
|
2017-07-25 22:03:18 +08:00
|
|
|
if (id->base.e1000_base_sx ||
|
|
|
|
id->base.e1000_base_lx ||
|
|
|
|
id->base.e1000_base_cx)
|
2018-02-27 23:52:57 +08:00
|
|
|
phylink_set(modes, 1000baseX_Full);
|
2017-07-25 22:03:18 +08:00
|
|
|
if (id->base.e1000_base_t) {
|
2018-02-27 23:52:57 +08:00
|
|
|
phylink_set(modes, 1000baseT_Half);
|
|
|
|
phylink_set(modes, 1000baseT_Full);
|
2017-07-25 22:03:18 +08:00
|
|
|
}
|
|
|
|
|
2017-12-29 20:15:23 +08:00
|
|
|
/* 1000Base-PX or 1000Base-BX10 */
|
|
|
|
if ((id->base.e_base_px || id->base.e_base_bx10) &&
|
|
|
|
br_min <= 1300 && br_max >= 1200)
|
2018-11-29 18:40:11 +08:00
|
|
|
phylink_set(modes, 1000baseX_Full);
|
2017-12-29 20:15:23 +08:00
|
|
|
|
2017-12-29 20:15:28 +08:00
|
|
|
/* For active or passive cables, select the link modes
|
|
|
|
* based on the bit rates and the cable compliance bytes.
|
|
|
|
*/
|
|
|
|
if ((id->base.sfp_ct_passive || id->base.sfp_ct_active) && br_nom) {
|
|
|
|
/* This may look odd, but some manufacturers use 12000MBd */
|
|
|
|
if (br_min <= 12000 && br_max >= 10300)
|
2018-02-27 23:52:57 +08:00
|
|
|
phylink_set(modes, 10000baseCR_Full);
|
2017-12-29 20:15:28 +08:00
|
|
|
if (br_min <= 3200 && br_max >= 3100)
|
2018-02-27 23:52:57 +08:00
|
|
|
phylink_set(modes, 2500baseX_Full);
|
2017-12-29 20:15:28 +08:00
|
|
|
if (br_min <= 1300 && br_max >= 1200)
|
2018-02-27 23:52:57 +08:00
|
|
|
phylink_set(modes, 1000baseX_Full);
|
2017-12-29 20:15:28 +08:00
|
|
|
}
|
|
|
|
if (id->base.sfp_ct_passive) {
|
|
|
|
if (id->base.passive.sff8431_app_e)
|
2018-02-27 23:52:57 +08:00
|
|
|
phylink_set(modes, 10000baseCR_Full);
|
2017-12-29 20:15:28 +08:00
|
|
|
}
|
|
|
|
if (id->base.sfp_ct_active) {
|
|
|
|
if (id->base.active.sff8431_app_e ||
|
|
|
|
id->base.active.sff8431_lim) {
|
2018-02-27 23:52:57 +08:00
|
|
|
phylink_set(modes, 10000baseCR_Full);
|
2017-12-29 20:15:28 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-07-25 22:03:18 +08:00
|
|
|
switch (id->base.extended_cc) {
|
2019-12-11 18:56:04 +08:00
|
|
|
case SFF8024_ECC_UNSPEC:
|
2017-07-25 22:03:18 +08:00
|
|
|
break;
|
2019-12-11 18:56:04 +08:00
|
|
|
case SFF8024_ECC_100GBASE_SR4_25GBASE_SR:
|
2018-02-27 23:52:57 +08:00
|
|
|
phylink_set(modes, 100000baseSR4_Full);
|
|
|
|
phylink_set(modes, 25000baseSR_Full);
|
2017-07-25 22:03:18 +08:00
|
|
|
break;
|
2019-12-11 18:56:04 +08:00
|
|
|
case SFF8024_ECC_100GBASE_LR4_25GBASE_LR:
|
|
|
|
case SFF8024_ECC_100GBASE_ER4_25GBASE_ER:
|
2018-02-27 23:52:57 +08:00
|
|
|
phylink_set(modes, 100000baseLR4_ER4_Full);
|
2017-07-25 22:03:18 +08:00
|
|
|
break;
|
2019-12-11 18:56:04 +08:00
|
|
|
case SFF8024_ECC_100GBASE_CR4:
|
2018-02-27 23:52:57 +08:00
|
|
|
phylink_set(modes, 100000baseCR4_Full);
|
2019-12-11 18:56:04 +08:00
|
|
|
/* fallthrough */
|
|
|
|
case SFF8024_ECC_25GBASE_CR_S:
|
|
|
|
case SFF8024_ECC_25GBASE_CR_N:
|
2018-02-27 23:52:57 +08:00
|
|
|
phylink_set(modes, 25000baseCR_Full);
|
2017-07-25 22:03:18 +08:00
|
|
|
break;
|
2019-12-11 18:56:04 +08:00
|
|
|
case SFF8024_ECC_10GBASE_T_SFI:
|
|
|
|
case SFF8024_ECC_10GBASE_T_SR:
|
|
|
|
phylink_set(modes, 10000baseT_Full);
|
|
|
|
break;
|
|
|
|
case SFF8024_ECC_5GBASE_T:
|
|
|
|
phylink_set(modes, 5000baseT_Full);
|
|
|
|
break;
|
|
|
|
case SFF8024_ECC_2_5GBASE_T:
|
|
|
|
phylink_set(modes, 2500baseT_Full);
|
|
|
|
break;
|
2017-07-25 22:03:18 +08:00
|
|
|
default:
|
|
|
|
dev_warn(bus->sfp_dev,
|
|
|
|
"Unknown/unsupported extended compliance code: 0x%02x\n",
|
|
|
|
id->base.extended_cc);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* For fibre channel SFP, derive possible BaseX modes */
|
|
|
|
if (id->base.fc_speed_100 ||
|
|
|
|
id->base.fc_speed_200 ||
|
|
|
|
id->base.fc_speed_400) {
|
|
|
|
if (id->base.br_nominal >= 31)
|
2018-02-27 23:52:57 +08:00
|
|
|
phylink_set(modes, 2500baseX_Full);
|
2017-07-25 22:03:18 +08:00
|
|
|
if (id->base.br_nominal >= 12)
|
2018-02-27 23:52:57 +08:00
|
|
|
phylink_set(modes, 1000baseX_Full);
|
2017-07-25 22:03:18 +08:00
|
|
|
}
|
2018-02-27 23:52:57 +08:00
|
|
|
|
|
|
|
/* If we haven't discovered any modes that this module supports, try
|
|
|
|
* the encoding and bitrate to determine supported modes. Some BiDi
|
|
|
|
* modules (eg, 1310nm/1550nm) are not 1000BASE-BX compliant due to
|
|
|
|
* the differing wavelengths, so do not set any transceiver bits.
|
|
|
|
*/
|
|
|
|
if (bitmap_empty(modes, __ETHTOOL_LINK_MODE_MASK_NBITS)) {
|
|
|
|
/* If the encoding and bit rate allows 1000baseX */
|
2019-12-11 18:56:04 +08:00
|
|
|
if (id->base.encoding == SFF8024_ENCODING_8B10B && br_nom &&
|
2018-02-27 23:52:57 +08:00
|
|
|
br_min <= 1300 && br_max >= 1200)
|
|
|
|
phylink_set(modes, 1000baseX_Full);
|
|
|
|
}
|
|
|
|
|
2019-11-20 19:42:42 +08:00
|
|
|
if (bus->sfp_quirk)
|
|
|
|
bus->sfp_quirk->modes(id, modes);
|
|
|
|
|
2018-02-27 23:52:57 +08:00
|
|
|
bitmap_or(support, support, modes, __ETHTOOL_LINK_MODE_MASK_NBITS);
|
|
|
|
|
|
|
|
phylink_set(support, Autoneg);
|
|
|
|
phylink_set(support, Pause);
|
|
|
|
phylink_set(support, Asym_Pause);
|
2017-07-25 22:03:18 +08:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(sfp_parse_support);
|
|
|
|
|
2018-02-27 23:53:02 +08:00
|
|
|
/**
|
|
|
|
* sfp_select_interface() - Select appropriate phy_interface_t mode
|
|
|
|
* @bus: a pointer to the &struct sfp_bus structure for the sfp module
|
|
|
|
* @link_modes: ethtool link modes mask
|
|
|
|
*
|
2019-12-11 18:55:59 +08:00
|
|
|
* Derive the phy_interface_t mode for the SFP module from the link
|
|
|
|
* modes mask.
|
2018-02-27 23:53:02 +08:00
|
|
|
*/
|
|
|
|
phy_interface_t sfp_select_interface(struct sfp_bus *bus,
|
|
|
|
unsigned long *link_modes)
|
|
|
|
{
|
|
|
|
if (phylink_test(link_modes, 10000baseCR_Full) ||
|
|
|
|
phylink_test(link_modes, 10000baseSR_Full) ||
|
|
|
|
phylink_test(link_modes, 10000baseLR_Full) ||
|
|
|
|
phylink_test(link_modes, 10000baseLRM_Full) ||
|
2019-12-11 18:56:04 +08:00
|
|
|
phylink_test(link_modes, 10000baseER_Full) ||
|
|
|
|
phylink_test(link_modes, 10000baseT_Full))
|
2020-01-04 04:43:23 +08:00
|
|
|
return PHY_INTERFACE_MODE_10GBASER;
|
2018-02-27 23:53:02 +08:00
|
|
|
|
|
|
|
if (phylink_test(link_modes, 2500baseX_Full))
|
|
|
|
return PHY_INTERFACE_MODE_2500BASEX;
|
|
|
|
|
2019-12-11 18:55:59 +08:00
|
|
|
if (phylink_test(link_modes, 1000baseT_Half) ||
|
|
|
|
phylink_test(link_modes, 1000baseT_Full))
|
2018-02-27 23:53:02 +08:00
|
|
|
return PHY_INTERFACE_MODE_SGMII;
|
|
|
|
|
|
|
|
if (phylink_test(link_modes, 1000baseX_Full))
|
|
|
|
return PHY_INTERFACE_MODE_1000BASEX;
|
|
|
|
|
|
|
|
dev_warn(bus->sfp_dev, "Unable to ascertain link mode\n");
|
|
|
|
|
|
|
|
return PHY_INTERFACE_MODE_NA;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(sfp_select_interface);
|
|
|
|
|
2017-07-25 22:03:18 +08:00
|
|
|
static LIST_HEAD(sfp_buses);
|
|
|
|
static DEFINE_MUTEX(sfp_mutex);
|
|
|
|
|
|
|
|
static const struct sfp_upstream_ops *sfp_get_upstream_ops(struct sfp_bus *bus)
|
|
|
|
{
|
|
|
|
return bus->registered ? bus->upstream_ops : NULL;
|
|
|
|
}
|
|
|
|
|
2017-12-01 18:25:03 +08:00
|
|
|
static struct sfp_bus *sfp_bus_get(struct fwnode_handle *fwnode)
|
2017-07-25 22:03:18 +08:00
|
|
|
{
|
|
|
|
struct sfp_bus *sfp, *new, *found = NULL;
|
|
|
|
|
|
|
|
new = kzalloc(sizeof(*new), GFP_KERNEL);
|
|
|
|
|
|
|
|
mutex_lock(&sfp_mutex);
|
|
|
|
|
|
|
|
list_for_each_entry(sfp, &sfp_buses, node) {
|
2017-12-01 18:25:03 +08:00
|
|
|
if (sfp->fwnode == fwnode) {
|
2017-07-25 22:03:18 +08:00
|
|
|
kref_get(&sfp->kref);
|
|
|
|
found = sfp;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!found && new) {
|
|
|
|
kref_init(&new->kref);
|
2017-12-01 18:25:03 +08:00
|
|
|
new->fwnode = fwnode;
|
2017-07-25 22:03:18 +08:00
|
|
|
list_add(&new->node, &sfp_buses);
|
|
|
|
found = new;
|
|
|
|
new = NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
mutex_unlock(&sfp_mutex);
|
|
|
|
|
|
|
|
kfree(new);
|
|
|
|
|
|
|
|
return found;
|
|
|
|
}
|
|
|
|
|
2017-12-01 18:24:58 +08:00
|
|
|
static void sfp_bus_release(struct kref *kref)
|
2017-07-25 22:03:18 +08:00
|
|
|
{
|
|
|
|
struct sfp_bus *bus = container_of(kref, struct sfp_bus, kref);
|
|
|
|
|
|
|
|
list_del(&bus->node);
|
|
|
|
mutex_unlock(&sfp_mutex);
|
|
|
|
kfree(bus);
|
|
|
|
}
|
|
|
|
|
2019-11-09 01:39:29 +08:00
|
|
|
/**
|
|
|
|
* sfp_bus_put() - put a reference on the &struct sfp_bus
|
2019-11-10 22:04:11 +08:00
|
|
|
* @bus: the &struct sfp_bus found via sfp_bus_find_fwnode()
|
2019-11-09 01:39:29 +08:00
|
|
|
*
|
|
|
|
* Put a reference on the &struct sfp_bus and free the underlying structure
|
|
|
|
* if this was the last reference.
|
|
|
|
*/
|
|
|
|
void sfp_bus_put(struct sfp_bus *bus)
|
2017-07-25 22:03:18 +08:00
|
|
|
{
|
2019-11-09 01:39:29 +08:00
|
|
|
if (bus)
|
|
|
|
kref_put_mutex(&bus->kref, sfp_bus_release, &sfp_mutex);
|
2017-07-25 22:03:18 +08:00
|
|
|
}
|
2019-11-09 01:39:29 +08:00
|
|
|
EXPORT_SYMBOL_GPL(sfp_bus_put);
|
2017-07-25 22:03:18 +08:00
|
|
|
|
|
|
|
static int sfp_register_bus(struct sfp_bus *bus)
|
|
|
|
{
|
|
|
|
const struct sfp_upstream_ops *ops = bus->upstream_ops;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
if (ops) {
|
|
|
|
if (ops->link_down)
|
|
|
|
ops->link_down(bus->upstream);
|
|
|
|
if (ops->connect_phy && bus->phydev) {
|
|
|
|
ret = ops->connect_phy(bus->upstream, bus->phydev);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
}
|
2019-11-09 01:39:29 +08:00
|
|
|
bus->registered = true;
|
2019-02-06 18:52:30 +08:00
|
|
|
bus->socket_ops->attach(bus->sfp);
|
2017-07-25 22:03:18 +08:00
|
|
|
if (bus->started)
|
|
|
|
bus->socket_ops->start(bus->sfp);
|
2019-05-28 17:57:34 +08:00
|
|
|
bus->upstream_ops->attach(bus->upstream, bus);
|
2017-07-25 22:03:18 +08:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void sfp_unregister_bus(struct sfp_bus *bus)
|
|
|
|
{
|
|
|
|
const struct sfp_upstream_ops *ops = bus->upstream_ops;
|
|
|
|
|
|
|
|
if (bus->registered) {
|
2019-05-28 17:57:34 +08:00
|
|
|
bus->upstream_ops->detach(bus->upstream, bus);
|
2017-07-25 22:03:18 +08:00
|
|
|
if (bus->started)
|
|
|
|
bus->socket_ops->stop(bus->sfp);
|
2019-02-06 18:52:30 +08:00
|
|
|
bus->socket_ops->detach(bus->sfp);
|
2017-07-25 22:03:18 +08:00
|
|
|
if (bus->phydev && ops && ops->disconnect_phy)
|
|
|
|
ops->disconnect_phy(bus->upstream);
|
|
|
|
}
|
|
|
|
bus->registered = false;
|
|
|
|
}
|
|
|
|
|
2017-12-01 18:24:53 +08:00
|
|
|
/**
|
|
|
|
* sfp_get_module_info() - Get the ethtool_modinfo for a SFP module
|
|
|
|
* @bus: a pointer to the &struct sfp_bus structure for the sfp module
|
|
|
|
* @modinfo: a &struct ethtool_modinfo
|
|
|
|
*
|
|
|
|
* Fill in the type and eeprom_len parameters in @modinfo for a module on
|
|
|
|
* the sfp bus specified by @bus.
|
|
|
|
*
|
|
|
|
* Returns 0 on success or a negative errno number.
|
|
|
|
*/
|
2017-07-25 22:03:18 +08:00
|
|
|
int sfp_get_module_info(struct sfp_bus *bus, struct ethtool_modinfo *modinfo)
|
|
|
|
{
|
|
|
|
return bus->socket_ops->module_info(bus->sfp, modinfo);
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(sfp_get_module_info);
|
|
|
|
|
2017-12-01 18:24:53 +08:00
|
|
|
/**
|
|
|
|
* sfp_get_module_eeprom() - Read the SFP module EEPROM
|
|
|
|
* @bus: a pointer to the &struct sfp_bus structure for the sfp module
|
|
|
|
* @ee: a &struct ethtool_eeprom
|
|
|
|
* @data: buffer to contain the EEPROM data (must be at least @ee->len bytes)
|
|
|
|
*
|
|
|
|
* Read the EEPROM as specified by the supplied @ee. See the documentation
|
|
|
|
* for &struct ethtool_eeprom for the region to be read.
|
|
|
|
*
|
|
|
|
* Returns 0 on success or a negative errno number.
|
|
|
|
*/
|
2017-07-25 22:03:18 +08:00
|
|
|
int sfp_get_module_eeprom(struct sfp_bus *bus, struct ethtool_eeprom *ee,
|
2017-10-31 12:42:57 +08:00
|
|
|
u8 *data)
|
2017-07-25 22:03:18 +08:00
|
|
|
{
|
|
|
|
return bus->socket_ops->module_eeprom(bus->sfp, ee, data);
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(sfp_get_module_eeprom);
|
|
|
|
|
2017-12-01 18:24:53 +08:00
|
|
|
/**
|
|
|
|
* sfp_upstream_start() - Inform the SFP that the network device is up
|
|
|
|
* @bus: a pointer to the &struct sfp_bus structure for the sfp module
|
|
|
|
*
|
|
|
|
* Inform the SFP socket that the network device is now up, so that the
|
|
|
|
* module can be enabled by allowing TX_DISABLE to be deasserted. This
|
|
|
|
* should be called from the network device driver's &struct net_device_ops
|
|
|
|
* ndo_open() method.
|
|
|
|
*/
|
2017-07-25 22:03:18 +08:00
|
|
|
void sfp_upstream_start(struct sfp_bus *bus)
|
|
|
|
{
|
|
|
|
if (bus->registered)
|
|
|
|
bus->socket_ops->start(bus->sfp);
|
|
|
|
bus->started = true;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(sfp_upstream_start);
|
|
|
|
|
2017-12-01 18:24:53 +08:00
|
|
|
/**
|
|
|
|
* sfp_upstream_stop() - Inform the SFP that the network device is down
|
|
|
|
* @bus: a pointer to the &struct sfp_bus structure for the sfp module
|
|
|
|
*
|
|
|
|
* Inform the SFP socket that the network device is now up, so that the
|
|
|
|
* module can be disabled by asserting TX_DISABLE, disabling the laser
|
|
|
|
* in optical modules. This should be called from the network device
|
|
|
|
* driver's &struct net_device_ops ndo_stop() method.
|
|
|
|
*/
|
2017-07-25 22:03:18 +08:00
|
|
|
void sfp_upstream_stop(struct sfp_bus *bus)
|
|
|
|
{
|
|
|
|
if (bus->registered)
|
|
|
|
bus->socket_ops->stop(bus->sfp);
|
|
|
|
bus->started = false;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(sfp_upstream_stop);
|
|
|
|
|
2018-07-10 19:05:31 +08:00
|
|
|
static void sfp_upstream_clear(struct sfp_bus *bus)
|
|
|
|
{
|
|
|
|
bus->upstream_ops = NULL;
|
|
|
|
bus->upstream = NULL;
|
|
|
|
}
|
|
|
|
|
2017-12-01 18:24:53 +08:00
|
|
|
/**
|
2019-11-09 01:39:29 +08:00
|
|
|
* sfp_bus_find_fwnode() - parse and locate the SFP bus from fwnode
|
2019-10-15 18:38:39 +08:00
|
|
|
* @fwnode: firmware node for the parent device (MAC or PHY)
|
2017-12-01 18:24:53 +08:00
|
|
|
*
|
2019-11-09 01:39:29 +08:00
|
|
|
* Parse the parent device's firmware node for a SFP bus, and locate
|
|
|
|
* the sfp_bus structure, incrementing its reference count. This must
|
|
|
|
* be put via sfp_bus_put() when done.
|
2017-12-01 18:24:53 +08:00
|
|
|
*
|
2020-03-17 22:54:19 +08:00
|
|
|
* Returns:
|
|
|
|
* - on success, a pointer to the sfp_bus structure,
|
|
|
|
* - %NULL if no SFP is specified,
|
|
|
|
* - on failure, an error pointer value:
|
|
|
|
*
|
|
|
|
* - corresponding to the errors detailed for
|
|
|
|
* fwnode_property_get_reference_args().
|
|
|
|
* - %-ENOMEM if we failed to allocate the bus.
|
|
|
|
* - an error from the upstream's connect_phy() method.
|
2017-12-01 18:24:53 +08:00
|
|
|
*/
|
2019-11-09 01:39:29 +08:00
|
|
|
struct sfp_bus *sfp_bus_find_fwnode(struct fwnode_handle *fwnode)
|
2017-07-25 22:03:18 +08:00
|
|
|
{
|
2019-10-15 18:38:39 +08:00
|
|
|
struct fwnode_reference_args ref;
|
|
|
|
struct sfp_bus *bus;
|
|
|
|
int ret;
|
2017-07-25 22:03:18 +08:00
|
|
|
|
2019-10-15 18:38:39 +08:00
|
|
|
ret = fwnode_property_get_reference_args(fwnode, "sfp", NULL,
|
|
|
|
0, 0, &ref);
|
|
|
|
if (ret == -ENOENT)
|
|
|
|
return NULL;
|
|
|
|
else if (ret < 0)
|
|
|
|
return ERR_PTR(ret);
|
2017-07-25 22:03:18 +08:00
|
|
|
|
2019-10-15 18:38:39 +08:00
|
|
|
bus = sfp_bus_get(ref.fwnode);
|
|
|
|
fwnode_handle_put(ref.fwnode);
|
|
|
|
if (!bus)
|
|
|
|
return ERR_PTR(-ENOMEM);
|
|
|
|
|
2019-11-09 01:39:29 +08:00
|
|
|
return bus;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(sfp_bus_find_fwnode);
|
|
|
|
|
|
|
|
/**
|
|
|
|
* sfp_bus_add_upstream() - parse and register the neighbouring device
|
|
|
|
* @bus: the &struct sfp_bus found via sfp_bus_find_fwnode()
|
|
|
|
* @upstream: the upstream private data
|
|
|
|
* @ops: the upstream's &struct sfp_upstream_ops
|
|
|
|
*
|
|
|
|
* Add upstream driver for the SFP bus, and if the bus is complete, register
|
|
|
|
* the SFP bus using sfp_register_upstream(). This takes a reference on the
|
|
|
|
* bus, so it is safe to put the bus after this call.
|
|
|
|
*
|
2020-03-17 22:54:19 +08:00
|
|
|
* Returns:
|
|
|
|
* - on success, a pointer to the sfp_bus structure,
|
|
|
|
* - %NULL if no SFP is specified,
|
|
|
|
* - on failure, an error pointer value:
|
|
|
|
*
|
|
|
|
* - corresponding to the errors detailed for
|
|
|
|
* fwnode_property_get_reference_args().
|
|
|
|
* - %-ENOMEM if we failed to allocate the bus.
|
|
|
|
* - an error from the upstream's connect_phy() method.
|
2019-11-09 01:39:29 +08:00
|
|
|
*/
|
|
|
|
int sfp_bus_add_upstream(struct sfp_bus *bus, void *upstream,
|
|
|
|
const struct sfp_upstream_ops *ops)
|
|
|
|
{
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
/* If no bus, return success */
|
|
|
|
if (!bus)
|
|
|
|
return 0;
|
|
|
|
|
2019-10-15 18:38:39 +08:00
|
|
|
rtnl_lock();
|
2019-11-09 01:39:29 +08:00
|
|
|
kref_get(&bus->kref);
|
2019-10-15 18:38:39 +08:00
|
|
|
bus->upstream_ops = ops;
|
|
|
|
bus->upstream = upstream;
|
|
|
|
|
|
|
|
if (bus->sfp) {
|
|
|
|
ret = sfp_register_bus(bus);
|
|
|
|
if (ret)
|
|
|
|
sfp_upstream_clear(bus);
|
|
|
|
} else {
|
|
|
|
ret = 0;
|
2017-07-25 22:03:18 +08:00
|
|
|
}
|
2019-10-15 18:38:39 +08:00
|
|
|
rtnl_unlock();
|
2017-07-25 22:03:18 +08:00
|
|
|
|
2019-11-09 01:39:29 +08:00
|
|
|
if (ret)
|
2017-07-25 22:03:18 +08:00
|
|
|
sfp_bus_put(bus);
|
|
|
|
|
2019-11-09 01:39:29 +08:00
|
|
|
return ret;
|
2017-07-25 22:03:18 +08:00
|
|
|
}
|
2019-11-09 01:39:29 +08:00
|
|
|
EXPORT_SYMBOL_GPL(sfp_bus_add_upstream);
|
2017-07-25 22:03:18 +08:00
|
|
|
|
2017-12-01 18:24:53 +08:00
|
|
|
/**
|
2019-11-09 01:39:29 +08:00
|
|
|
* sfp_bus_del_upstream() - Delete a sfp bus
|
2017-12-01 18:24:53 +08:00
|
|
|
* @bus: a pointer to the &struct sfp_bus structure for the sfp module
|
|
|
|
*
|
2019-11-09 01:39:29 +08:00
|
|
|
* Delete a previously registered upstream connection for the SFP
|
|
|
|
* module. @bus should have been added by sfp_bus_add_upstream().
|
2017-12-01 18:24:53 +08:00
|
|
|
*/
|
2019-11-09 01:39:29 +08:00
|
|
|
void sfp_bus_del_upstream(struct sfp_bus *bus)
|
2017-07-25 22:03:18 +08:00
|
|
|
{
|
2019-11-09 01:39:29 +08:00
|
|
|
if (bus) {
|
|
|
|
rtnl_lock();
|
|
|
|
if (bus->sfp)
|
|
|
|
sfp_unregister_bus(bus);
|
|
|
|
sfp_upstream_clear(bus);
|
|
|
|
rtnl_unlock();
|
2017-07-25 22:03:18 +08:00
|
|
|
|
2019-11-09 01:39:29 +08:00
|
|
|
sfp_bus_put(bus);
|
|
|
|
}
|
2017-07-25 22:03:18 +08:00
|
|
|
}
|
2019-11-09 01:39:29 +08:00
|
|
|
EXPORT_SYMBOL_GPL(sfp_bus_del_upstream);
|
2017-07-25 22:03:18 +08:00
|
|
|
|
|
|
|
/* Socket driver entry points */
|
|
|
|
int sfp_add_phy(struct sfp_bus *bus, struct phy_device *phydev)
|
|
|
|
{
|
|
|
|
const struct sfp_upstream_ops *ops = sfp_get_upstream_ops(bus);
|
|
|
|
int ret = 0;
|
|
|
|
|
|
|
|
if (ops && ops->connect_phy)
|
|
|
|
ret = ops->connect_phy(bus->upstream, phydev);
|
|
|
|
|
|
|
|
if (ret == 0)
|
|
|
|
bus->phydev = phydev;
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(sfp_add_phy);
|
|
|
|
|
|
|
|
void sfp_remove_phy(struct sfp_bus *bus)
|
|
|
|
{
|
|
|
|
const struct sfp_upstream_ops *ops = sfp_get_upstream_ops(bus);
|
|
|
|
|
|
|
|
if (ops && ops->disconnect_phy)
|
|
|
|
ops->disconnect_phy(bus->upstream);
|
|
|
|
bus->phydev = NULL;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(sfp_remove_phy);
|
|
|
|
|
|
|
|
void sfp_link_up(struct sfp_bus *bus)
|
|
|
|
{
|
|
|
|
const struct sfp_upstream_ops *ops = sfp_get_upstream_ops(bus);
|
|
|
|
|
|
|
|
if (ops && ops->link_up)
|
|
|
|
ops->link_up(bus->upstream);
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(sfp_link_up);
|
|
|
|
|
|
|
|
void sfp_link_down(struct sfp_bus *bus)
|
|
|
|
{
|
|
|
|
const struct sfp_upstream_ops *ops = sfp_get_upstream_ops(bus);
|
|
|
|
|
|
|
|
if (ops && ops->link_down)
|
|
|
|
ops->link_down(bus->upstream);
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(sfp_link_down);
|
|
|
|
|
|
|
|
int sfp_module_insert(struct sfp_bus *bus, const struct sfp_eeprom_id *id)
|
|
|
|
{
|
|
|
|
const struct sfp_upstream_ops *ops = sfp_get_upstream_ops(bus);
|
|
|
|
int ret = 0;
|
|
|
|
|
2019-11-20 19:42:42 +08:00
|
|
|
bus->sfp_quirk = sfp_lookup_quirk(id);
|
|
|
|
|
2017-07-25 22:03:18 +08:00
|
|
|
if (ops && ops->module_insert)
|
|
|
|
ret = ops->module_insert(bus->upstream, id);
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(sfp_module_insert);
|
|
|
|
|
|
|
|
void sfp_module_remove(struct sfp_bus *bus)
|
|
|
|
{
|
|
|
|
const struct sfp_upstream_ops *ops = sfp_get_upstream_ops(bus);
|
|
|
|
|
|
|
|
if (ops && ops->module_remove)
|
|
|
|
ops->module_remove(bus->upstream);
|
2019-11-20 19:42:42 +08:00
|
|
|
|
|
|
|
bus->sfp_quirk = NULL;
|
2017-07-25 22:03:18 +08:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(sfp_module_remove);
|
|
|
|
|
2019-12-11 18:56:09 +08:00
|
|
|
int sfp_module_start(struct sfp_bus *bus)
|
|
|
|
{
|
|
|
|
const struct sfp_upstream_ops *ops = sfp_get_upstream_ops(bus);
|
|
|
|
int ret = 0;
|
|
|
|
|
|
|
|
if (ops && ops->module_start)
|
|
|
|
ret = ops->module_start(bus->upstream);
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(sfp_module_start);
|
|
|
|
|
|
|
|
void sfp_module_stop(struct sfp_bus *bus)
|
|
|
|
{
|
|
|
|
const struct sfp_upstream_ops *ops = sfp_get_upstream_ops(bus);
|
|
|
|
|
|
|
|
if (ops && ops->module_stop)
|
|
|
|
ops->module_stop(bus->upstream);
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(sfp_module_stop);
|
|
|
|
|
2018-07-10 19:05:31 +08:00
|
|
|
static void sfp_socket_clear(struct sfp_bus *bus)
|
|
|
|
{
|
|
|
|
bus->sfp_dev = NULL;
|
|
|
|
bus->sfp = NULL;
|
|
|
|
bus->socket_ops = NULL;
|
|
|
|
}
|
|
|
|
|
2017-07-25 22:03:18 +08:00
|
|
|
struct sfp_bus *sfp_register_socket(struct device *dev, struct sfp *sfp,
|
|
|
|
const struct sfp_socket_ops *ops)
|
|
|
|
{
|
2017-12-01 18:25:03 +08:00
|
|
|
struct sfp_bus *bus = sfp_bus_get(dev->fwnode);
|
2017-07-25 22:03:18 +08:00
|
|
|
int ret = 0;
|
|
|
|
|
|
|
|
if (bus) {
|
|
|
|
rtnl_lock();
|
|
|
|
bus->sfp_dev = dev;
|
|
|
|
bus->sfp = sfp;
|
|
|
|
bus->socket_ops = ops;
|
|
|
|
|
2019-05-28 17:57:39 +08:00
|
|
|
if (bus->upstream_ops) {
|
2017-07-25 22:03:18 +08:00
|
|
|
ret = sfp_register_bus(bus);
|
2018-07-10 19:05:31 +08:00
|
|
|
if (ret)
|
|
|
|
sfp_socket_clear(bus);
|
|
|
|
}
|
2017-07-25 22:03:18 +08:00
|
|
|
rtnl_unlock();
|
|
|
|
}
|
|
|
|
|
|
|
|
if (ret) {
|
|
|
|
sfp_bus_put(bus);
|
|
|
|
bus = NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
return bus;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(sfp_register_socket);
|
|
|
|
|
|
|
|
void sfp_unregister_socket(struct sfp_bus *bus)
|
|
|
|
{
|
|
|
|
rtnl_lock();
|
2019-05-28 17:57:39 +08:00
|
|
|
if (bus->upstream_ops)
|
2017-12-27 07:15:17 +08:00
|
|
|
sfp_unregister_bus(bus);
|
2018-07-10 19:05:31 +08:00
|
|
|
sfp_socket_clear(bus);
|
2017-07-25 22:03:18 +08:00
|
|
|
rtnl_unlock();
|
|
|
|
|
|
|
|
sfp_bus_put(bus);
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(sfp_unregister_socket);
|