mirror of https://gitee.com/openkylin/linux.git
sfp: add sfp-bus to bridge between network devices and sfp cages
Signed-off-by: Russell King <rmk+kernel@armlinux.org.uk> Reviewed-by: Andrew Lunn <andrew@lunn.ch> Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
Russell King
David S. Miller
parent
9525ae8395
commit
ce0aa27ff3
|
|
@ -38,6 +38,9 @@ obj-$(CONFIG_MDIO_SUN4I) += mdio-sun4i.o
|
||||||
obj-$(CONFIG_MDIO_THUNDER) += mdio-thunder.o
|
obj-$(CONFIG_MDIO_THUNDER) += mdio-thunder.o
|
||||||
obj-$(CONFIG_MDIO_XGENE) += mdio-xgene.o
|
obj-$(CONFIG_MDIO_XGENE) += mdio-xgene.o
|
||||||
|
|
||||||
|
sfp-obj-$(CONFIG_SFP) += sfp-bus.o
|
||||||
|
obj-y += $(sfp-obj-y) $(sfp-obj-m)
|
||||||
|
|
||||||
obj-$(CONFIG_AMD_PHY) += amd.o
|
obj-$(CONFIG_AMD_PHY) += amd.o
|
||||||
obj-$(CONFIG_AQUANTIA_PHY) += aquantia.o
|
obj-$(CONFIG_AQUANTIA_PHY) += aquantia.o
|
||||||
obj-$(CONFIG_AT803X_PHY) += at803x.o
|
obj-$(CONFIG_AT803X_PHY) += at803x.o
|
||||||
|
|
|
||||||
|
|
@ -21,6 +21,7 @@
|
||||||
#include <linux/spinlock.h>
|
#include <linux/spinlock.h>
|
||||||
#include <linux/workqueue.h>
|
#include <linux/workqueue.h>
|
||||||
|
|
||||||
|
#include "sfp.h"
|
||||||
#include "swphy.h"
|
#include "swphy.h"
|
||||||
|
|
||||||
#define SUPPORTED_INTERFACES \
|
#define SUPPORTED_INTERFACES \
|
||||||
|
|
@ -32,6 +33,7 @@
|
||||||
|
|
||||||
enum {
|
enum {
|
||||||
PHYLINK_DISABLE_STOPPED,
|
PHYLINK_DISABLE_STOPPED,
|
||||||
|
PHYLINK_DISABLE_LINK,
|
||||||
};
|
};
|
||||||
|
|
||||||
struct phylink {
|
struct phylink {
|
||||||
|
|
@ -54,6 +56,8 @@ struct phylink {
|
||||||
struct work_struct resolve;
|
struct work_struct resolve;
|
||||||
|
|
||||||
bool mac_link_dropped;
|
bool mac_link_dropped;
|
||||||
|
|
||||||
|
struct sfp_bus *sfp_bus;
|
||||||
};
|
};
|
||||||
|
|
||||||
static inline void linkmode_zero(unsigned long *dst)
|
static inline void linkmode_zero(unsigned long *dst)
|
||||||
|
|
@ -466,6 +470,24 @@ static void phylink_run_resolve(struct phylink *pl)
|
||||||
queue_work(system_power_efficient_wq, &pl->resolve);
|
queue_work(system_power_efficient_wq, &pl->resolve);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static const struct sfp_upstream_ops sfp_phylink_ops;
|
||||||
|
|
||||||
|
static int phylink_register_sfp(struct phylink *pl, struct device_node *np)
|
||||||
|
{
|
||||||
|
struct device_node *sfp_np;
|
||||||
|
|
||||||
|
sfp_np = of_parse_phandle(np, "sfp", 0);
|
||||||
|
if (!sfp_np)
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
pl->sfp_bus = sfp_register_upstream(sfp_np, pl->netdev, pl,
|
||||||
|
&sfp_phylink_ops);
|
||||||
|
if (!pl->sfp_bus)
|
||||||
|
return -ENOMEM;
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
struct phylink *phylink_create(struct net_device *ndev, struct device_node *np,
|
struct phylink *phylink_create(struct net_device *ndev, struct device_node *np,
|
||||||
phy_interface_t iface, const struct phylink_mac_ops *ops)
|
phy_interface_t iface, const struct phylink_mac_ops *ops)
|
||||||
{
|
{
|
||||||
|
|
@ -507,12 +529,21 @@ struct phylink *phylink_create(struct net_device *ndev, struct device_node *np,
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
ret = phylink_register_sfp(pl, np);
|
||||||
|
if (ret < 0) {
|
||||||
|
kfree(pl);
|
||||||
|
return ERR_PTR(ret);
|
||||||
|
}
|
||||||
|
|
||||||
return pl;
|
return pl;
|
||||||
}
|
}
|
||||||
EXPORT_SYMBOL_GPL(phylink_create);
|
EXPORT_SYMBOL_GPL(phylink_create);
|
||||||
|
|
||||||
void phylink_destroy(struct phylink *pl)
|
void phylink_destroy(struct phylink *pl)
|
||||||
{
|
{
|
||||||
|
if (pl->sfp_bus)
|
||||||
|
sfp_unregister_upstream(pl->sfp_bus);
|
||||||
|
|
||||||
cancel_work_sync(&pl->resolve);
|
cancel_work_sync(&pl->resolve);
|
||||||
kfree(pl);
|
kfree(pl);
|
||||||
}
|
}
|
||||||
|
|
@ -706,6 +737,8 @@ void phylink_start(struct phylink *pl)
|
||||||
clear_bit(PHYLINK_DISABLE_STOPPED, &pl->phylink_disable_state);
|
clear_bit(PHYLINK_DISABLE_STOPPED, &pl->phylink_disable_state);
|
||||||
phylink_run_resolve(pl);
|
phylink_run_resolve(pl);
|
||||||
|
|
||||||
|
if (pl->sfp_bus)
|
||||||
|
sfp_upstream_start(pl->sfp_bus);
|
||||||
if (pl->phydev)
|
if (pl->phydev)
|
||||||
phy_start(pl->phydev);
|
phy_start(pl->phydev);
|
||||||
}
|
}
|
||||||
|
|
@ -717,6 +750,8 @@ void phylink_stop(struct phylink *pl)
|
||||||
|
|
||||||
if (pl->phydev)
|
if (pl->phydev)
|
||||||
phy_stop(pl->phydev);
|
phy_stop(pl->phydev);
|
||||||
|
if (pl->sfp_bus)
|
||||||
|
sfp_upstream_stop(pl->sfp_bus);
|
||||||
|
|
||||||
set_bit(PHYLINK_DISABLE_STOPPED, &pl->phylink_disable_state);
|
set_bit(PHYLINK_DISABLE_STOPPED, &pl->phylink_disable_state);
|
||||||
flush_work(&pl->resolve);
|
flush_work(&pl->resolve);
|
||||||
|
|
@ -1166,4 +1201,126 @@ int phylink_mii_ioctl(struct phylink *pl, struct ifreq *ifr, int cmd)
|
||||||
}
|
}
|
||||||
EXPORT_SYMBOL_GPL(phylink_mii_ioctl);
|
EXPORT_SYMBOL_GPL(phylink_mii_ioctl);
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
static int phylink_sfp_module_insert(void *upstream,
|
||||||
|
const struct sfp_eeprom_id *id)
|
||||||
|
{
|
||||||
|
struct phylink *pl = upstream;
|
||||||
|
__ETHTOOL_DECLARE_LINK_MODE_MASK(support) = { 0, };
|
||||||
|
struct phylink_link_state config;
|
||||||
|
phy_interface_t iface;
|
||||||
|
int mode, ret = 0;
|
||||||
|
bool changed;
|
||||||
|
u8 port;
|
||||||
|
|
||||||
|
sfp_parse_support(pl->sfp_bus, id, support);
|
||||||
|
port = sfp_parse_port(pl->sfp_bus, id, support);
|
||||||
|
iface = sfp_parse_interface(pl->sfp_bus, id);
|
||||||
|
|
||||||
|
WARN_ON(!lockdep_rtnl_is_held());
|
||||||
|
|
||||||
|
switch (iface) {
|
||||||
|
case PHY_INTERFACE_MODE_SGMII:
|
||||||
|
mode = MLO_AN_SGMII;
|
||||||
|
break;
|
||||||
|
case PHY_INTERFACE_MODE_1000BASEX:
|
||||||
|
mode = MLO_AN_8023Z;
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
memset(&config, 0, sizeof(config));
|
||||||
|
linkmode_copy(config.advertising, support);
|
||||||
|
config.interface = iface;
|
||||||
|
config.speed = SPEED_UNKNOWN;
|
||||||
|
config.duplex = DUPLEX_UNKNOWN;
|
||||||
|
config.pause = MLO_PAUSE_AN;
|
||||||
|
config.an_enabled = pl->link_config.an_enabled;
|
||||||
|
|
||||||
|
/* Ignore errors if we're expecting a PHY to attach later */
|
||||||
|
ret = phylink_validate(pl, support, &config);
|
||||||
|
if (ret) {
|
||||||
|
netdev_err(pl->netdev, "validation of %s/%s with support %*pb failed: %d\n",
|
||||||
|
phylink_an_mode_str(mode), phy_modes(config.interface),
|
||||||
|
__ETHTOOL_LINK_MODE_MASK_NBITS, support, ret);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
netdev_dbg(pl->netdev, "requesting link mode %s/%s with support %*pb\n",
|
||||||
|
phylink_an_mode_str(mode), phy_modes(config.interface),
|
||||||
|
__ETHTOOL_LINK_MODE_MASK_NBITS, support);
|
||||||
|
|
||||||
|
if (mode == MLO_AN_8023Z && pl->phydev)
|
||||||
|
return -EINVAL;
|
||||||
|
|
||||||
|
changed = !bitmap_equal(pl->supported, support,
|
||||||
|
__ETHTOOL_LINK_MODE_MASK_NBITS);
|
||||||
|
if (changed) {
|
||||||
|
linkmode_copy(pl->supported, support);
|
||||||
|
linkmode_copy(pl->link_config.advertising, config.advertising);
|
||||||
|
}
|
||||||
|
|
||||||
|
if (pl->link_an_mode != mode ||
|
||||||
|
pl->link_config.interface != config.interface) {
|
||||||
|
pl->link_config.interface = config.interface;
|
||||||
|
pl->link_an_mode = mode;
|
||||||
|
|
||||||
|
changed = true;
|
||||||
|
|
||||||
|
netdev_info(pl->netdev, "switched to %s/%s link mode\n",
|
||||||
|
phylink_an_mode_str(mode),
|
||||||
|
phy_modes(config.interface));
|
||||||
|
}
|
||||||
|
|
||||||
|
pl->link_port = port;
|
||||||
|
|
||||||
|
if (changed && !test_bit(PHYLINK_DISABLE_STOPPED,
|
||||||
|
&pl->phylink_disable_state))
|
||||||
|
phylink_mac_config(pl, &pl->link_config);
|
||||||
|
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void phylink_sfp_link_down(void *upstream)
|
||||||
|
{
|
||||||
|
struct phylink *pl = upstream;
|
||||||
|
|
||||||
|
WARN_ON(!lockdep_rtnl_is_held());
|
||||||
|
|
||||||
|
set_bit(PHYLINK_DISABLE_LINK, &pl->phylink_disable_state);
|
||||||
|
flush_work(&pl->resolve);
|
||||||
|
|
||||||
|
netif_carrier_off(pl->netdev);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void phylink_sfp_link_up(void *upstream)
|
||||||
|
{
|
||||||
|
struct phylink *pl = upstream;
|
||||||
|
|
||||||
|
WARN_ON(!lockdep_rtnl_is_held());
|
||||||
|
|
||||||
|
clear_bit(PHYLINK_DISABLE_LINK, &pl->phylink_disable_state);
|
||||||
|
phylink_run_resolve(pl);
|
||||||
|
}
|
||||||
|
|
||||||
|
static int phylink_sfp_connect_phy(void *upstream, struct phy_device *phy)
|
||||||
|
{
|
||||||
|
return phylink_connect_phy(upstream, phy);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void phylink_sfp_disconnect_phy(void *upstream)
|
||||||
|
{
|
||||||
|
phylink_disconnect_phy(upstream);
|
||||||
|
}
|
||||||
|
|
||||||
|
static const struct sfp_upstream_ops sfp_phylink_ops = {
|
||||||
|
.module_insert = phylink_sfp_module_insert,
|
||||||
|
.link_up = phylink_sfp_link_up,
|
||||||
|
.link_down = phylink_sfp_link_down,
|
||||||
|
.connect_phy = phylink_sfp_connect_phy,
|
||||||
|
.disconnect_phy = phylink_sfp_disconnect_phy,
|
||||||
|
};
|
||||||
|
|
||||||
MODULE_LICENSE("GPL");
|
MODULE_LICENSE("GPL");
|
||||||
|
|
|
||||||
|
|
@ -0,0 +1,475 @@
|
||||||
|
#include <linux/export.h>
|
||||||
|
#include <linux/kref.h>
|
||||||
|
#include <linux/list.h>
|
||||||
|
#include <linux/mutex.h>
|
||||||
|
#include <linux/phylink.h>
|
||||||
|
#include <linux/rtnetlink.h>
|
||||||
|
#include <linux/slab.h>
|
||||||
|
|
||||||
|
#include "sfp.h"
|
||||||
|
|
||||||
|
struct sfp_bus {
|
||||||
|
struct kref kref;
|
||||||
|
struct list_head node;
|
||||||
|
struct device_node *device_node;
|
||||||
|
|
||||||
|
const struct sfp_socket_ops *socket_ops;
|
||||||
|
struct device *sfp_dev;
|
||||||
|
struct sfp *sfp;
|
||||||
|
|
||||||
|
const struct sfp_upstream_ops *upstream_ops;
|
||||||
|
void *upstream;
|
||||||
|
struct net_device *netdev;
|
||||||
|
struct phy_device *phydev;
|
||||||
|
|
||||||
|
bool registered;
|
||||||
|
bool started;
|
||||||
|
};
|
||||||
|
|
||||||
|
|
||||||
|
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) {
|
||||||
|
case SFP_CONNECTOR_SC:
|
||||||
|
case SFP_CONNECTOR_FIBERJACK:
|
||||||
|
case SFP_CONNECTOR_LC:
|
||||||
|
case SFP_CONNECTOR_MT_RJ:
|
||||||
|
case SFP_CONNECTOR_MU:
|
||||||
|
case SFP_CONNECTOR_OPTICAL_PIGTAIL:
|
||||||
|
if (support)
|
||||||
|
phylink_set(support, FIBRE);
|
||||||
|
port = PORT_FIBRE;
|
||||||
|
break;
|
||||||
|
|
||||||
|
case SFP_CONNECTOR_RJ45:
|
||||||
|
if (support)
|
||||||
|
phylink_set(support, TP);
|
||||||
|
port = PORT_TP;
|
||||||
|
break;
|
||||||
|
|
||||||
|
case SFP_CONNECTOR_UNSPEC:
|
||||||
|
if (id->base.e1000_base_t) {
|
||||||
|
if (support)
|
||||||
|
phylink_set(support, TP);
|
||||||
|
port = PORT_TP;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
/* fallthrough */
|
||||||
|
case SFP_CONNECTOR_SG: /* guess */
|
||||||
|
case SFP_CONNECTOR_MPO_1X12:
|
||||||
|
case SFP_CONNECTOR_MPO_2X16:
|
||||||
|
case SFP_CONNECTOR_HSSDC_II:
|
||||||
|
case SFP_CONNECTOR_COPPER_PIGTAIL:
|
||||||
|
case SFP_CONNECTOR_NOSEPARATE:
|
||||||
|
case SFP_CONNECTOR_MXC_2X16:
|
||||||
|
port = PORT_OTHER;
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
dev_warn(bus->sfp_dev, "SFP: unknown connector id 0x%02x\n",
|
||||||
|
id->base.connector);
|
||||||
|
port = PORT_OTHER;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
return port;
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL_GPL(sfp_parse_port);
|
||||||
|
|
||||||
|
phy_interface_t sfp_parse_interface(struct sfp_bus *bus,
|
||||||
|
const struct sfp_eeprom_id *id)
|
||||||
|
{
|
||||||
|
phy_interface_t iface;
|
||||||
|
|
||||||
|
/* Setting the serdes link mode is guesswork: there's no field in
|
||||||
|
* the EEPROM which indicates what mode should be used.
|
||||||
|
*
|
||||||
|
* If the module wants 64b66b, then it must be >= 10G.
|
||||||
|
*
|
||||||
|
* If it's a gigabit-only fiber module, it probably does not have
|
||||||
|
* a PHY, so switch to 802.3z negotiation mode. Otherwise, switch
|
||||||
|
* to SGMII mode (which is required to support non-gigabit speeds).
|
||||||
|
*/
|
||||||
|
switch (id->base.encoding) {
|
||||||
|
case SFP_ENCODING_8472_64B66B:
|
||||||
|
iface = PHY_INTERFACE_MODE_10GKR;
|
||||||
|
break;
|
||||||
|
|
||||||
|
case SFP_ENCODING_8B10B:
|
||||||
|
if (!id->base.e1000_base_t &&
|
||||||
|
!id->base.e100_base_lx &&
|
||||||
|
!id->base.e100_base_fx)
|
||||||
|
iface = PHY_INTERFACE_MODE_1000BASEX;
|
||||||
|
else
|
||||||
|
iface = PHY_INTERFACE_MODE_SGMII;
|
||||||
|
break;
|
||||||
|
|
||||||
|
default:
|
||||||
|
iface = PHY_INTERFACE_MODE_NA;
|
||||||
|
dev_err(bus->sfp_dev,
|
||||||
|
"SFP module encoding does not support 8b10b nor 64b66b\n");
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
return iface;
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL_GPL(sfp_parse_interface);
|
||||||
|
|
||||||
|
void sfp_parse_support(struct sfp_bus *bus, const struct sfp_eeprom_id *id,
|
||||||
|
unsigned long *support)
|
||||||
|
{
|
||||||
|
phylink_set(support, Autoneg);
|
||||||
|
phylink_set(support, Pause);
|
||||||
|
phylink_set(support, Asym_Pause);
|
||||||
|
|
||||||
|
/* Set ethtool support from the compliance fields. */
|
||||||
|
if (id->base.e10g_base_sr)
|
||||||
|
phylink_set(support, 10000baseSR_Full);
|
||||||
|
if (id->base.e10g_base_lr)
|
||||||
|
phylink_set(support, 10000baseLR_Full);
|
||||||
|
if (id->base.e10g_base_lrm)
|
||||||
|
phylink_set(support, 10000baseLRM_Full);
|
||||||
|
if (id->base.e10g_base_er)
|
||||||
|
phylink_set(support, 10000baseER_Full);
|
||||||
|
if (id->base.e1000_base_sx ||
|
||||||
|
id->base.e1000_base_lx ||
|
||||||
|
id->base.e1000_base_cx)
|
||||||
|
phylink_set(support, 1000baseX_Full);
|
||||||
|
if (id->base.e1000_base_t) {
|
||||||
|
phylink_set(support, 1000baseT_Half);
|
||||||
|
phylink_set(support, 1000baseT_Full);
|
||||||
|
}
|
||||||
|
|
||||||
|
switch (id->base.extended_cc) {
|
||||||
|
case 0x00: /* Unspecified */
|
||||||
|
break;
|
||||||
|
case 0x02: /* 100Gbase-SR4 or 25Gbase-SR */
|
||||||
|
phylink_set(support, 100000baseSR4_Full);
|
||||||
|
phylink_set(support, 25000baseSR_Full);
|
||||||
|
break;
|
||||||
|
case 0x03: /* 100Gbase-LR4 or 25Gbase-LR */
|
||||||
|
case 0x04: /* 100Gbase-ER4 or 25Gbase-ER */
|
||||||
|
phylink_set(support, 100000baseLR4_ER4_Full);
|
||||||
|
break;
|
||||||
|
case 0x0b: /* 100Gbase-CR4 or 25Gbase-CR CA-L */
|
||||||
|
case 0x0c: /* 25Gbase-CR CA-S */
|
||||||
|
case 0x0d: /* 25Gbase-CR CA-N */
|
||||||
|
phylink_set(support, 100000baseCR4_Full);
|
||||||
|
phylink_set(support, 25000baseCR_Full);
|
||||||
|
break;
|
||||||
|
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)
|
||||||
|
phylink_set(support, 2500baseX_Full);
|
||||||
|
if (id->base.br_nominal >= 12)
|
||||||
|
phylink_set(support, 1000baseX_Full);
|
||||||
|
}
|
||||||
|
|
||||||
|
switch (id->base.connector) {
|
||||||
|
case SFP_CONNECTOR_SC:
|
||||||
|
case SFP_CONNECTOR_FIBERJACK:
|
||||||
|
case SFP_CONNECTOR_LC:
|
||||||
|
case SFP_CONNECTOR_MT_RJ:
|
||||||
|
case SFP_CONNECTOR_MU:
|
||||||
|
case SFP_CONNECTOR_OPTICAL_PIGTAIL:
|
||||||
|
break;
|
||||||
|
|
||||||
|
case SFP_CONNECTOR_UNSPEC:
|
||||||
|
if (id->base.e1000_base_t)
|
||||||
|
break;
|
||||||
|
|
||||||
|
case SFP_CONNECTOR_SG: /* guess */
|
||||||
|
case SFP_CONNECTOR_MPO_1X12:
|
||||||
|
case SFP_CONNECTOR_MPO_2X16:
|
||||||
|
case SFP_CONNECTOR_HSSDC_II:
|
||||||
|
case SFP_CONNECTOR_COPPER_PIGTAIL:
|
||||||
|
case SFP_CONNECTOR_NOSEPARATE:
|
||||||
|
case SFP_CONNECTOR_MXC_2X16:
|
||||||
|
default:
|
||||||
|
/* a guess at the supported link modes */
|
||||||
|
dev_warn(bus->sfp_dev,
|
||||||
|
"Guessing link modes, please report...\n");
|
||||||
|
phylink_set(support, 1000baseT_Half);
|
||||||
|
phylink_set(support, 1000baseT_Full);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL_GPL(sfp_parse_support);
|
||||||
|
|
||||||
|
|
||||||
|
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;
|
||||||
|
}
|
||||||
|
|
||||||
|
static struct sfp_bus *sfp_bus_get(struct device_node *np)
|
||||||
|
{
|
||||||
|
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) {
|
||||||
|
if (sfp->device_node == np) {
|
||||||
|
kref_get(&sfp->kref);
|
||||||
|
found = sfp;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if (!found && new) {
|
||||||
|
kref_init(&new->kref);
|
||||||
|
new->device_node = np;
|
||||||
|
list_add(&new->node, &sfp_buses);
|
||||||
|
found = new;
|
||||||
|
new = NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
mutex_unlock(&sfp_mutex);
|
||||||
|
|
||||||
|
kfree(new);
|
||||||
|
|
||||||
|
return found;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void sfp_bus_release(struct kref *kref) __releases(sfp_mutex)
|
||||||
|
{
|
||||||
|
struct sfp_bus *bus = container_of(kref, struct sfp_bus, kref);
|
||||||
|
|
||||||
|
list_del(&bus->node);
|
||||||
|
mutex_unlock(&sfp_mutex);
|
||||||
|
kfree(bus);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void sfp_bus_put(struct sfp_bus *bus)
|
||||||
|
{
|
||||||
|
kref_put_mutex(&bus->kref, sfp_bus_release, &sfp_mutex);
|
||||||
|
}
|
||||||
|
|
||||||
|
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;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
if (bus->started)
|
||||||
|
bus->socket_ops->start(bus->sfp);
|
||||||
|
bus->registered = true;
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void sfp_unregister_bus(struct sfp_bus *bus)
|
||||||
|
{
|
||||||
|
const struct sfp_upstream_ops *ops = bus->upstream_ops;
|
||||||
|
|
||||||
|
if (bus->registered) {
|
||||||
|
if (bus->started)
|
||||||
|
bus->socket_ops->stop(bus->sfp);
|
||||||
|
if (bus->phydev && ops && ops->disconnect_phy)
|
||||||
|
ops->disconnect_phy(bus->upstream);
|
||||||
|
}
|
||||||
|
bus->registered = false;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
int sfp_get_module_info(struct sfp_bus *bus, struct ethtool_modinfo *modinfo)
|
||||||
|
{
|
||||||
|
if (!bus->registered)
|
||||||
|
return -ENOIOCTLCMD;
|
||||||
|
return bus->socket_ops->module_info(bus->sfp, modinfo);
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL_GPL(sfp_get_module_info);
|
||||||
|
|
||||||
|
int sfp_get_module_eeprom(struct sfp_bus *bus, struct ethtool_eeprom *ee,
|
||||||
|
u8 *data)
|
||||||
|
{
|
||||||
|
if (!bus->registered)
|
||||||
|
return -ENOIOCTLCMD;
|
||||||
|
return bus->socket_ops->module_eeprom(bus->sfp, ee, data);
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL_GPL(sfp_get_module_eeprom);
|
||||||
|
|
||||||
|
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);
|
||||||
|
|
||||||
|
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);
|
||||||
|
|
||||||
|
struct sfp_bus *sfp_register_upstream(struct device_node *np,
|
||||||
|
struct net_device *ndev, void *upstream,
|
||||||
|
const struct sfp_upstream_ops *ops)
|
||||||
|
{
|
||||||
|
struct sfp_bus *bus = sfp_bus_get(np);
|
||||||
|
int ret = 0;
|
||||||
|
|
||||||
|
if (bus) {
|
||||||
|
rtnl_lock();
|
||||||
|
bus->upstream_ops = ops;
|
||||||
|
bus->upstream = upstream;
|
||||||
|
bus->netdev = ndev;
|
||||||
|
|
||||||
|
if (bus->sfp)
|
||||||
|
ret = sfp_register_bus(bus);
|
||||||
|
rtnl_unlock();
|
||||||
|
}
|
||||||
|
|
||||||
|
if (ret) {
|
||||||
|
sfp_bus_put(bus);
|
||||||
|
bus = NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
return bus;
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL_GPL(sfp_register_upstream);
|
||||||
|
|
||||||
|
void sfp_unregister_upstream(struct sfp_bus *bus)
|
||||||
|
{
|
||||||
|
rtnl_lock();
|
||||||
|
sfp_unregister_bus(bus);
|
||||||
|
bus->upstream = NULL;
|
||||||
|
bus->netdev = NULL;
|
||||||
|
rtnl_unlock();
|
||||||
|
|
||||||
|
sfp_bus_put(bus);
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL_GPL(sfp_unregister_upstream);
|
||||||
|
|
||||||
|
|
||||||
|
/* 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;
|
||||||
|
|
||||||
|
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);
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL_GPL(sfp_module_remove);
|
||||||
|
|
||||||
|
struct sfp_bus *sfp_register_socket(struct device *dev, struct sfp *sfp,
|
||||||
|
const struct sfp_socket_ops *ops)
|
||||||
|
{
|
||||||
|
struct sfp_bus *bus = sfp_bus_get(dev->of_node);
|
||||||
|
int ret = 0;
|
||||||
|
|
||||||
|
if (bus) {
|
||||||
|
rtnl_lock();
|
||||||
|
bus->sfp_dev = dev;
|
||||||
|
bus->sfp = sfp;
|
||||||
|
bus->socket_ops = ops;
|
||||||
|
|
||||||
|
if (bus->netdev)
|
||||||
|
ret = sfp_register_bus(bus);
|
||||||
|
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();
|
||||||
|
sfp_unregister_bus(bus);
|
||||||
|
bus->sfp_dev = NULL;
|
||||||
|
bus->sfp = NULL;
|
||||||
|
bus->socket_ops = NULL;
|
||||||
|
rtnl_unlock();
|
||||||
|
|
||||||
|
sfp_bus_put(bus);
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL_GPL(sfp_unregister_socket);
|
||||||
|
|
@ -0,0 +1,28 @@
|
||||||
|
#ifndef SFP_H
|
||||||
|
#define SFP_H
|
||||||
|
|
||||||
|
#include <linux/ethtool.h>
|
||||||
|
#include <linux/sfp.h>
|
||||||
|
|
||||||
|
struct sfp;
|
||||||
|
|
||||||
|
struct sfp_socket_ops {
|
||||||
|
void (*start)(struct sfp *sfp);
|
||||||
|
void (*stop)(struct sfp *sfp);
|
||||||
|
int (*module_info)(struct sfp *sfp, struct ethtool_modinfo *modinfo);
|
||||||
|
int (*module_eeprom)(struct sfp *sfp, struct ethtool_eeprom *ee,
|
||||||
|
u8 *data);
|
||||||
|
};
|
||||||
|
|
||||||
|
int sfp_add_phy(struct sfp_bus *bus, struct phy_device *phydev);
|
||||||
|
void sfp_remove_phy(struct sfp_bus *bus);
|
||||||
|
void sfp_link_up(struct sfp_bus *bus);
|
||||||
|
void sfp_link_down(struct sfp_bus *bus);
|
||||||
|
int sfp_module_insert(struct sfp_bus *bus, const struct sfp_eeprom_id *id);
|
||||||
|
void sfp_module_remove(struct sfp_bus *bus);
|
||||||
|
int sfp_link_configure(struct sfp_bus *bus, const struct sfp_eeprom_id *id);
|
||||||
|
struct sfp_bus *sfp_register_socket(struct device *dev, struct sfp *sfp,
|
||||||
|
const struct sfp_socket_ops *ops);
|
||||||
|
void sfp_unregister_socket(struct sfp_bus *bus);
|
||||||
|
|
||||||
|
#endif
|
||||||
|
|
@ -0,0 +1,434 @@
|
||||||
|
#ifndef LINUX_SFP_H
|
||||||
|
#define LINUX_SFP_H
|
||||||
|
|
||||||
|
#include <linux/phy.h>
|
||||||
|
|
||||||
|
struct __packed sfp_eeprom_base {
|
||||||
|
u8 phys_id;
|
||||||
|
u8 phys_ext_id;
|
||||||
|
u8 connector;
|
||||||
|
#if defined __BIG_ENDIAN_BITFIELD
|
||||||
|
u8 e10g_base_er:1;
|
||||||
|
u8 e10g_base_lrm:1;
|
||||||
|
u8 e10g_base_lr:1;
|
||||||
|
u8 e10g_base_sr:1;
|
||||||
|
u8 if_1x_sx:1;
|
||||||
|
u8 if_1x_lx:1;
|
||||||
|
u8 if_1x_copper_active:1;
|
||||||
|
u8 if_1x_copper_passive:1;
|
||||||
|
|
||||||
|
u8 escon_mmf_1310_led:1;
|
||||||
|
u8 escon_smf_1310_laser:1;
|
||||||
|
u8 sonet_oc192_short_reach:1;
|
||||||
|
u8 sonet_reach_bit1:1;
|
||||||
|
u8 sonet_reach_bit2:1;
|
||||||
|
u8 sonet_oc48_long_reach:1;
|
||||||
|
u8 sonet_oc48_intermediate_reach:1;
|
||||||
|
u8 sonet_oc48_short_reach:1;
|
||||||
|
|
||||||
|
u8 unallocated_5_7:1;
|
||||||
|
u8 sonet_oc12_smf_long_reach:1;
|
||||||
|
u8 sonet_oc12_smf_intermediate_reach:1;
|
||||||
|
u8 sonet_oc12_short_reach:1;
|
||||||
|
u8 unallocated_5_3:1;
|
||||||
|
u8 sonet_oc3_smf_long_reach:1;
|
||||||
|
u8 sonet_oc3_smf_intermediate_reach:1;
|
||||||
|
u8 sonet_oc3_short_reach:1;
|
||||||
|
|
||||||
|
u8 e_base_px:1;
|
||||||
|
u8 e_base_bx10:1;
|
||||||
|
u8 e100_base_fx:1;
|
||||||
|
u8 e100_base_lx:1;
|
||||||
|
u8 e1000_base_t:1;
|
||||||
|
u8 e1000_base_cx:1;
|
||||||
|
u8 e1000_base_lx:1;
|
||||||
|
u8 e1000_base_sx:1;
|
||||||
|
|
||||||
|
u8 fc_ll_v:1;
|
||||||
|
u8 fc_ll_s:1;
|
||||||
|
u8 fc_ll_i:1;
|
||||||
|
u8 fc_ll_l:1;
|
||||||
|
u8 fc_ll_m:1;
|
||||||
|
u8 fc_tech_sa:1;
|
||||||
|
u8 fc_tech_lc:1;
|
||||||
|
u8 fc_tech_electrical_inter_enclosure:1;
|
||||||
|
|
||||||
|
u8 fc_tech_electrical_intra_enclosure:1;
|
||||||
|
u8 fc_tech_sn:1;
|
||||||
|
u8 fc_tech_sl:1;
|
||||||
|
u8 fc_tech_ll:1;
|
||||||
|
u8 sfp_ct_active:1;
|
||||||
|
u8 sfp_ct_passive:1;
|
||||||
|
u8 unallocated_8_1:1;
|
||||||
|
u8 unallocated_8_0:1;
|
||||||
|
|
||||||
|
u8 fc_media_tw:1;
|
||||||
|
u8 fc_media_tp:1;
|
||||||
|
u8 fc_media_mi:1;
|
||||||
|
u8 fc_media_tv:1;
|
||||||
|
u8 fc_media_m6:1;
|
||||||
|
u8 fc_media_m5:1;
|
||||||
|
u8 unallocated_9_1:1;
|
||||||
|
u8 fc_media_sm:1;
|
||||||
|
|
||||||
|
u8 fc_speed_1200:1;
|
||||||
|
u8 fc_speed_800:1;
|
||||||
|
u8 fc_speed_1600:1;
|
||||||
|
u8 fc_speed_400:1;
|
||||||
|
u8 fc_speed_3200:1;
|
||||||
|
u8 fc_speed_200:1;
|
||||||
|
u8 unallocated_10_1:1;
|
||||||
|
u8 fc_speed_100:1;
|
||||||
|
#elif defined __LITTLE_ENDIAN_BITFIELD
|
||||||
|
u8 if_1x_copper_passive:1;
|
||||||
|
u8 if_1x_copper_active:1;
|
||||||
|
u8 if_1x_lx:1;
|
||||||
|
u8 if_1x_sx:1;
|
||||||
|
u8 e10g_base_sr:1;
|
||||||
|
u8 e10g_base_lr:1;
|
||||||
|
u8 e10g_base_lrm:1;
|
||||||
|
u8 e10g_base_er:1;
|
||||||
|
|
||||||
|
u8 sonet_oc3_short_reach:1;
|
||||||
|
u8 sonet_oc3_smf_intermediate_reach:1;
|
||||||
|
u8 sonet_oc3_smf_long_reach:1;
|
||||||
|
u8 unallocated_5_3:1;
|
||||||
|
u8 sonet_oc12_short_reach:1;
|
||||||
|
u8 sonet_oc12_smf_intermediate_reach:1;
|
||||||
|
u8 sonet_oc12_smf_long_reach:1;
|
||||||
|
u8 unallocated_5_7:1;
|
||||||
|
|
||||||
|
u8 sonet_oc48_short_reach:1;
|
||||||
|
u8 sonet_oc48_intermediate_reach:1;
|
||||||
|
u8 sonet_oc48_long_reach:1;
|
||||||
|
u8 sonet_reach_bit2:1;
|
||||||
|
u8 sonet_reach_bit1:1;
|
||||||
|
u8 sonet_oc192_short_reach:1;
|
||||||
|
u8 escon_smf_1310_laser:1;
|
||||||
|
u8 escon_mmf_1310_led:1;
|
||||||
|
|
||||||
|
u8 e1000_base_sx:1;
|
||||||
|
u8 e1000_base_lx:1;
|
||||||
|
u8 e1000_base_cx:1;
|
||||||
|
u8 e1000_base_t:1;
|
||||||
|
u8 e100_base_lx:1;
|
||||||
|
u8 e100_base_fx:1;
|
||||||
|
u8 e_base_bx10:1;
|
||||||
|
u8 e_base_px:1;
|
||||||
|
|
||||||
|
u8 fc_tech_electrical_inter_enclosure:1;
|
||||||
|
u8 fc_tech_lc:1;
|
||||||
|
u8 fc_tech_sa:1;
|
||||||
|
u8 fc_ll_m:1;
|
||||||
|
u8 fc_ll_l:1;
|
||||||
|
u8 fc_ll_i:1;
|
||||||
|
u8 fc_ll_s:1;
|
||||||
|
u8 fc_ll_v:1;
|
||||||
|
|
||||||
|
u8 unallocated_8_0:1;
|
||||||
|
u8 unallocated_8_1:1;
|
||||||
|
u8 sfp_ct_passive:1;
|
||||||
|
u8 sfp_ct_active:1;
|
||||||
|
u8 fc_tech_ll:1;
|
||||||
|
u8 fc_tech_sl:1;
|
||||||
|
u8 fc_tech_sn:1;
|
||||||
|
u8 fc_tech_electrical_intra_enclosure:1;
|
||||||
|
|
||||||
|
u8 fc_media_sm:1;
|
||||||
|
u8 unallocated_9_1:1;
|
||||||
|
u8 fc_media_m5:1;
|
||||||
|
u8 fc_media_m6:1;
|
||||||
|
u8 fc_media_tv:1;
|
||||||
|
u8 fc_media_mi:1;
|
||||||
|
u8 fc_media_tp:1;
|
||||||
|
u8 fc_media_tw:1;
|
||||||
|
|
||||||
|
u8 fc_speed_100:1;
|
||||||
|
u8 unallocated_10_1:1;
|
||||||
|
u8 fc_speed_200:1;
|
||||||
|
u8 fc_speed_3200:1;
|
||||||
|
u8 fc_speed_400:1;
|
||||||
|
u8 fc_speed_1600:1;
|
||||||
|
u8 fc_speed_800:1;
|
||||||
|
u8 fc_speed_1200:1;
|
||||||
|
#else
|
||||||
|
#error Unknown Endian
|
||||||
|
#endif
|
||||||
|
u8 encoding;
|
||||||
|
u8 br_nominal;
|
||||||
|
u8 rate_id;
|
||||||
|
u8 link_len[6];
|
||||||
|
char vendor_name[16];
|
||||||
|
u8 extended_cc;
|
||||||
|
char vendor_oui[3];
|
||||||
|
char vendor_pn[16];
|
||||||
|
char vendor_rev[4];
|
||||||
|
union {
|
||||||
|
__be16 optical_wavelength;
|
||||||
|
u8 cable_spec;
|
||||||
|
};
|
||||||
|
u8 reserved62;
|
||||||
|
u8 cc_base;
|
||||||
|
};
|
||||||
|
|
||||||
|
struct __packed sfp_eeprom_ext {
|
||||||
|
__be16 options;
|
||||||
|
u8 br_max;
|
||||||
|
u8 br_min;
|
||||||
|
char vendor_sn[16];
|
||||||
|
char datecode[8];
|
||||||
|
u8 diagmon;
|
||||||
|
u8 enhopts;
|
||||||
|
u8 sff8472_compliance;
|
||||||
|
u8 cc_ext;
|
||||||
|
};
|
||||||
|
|
||||||
|
struct __packed sfp_eeprom_id {
|
||||||
|
struct sfp_eeprom_base base;
|
||||||
|
struct sfp_eeprom_ext ext;
|
||||||
|
};
|
||||||
|
|
||||||
|
/* SFP EEPROM registers */
|
||||||
|
enum {
|
||||||
|
SFP_PHYS_ID = 0x00,
|
||||||
|
SFP_PHYS_EXT_ID = 0x01,
|
||||||
|
SFP_CONNECTOR = 0x02,
|
||||||
|
SFP_COMPLIANCE = 0x03,
|
||||||
|
SFP_ENCODING = 0x0b,
|
||||||
|
SFP_BR_NOMINAL = 0x0c,
|
||||||
|
SFP_RATE_ID = 0x0d,
|
||||||
|
SFP_LINK_LEN_SM_KM = 0x0e,
|
||||||
|
SFP_LINK_LEN_SM_100M = 0x0f,
|
||||||
|
SFP_LINK_LEN_50UM_OM2_10M = 0x10,
|
||||||
|
SFP_LINK_LEN_62_5UM_OM1_10M = 0x11,
|
||||||
|
SFP_LINK_LEN_COPPER_1M = 0x12,
|
||||||
|
SFP_LINK_LEN_50UM_OM4_10M = 0x12,
|
||||||
|
SFP_LINK_LEN_50UM_OM3_10M = 0x13,
|
||||||
|
SFP_VENDOR_NAME = 0x14,
|
||||||
|
SFP_VENDOR_OUI = 0x25,
|
||||||
|
SFP_VENDOR_PN = 0x28,
|
||||||
|
SFP_VENDOR_REV = 0x38,
|
||||||
|
SFP_OPTICAL_WAVELENGTH_MSB = 0x3c,
|
||||||
|
SFP_OPTICAL_WAVELENGTH_LSB = 0x3d,
|
||||||
|
SFP_CABLE_SPEC = 0x3c,
|
||||||
|
SFP_CC_BASE = 0x3f,
|
||||||
|
SFP_OPTIONS = 0x40, /* 2 bytes, MSB, LSB */
|
||||||
|
SFP_BR_MAX = 0x42,
|
||||||
|
SFP_BR_MIN = 0x43,
|
||||||
|
SFP_VENDOR_SN = 0x44,
|
||||||
|
SFP_DATECODE = 0x54,
|
||||||
|
SFP_DIAGMON = 0x5c,
|
||||||
|
SFP_ENHOPTS = 0x5d,
|
||||||
|
SFP_SFF8472_COMPLIANCE = 0x5e,
|
||||||
|
SFP_CC_EXT = 0x5f,
|
||||||
|
|
||||||
|
SFP_PHYS_ID_SFP = 0x03,
|
||||||
|
SFP_PHYS_EXT_ID_SFP = 0x04,
|
||||||
|
SFP_CONNECTOR_UNSPEC = 0x00,
|
||||||
|
/* codes 01-05 not supportable on SFP, but some modules have single SC */
|
||||||
|
SFP_CONNECTOR_SC = 0x01,
|
||||||
|
SFP_CONNECTOR_FIBERJACK = 0x06,
|
||||||
|
SFP_CONNECTOR_LC = 0x07,
|
||||||
|
SFP_CONNECTOR_MT_RJ = 0x08,
|
||||||
|
SFP_CONNECTOR_MU = 0x09,
|
||||||
|
SFP_CONNECTOR_SG = 0x0a,
|
||||||
|
SFP_CONNECTOR_OPTICAL_PIGTAIL = 0x0b,
|
||||||
|
SFP_CONNECTOR_MPO_1X12 = 0x0c,
|
||||||
|
SFP_CONNECTOR_MPO_2X16 = 0x0d,
|
||||||
|
SFP_CONNECTOR_HSSDC_II = 0x20,
|
||||||
|
SFP_CONNECTOR_COPPER_PIGTAIL = 0x21,
|
||||||
|
SFP_CONNECTOR_RJ45 = 0x22,
|
||||||
|
SFP_CONNECTOR_NOSEPARATE = 0x23,
|
||||||
|
SFP_CONNECTOR_MXC_2X16 = 0x24,
|
||||||
|
SFP_ENCODING_UNSPEC = 0x00,
|
||||||
|
SFP_ENCODING_8B10B = 0x01,
|
||||||
|
SFP_ENCODING_4B5B = 0x02,
|
||||||
|
SFP_ENCODING_NRZ = 0x03,
|
||||||
|
SFP_ENCODING_8472_MANCHESTER = 0x04,
|
||||||
|
SFP_ENCODING_8472_SONET = 0x05,
|
||||||
|
SFP_ENCODING_8472_64B66B = 0x06,
|
||||||
|
SFP_ENCODING_256B257B = 0x07,
|
||||||
|
SFP_ENCODING_PAM4 = 0x08,
|
||||||
|
SFP_OPTIONS_HIGH_POWER_LEVEL = BIT(13),
|
||||||
|
SFP_OPTIONS_PAGING_A2 = BIT(12),
|
||||||
|
SFP_OPTIONS_RETIMER = BIT(11),
|
||||||
|
SFP_OPTIONS_COOLED_XCVR = BIT(10),
|
||||||
|
SFP_OPTIONS_POWER_DECL = BIT(9),
|
||||||
|
SFP_OPTIONS_RX_LINEAR_OUT = BIT(8),
|
||||||
|
SFP_OPTIONS_RX_DECISION_THRESH = BIT(7),
|
||||||
|
SFP_OPTIONS_TUNABLE_TX = BIT(6),
|
||||||
|
SFP_OPTIONS_RATE_SELECT = BIT(5),
|
||||||
|
SFP_OPTIONS_TX_DISABLE = BIT(4),
|
||||||
|
SFP_OPTIONS_TX_FAULT = BIT(3),
|
||||||
|
SFP_OPTIONS_LOS_INVERTED = BIT(2),
|
||||||
|
SFP_OPTIONS_LOS_NORMAL = BIT(1),
|
||||||
|
SFP_DIAGMON_DDM = BIT(6),
|
||||||
|
SFP_DIAGMON_INT_CAL = BIT(5),
|
||||||
|
SFP_DIAGMON_EXT_CAL = BIT(4),
|
||||||
|
SFP_DIAGMON_RXPWR_AVG = BIT(3),
|
||||||
|
SFP_DIAGMON_ADDRMODE = BIT(2),
|
||||||
|
SFP_ENHOPTS_ALARMWARN = BIT(7),
|
||||||
|
SFP_ENHOPTS_SOFT_TX_DISABLE = BIT(6),
|
||||||
|
SFP_ENHOPTS_SOFT_TX_FAULT = BIT(5),
|
||||||
|
SFP_ENHOPTS_SOFT_RX_LOS = BIT(4),
|
||||||
|
SFP_ENHOPTS_SOFT_RATE_SELECT = BIT(3),
|
||||||
|
SFP_ENHOPTS_APP_SELECT_SFF8079 = BIT(2),
|
||||||
|
SFP_ENHOPTS_SOFT_RATE_SFF8431 = BIT(1),
|
||||||
|
SFP_SFF8472_COMPLIANCE_NONE = 0x00,
|
||||||
|
SFP_SFF8472_COMPLIANCE_REV9_3 = 0x01,
|
||||||
|
SFP_SFF8472_COMPLIANCE_REV9_5 = 0x02,
|
||||||
|
SFP_SFF8472_COMPLIANCE_REV10_2 = 0x03,
|
||||||
|
SFP_SFF8472_COMPLIANCE_REV10_4 = 0x04,
|
||||||
|
SFP_SFF8472_COMPLIANCE_REV11_0 = 0x05,
|
||||||
|
SFP_SFF8472_COMPLIANCE_REV11_3 = 0x06,
|
||||||
|
SFP_SFF8472_COMPLIANCE_REV11_4 = 0x07,
|
||||||
|
SFP_SFF8472_COMPLIANCE_REV12_0 = 0x08,
|
||||||
|
};
|
||||||
|
|
||||||
|
/* SFP Diagnostics */
|
||||||
|
enum {
|
||||||
|
/* Alarm and warnings stored MSB at lower address then LSB */
|
||||||
|
SFP_TEMP_HIGH_ALARM = 0x00,
|
||||||
|
SFP_TEMP_LOW_ALARM = 0x02,
|
||||||
|
SFP_TEMP_HIGH_WARN = 0x04,
|
||||||
|
SFP_TEMP_LOW_WARN = 0x06,
|
||||||
|
SFP_VOLT_HIGH_ALARM = 0x08,
|
||||||
|
SFP_VOLT_LOW_ALARM = 0x0a,
|
||||||
|
SFP_VOLT_HIGH_WARN = 0x0c,
|
||||||
|
SFP_VOLT_LOW_WARN = 0x0e,
|
||||||
|
SFP_BIAS_HIGH_ALARM = 0x10,
|
||||||
|
SFP_BIAS_LOW_ALARM = 0x12,
|
||||||
|
SFP_BIAS_HIGH_WARN = 0x14,
|
||||||
|
SFP_BIAS_LOW_WARN = 0x16,
|
||||||
|
SFP_TXPWR_HIGH_ALARM = 0x18,
|
||||||
|
SFP_TXPWR_LOW_ALARM = 0x1a,
|
||||||
|
SFP_TXPWR_HIGH_WARN = 0x1c,
|
||||||
|
SFP_TXPWR_LOW_WARN = 0x1e,
|
||||||
|
SFP_RXPWR_HIGH_ALARM = 0x20,
|
||||||
|
SFP_RXPWR_LOW_ALARM = 0x22,
|
||||||
|
SFP_RXPWR_HIGH_WARN = 0x24,
|
||||||
|
SFP_RXPWR_LOW_WARN = 0x26,
|
||||||
|
SFP_LASER_TEMP_HIGH_ALARM = 0x28,
|
||||||
|
SFP_LASER_TEMP_LOW_ALARM = 0x2a,
|
||||||
|
SFP_LASER_TEMP_HIGH_WARN = 0x2c,
|
||||||
|
SFP_LASER_TEMP_LOW_WARN = 0x2e,
|
||||||
|
SFP_TEC_CUR_HIGH_ALARM = 0x30,
|
||||||
|
SFP_TEC_CUR_LOW_ALARM = 0x32,
|
||||||
|
SFP_TEC_CUR_HIGH_WARN = 0x34,
|
||||||
|
SFP_TEC_CUR_LOW_WARN = 0x36,
|
||||||
|
SFP_CAL_RXPWR4 = 0x38,
|
||||||
|
SFP_CAL_RXPWR3 = 0x3c,
|
||||||
|
SFP_CAL_RXPWR2 = 0x40,
|
||||||
|
SFP_CAL_RXPWR1 = 0x44,
|
||||||
|
SFP_CAL_RXPWR0 = 0x48,
|
||||||
|
SFP_CAL_TXI_SLOPE = 0x4c,
|
||||||
|
SFP_CAL_TXI_OFFSET = 0x4e,
|
||||||
|
SFP_CAL_TXPWR_SLOPE = 0x50,
|
||||||
|
SFP_CAL_TXPWR_OFFSET = 0x52,
|
||||||
|
SFP_CAL_T_SLOPE = 0x54,
|
||||||
|
SFP_CAL_T_OFFSET = 0x56,
|
||||||
|
SFP_CAL_V_SLOPE = 0x58,
|
||||||
|
SFP_CAL_V_OFFSET = 0x5a,
|
||||||
|
SFP_CHKSUM = 0x5f,
|
||||||
|
|
||||||
|
SFP_TEMP = 0x60,
|
||||||
|
SFP_VCC = 0x62,
|
||||||
|
SFP_TX_BIAS = 0x64,
|
||||||
|
SFP_TX_POWER = 0x66,
|
||||||
|
SFP_RX_POWER = 0x68,
|
||||||
|
SFP_LASER_TEMP = 0x6a,
|
||||||
|
SFP_TEC_CUR = 0x6c,
|
||||||
|
|
||||||
|
SFP_STATUS = 0x6e,
|
||||||
|
SFP_ALARM = 0x70,
|
||||||
|
|
||||||
|
SFP_EXT_STATUS = 0x76,
|
||||||
|
SFP_VSL = 0x78,
|
||||||
|
SFP_PAGE = 0x7f,
|
||||||
|
};
|
||||||
|
|
||||||
|
struct device_node;
|
||||||
|
struct ethtool_eeprom;
|
||||||
|
struct ethtool_modinfo;
|
||||||
|
struct net_device;
|
||||||
|
struct sfp_bus;
|
||||||
|
|
||||||
|
struct sfp_upstream_ops {
|
||||||
|
int (*module_insert)(void *, const struct sfp_eeprom_id *id);
|
||||||
|
void (*module_remove)(void *);
|
||||||
|
void (*link_down)(void *);
|
||||||
|
void (*link_up)(void *);
|
||||||
|
int (*connect_phy)(void *, struct phy_device *);
|
||||||
|
void (*disconnect_phy)(void *);
|
||||||
|
};
|
||||||
|
|
||||||
|
#if IS_ENABLED(CONFIG_SFP)
|
||||||
|
int sfp_parse_port(struct sfp_bus *bus, const struct sfp_eeprom_id *id,
|
||||||
|
unsigned long *support);
|
||||||
|
phy_interface_t sfp_parse_interface(struct sfp_bus *bus,
|
||||||
|
const struct sfp_eeprom_id *id);
|
||||||
|
void sfp_parse_support(struct sfp_bus *bus, const struct sfp_eeprom_id *id,
|
||||||
|
unsigned long *support);
|
||||||
|
|
||||||
|
int sfp_get_module_info(struct sfp_bus *bus, struct ethtool_modinfo *modinfo);
|
||||||
|
int sfp_get_module_eeprom(struct sfp_bus *bus, struct ethtool_eeprom *ee,
|
||||||
|
u8 *data);
|
||||||
|
void sfp_upstream_start(struct sfp_bus *bus);
|
||||||
|
void sfp_upstream_stop(struct sfp_bus *bus);
|
||||||
|
struct sfp_bus *sfp_register_upstream(struct device_node *np,
|
||||||
|
struct net_device *ndev, void *upstream,
|
||||||
|
const struct sfp_upstream_ops *ops);
|
||||||
|
void sfp_unregister_upstream(struct sfp_bus *bus);
|
||||||
|
#else
|
||||||
|
static inline int sfp_parse_port(struct sfp_bus *bus,
|
||||||
|
const struct sfp_eeprom_id *id,
|
||||||
|
unsigned long *support)
|
||||||
|
{
|
||||||
|
return PORT_OTHER;
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline phy_interface_t sfp_parse_interface(struct sfp_bus *bus,
|
||||||
|
const struct sfp_eeprom_id *id)
|
||||||
|
{
|
||||||
|
return PHY_INTERFACE_MODE_NA;
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void sfp_parse_support(struct sfp_bus *bus,
|
||||||
|
const struct sfp_eeprom_id *id,
|
||||||
|
unsigned long *support)
|
||||||
|
{
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline int sfp_get_module_info(struct sfp_bus *bus,
|
||||||
|
struct ethtool_modinfo *modinfo)
|
||||||
|
{
|
||||||
|
return -EOPNOTSUPP;
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline int sfp_get_module_eeprom(struct sfp_bus *bus,
|
||||||
|
struct ethtool_eeprom *ee, u8 *data)
|
||||||
|
{
|
||||||
|
return -EOPNOTSUPP;
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void sfp_upstream_start(struct sfp_bus *bus)
|
||||||
|
{
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void sfp_upstream_stop(struct sfp_bus *bus)
|
||||||
|
{
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline struct sfp_bus *sfp_register_upstream(struct device_node *np,
|
||||||
|
struct net_device *ndev, void *upstream,
|
||||||
|
const struct sfp_upstream_ops *ops)
|
||||||
|
{
|
||||||
|
return (struct sfp_bus *)-1;
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void sfp_unregister_upstream(struct sfp_bus *bus)
|
||||||
|
{
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#endif
|
||||||
Loading…
Reference in New Issue