Commit 79396934 authored by Russell King (Oracle)'s avatar Russell King (Oracle) Committed by David S. Miller

net: dsa: b53: convert to phylink_pcs

Convert B53 to use phylink_pcs for the serdes rather than hooking it
into the MAC-layer callbacks.

Fixes: 81c1681c ("net: dsa: b53: mark as non-legacy")
Reviewed-by: default avatarFlorian Fainelli <f.fainelli@gmail.com>
Tested-by: default avatarFlorian Fainelli <f.fainelli@gmail.com>
Signed-off-by: default avatarRussell King (Oracle) <rmk+kernel@armlinux.org.uk>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 6b292a04
...@@ -1354,46 +1354,25 @@ static void b53_phylink_get_caps(struct dsa_switch *ds, int port, ...@@ -1354,46 +1354,25 @@ static void b53_phylink_get_caps(struct dsa_switch *ds, int port,
config->legacy_pre_march2020 = false; config->legacy_pre_march2020 = false;
} }
int b53_phylink_mac_link_state(struct dsa_switch *ds, int port, static struct phylink_pcs *b53_phylink_mac_select_pcs(struct dsa_switch *ds,
struct phylink_link_state *state) int port,
phy_interface_t interface)
{ {
struct b53_device *dev = ds->priv; struct b53_device *dev = ds->priv;
int ret = -EOPNOTSUPP;
if ((phy_interface_mode_is_8023z(state->interface) || if (!dev->ops->phylink_mac_select_pcs)
state->interface == PHY_INTERFACE_MODE_SGMII) && return NULL;
dev->ops->serdes_link_state)
ret = dev->ops->serdes_link_state(dev, port, state);
return ret; return dev->ops->phylink_mac_select_pcs(dev, port, interface);
} }
EXPORT_SYMBOL(b53_phylink_mac_link_state);
void b53_phylink_mac_config(struct dsa_switch *ds, int port, void b53_phylink_mac_config(struct dsa_switch *ds, int port,
unsigned int mode, unsigned int mode,
const struct phylink_link_state *state) const struct phylink_link_state *state)
{ {
struct b53_device *dev = ds->priv;
if (mode == MLO_AN_PHY || mode == MLO_AN_FIXED)
return;
if ((phy_interface_mode_is_8023z(state->interface) ||
state->interface == PHY_INTERFACE_MODE_SGMII) &&
dev->ops->serdes_config)
dev->ops->serdes_config(dev, port, mode, state);
} }
EXPORT_SYMBOL(b53_phylink_mac_config); EXPORT_SYMBOL(b53_phylink_mac_config);
void b53_phylink_mac_an_restart(struct dsa_switch *ds, int port)
{
struct b53_device *dev = ds->priv;
if (dev->ops->serdes_an_restart)
dev->ops->serdes_an_restart(dev, port);
}
EXPORT_SYMBOL(b53_phylink_mac_an_restart);
void b53_phylink_mac_link_down(struct dsa_switch *ds, int port, void b53_phylink_mac_link_down(struct dsa_switch *ds, int port,
unsigned int mode, unsigned int mode,
phy_interface_t interface) phy_interface_t interface)
...@@ -2269,9 +2248,8 @@ static const struct dsa_switch_ops b53_switch_ops = { ...@@ -2269,9 +2248,8 @@ static const struct dsa_switch_ops b53_switch_ops = {
.phy_write = b53_phy_write16, .phy_write = b53_phy_write16,
.adjust_link = b53_adjust_link, .adjust_link = b53_adjust_link,
.phylink_get_caps = b53_phylink_get_caps, .phylink_get_caps = b53_phylink_get_caps,
.phylink_mac_link_state = b53_phylink_mac_link_state, .phylink_mac_select_pcs = b53_phylink_mac_select_pcs,
.phylink_mac_config = b53_phylink_mac_config, .phylink_mac_config = b53_phylink_mac_config,
.phylink_mac_an_restart = b53_phylink_mac_an_restart,
.phylink_mac_link_down = b53_phylink_mac_link_down, .phylink_mac_link_down = b53_phylink_mac_link_down,
.phylink_mac_link_up = b53_phylink_mac_link_up, .phylink_mac_link_up = b53_phylink_mac_link_up,
.port_enable = b53_enable_port, .port_enable = b53_enable_port,
......
...@@ -21,7 +21,7 @@ ...@@ -21,7 +21,7 @@
#include <linux/kernel.h> #include <linux/kernel.h>
#include <linux/mutex.h> #include <linux/mutex.h>
#include <linux/phy.h> #include <linux/phylink.h>
#include <linux/etherdevice.h> #include <linux/etherdevice.h>
#include <net/dsa.h> #include <net/dsa.h>
...@@ -29,7 +29,6 @@ ...@@ -29,7 +29,6 @@
struct b53_device; struct b53_device;
struct net_device; struct net_device;
struct phylink_link_state;
struct b53_io_ops { struct b53_io_ops {
int (*read8)(struct b53_device *dev, u8 page, u8 reg, u8 *value); int (*read8)(struct b53_device *dev, u8 page, u8 reg, u8 *value);
...@@ -48,13 +47,10 @@ struct b53_io_ops { ...@@ -48,13 +47,10 @@ struct b53_io_ops {
void (*irq_disable)(struct b53_device *dev, int port); void (*irq_disable)(struct b53_device *dev, int port);
void (*phylink_get_caps)(struct b53_device *dev, int port, void (*phylink_get_caps)(struct b53_device *dev, int port,
struct phylink_config *config); struct phylink_config *config);
struct phylink_pcs *(*phylink_mac_select_pcs)(struct b53_device *dev,
int port,
phy_interface_t interface);
u8 (*serdes_map_lane)(struct b53_device *dev, int port); u8 (*serdes_map_lane)(struct b53_device *dev, int port);
int (*serdes_link_state)(struct b53_device *dev, int port,
struct phylink_link_state *state);
void (*serdes_config)(struct b53_device *dev, int port,
unsigned int mode,
const struct phylink_link_state *state);
void (*serdes_an_restart)(struct b53_device *dev, int port);
void (*serdes_link_set)(struct b53_device *dev, int port, void (*serdes_link_set)(struct b53_device *dev, int port,
unsigned int mode, phy_interface_t interface, unsigned int mode, phy_interface_t interface,
bool link_up); bool link_up);
...@@ -85,8 +81,15 @@ enum { ...@@ -85,8 +81,15 @@ enum {
BCM7278_DEVICE_ID = 0x7278, BCM7278_DEVICE_ID = 0x7278,
}; };
struct b53_pcs {
struct phylink_pcs pcs;
struct b53_device *dev;
u8 lane;
};
#define B53_N_PORTS 9 #define B53_N_PORTS 9
#define B53_N_PORTS_25 6 #define B53_N_PORTS_25 6
#define B53_N_PCS 2
struct b53_port { struct b53_port {
u16 vlan_ctl_mask; u16 vlan_ctl_mask;
...@@ -143,6 +146,8 @@ struct b53_device { ...@@ -143,6 +146,8 @@ struct b53_device {
bool vlan_enabled; bool vlan_enabled;
unsigned int num_ports; unsigned int num_ports;
struct b53_port *ports; struct b53_port *ports;
struct b53_pcs pcs[B53_N_PCS];
}; };
#define b53_for_each_port(dev, i) \ #define b53_for_each_port(dev, i) \
...@@ -336,12 +341,9 @@ int b53_br_flags(struct dsa_switch *ds, int port, ...@@ -336,12 +341,9 @@ int b53_br_flags(struct dsa_switch *ds, int port,
struct netlink_ext_ack *extack); struct netlink_ext_ack *extack);
int b53_setup_devlink_resources(struct dsa_switch *ds); int b53_setup_devlink_resources(struct dsa_switch *ds);
void b53_port_event(struct dsa_switch *ds, int port); void b53_port_event(struct dsa_switch *ds, int port);
int b53_phylink_mac_link_state(struct dsa_switch *ds, int port,
struct phylink_link_state *state);
void b53_phylink_mac_config(struct dsa_switch *ds, int port, void b53_phylink_mac_config(struct dsa_switch *ds, int port,
unsigned int mode, unsigned int mode,
const struct phylink_link_state *state); const struct phylink_link_state *state);
void b53_phylink_mac_an_restart(struct dsa_switch *ds, int port);
void b53_phylink_mac_link_down(struct dsa_switch *ds, int port, void b53_phylink_mac_link_down(struct dsa_switch *ds, int port,
unsigned int mode, unsigned int mode,
phy_interface_t interface); phy_interface_t interface);
......
...@@ -17,6 +17,11 @@ ...@@ -17,6 +17,11 @@
#include "b53_serdes.h" #include "b53_serdes.h"
#include "b53_regs.h" #include "b53_regs.h"
static inline struct b53_pcs *pcs_to_b53_pcs(struct phylink_pcs *pcs)
{
return container_of(pcs, struct b53_pcs, pcs);
}
static void b53_serdes_write_blk(struct b53_device *dev, u8 offset, u16 block, static void b53_serdes_write_blk(struct b53_device *dev, u8 offset, u16 block,
u16 value) u16 value)
{ {
...@@ -60,51 +65,47 @@ static u16 b53_serdes_read(struct b53_device *dev, u8 lane, ...@@ -60,51 +65,47 @@ static u16 b53_serdes_read(struct b53_device *dev, u8 lane,
return b53_serdes_read_blk(dev, offset, block); return b53_serdes_read_blk(dev, offset, block);
} }
void b53_serdes_config(struct b53_device *dev, int port, unsigned int mode, static int b53_serdes_config(struct phylink_pcs *pcs, unsigned int mode,
const struct phylink_link_state *state) phy_interface_t interface,
const unsigned long *advertising,
bool permit_pause_to_mac)
{ {
u8 lane = b53_serdes_map_lane(dev, port); struct b53_device *dev = pcs_to_b53_pcs(pcs)->dev;
u8 lane = pcs_to_b53_pcs(pcs)->lane;
u16 reg; u16 reg;
if (lane == B53_INVALID_LANE)
return;
reg = b53_serdes_read(dev, lane, B53_SERDES_DIGITAL_CONTROL(1), reg = b53_serdes_read(dev, lane, B53_SERDES_DIGITAL_CONTROL(1),
SERDES_DIGITAL_BLK); SERDES_DIGITAL_BLK);
if (state->interface == PHY_INTERFACE_MODE_1000BASEX) if (interface == PHY_INTERFACE_MODE_1000BASEX)
reg |= FIBER_MODE_1000X; reg |= FIBER_MODE_1000X;
else else
reg &= ~FIBER_MODE_1000X; reg &= ~FIBER_MODE_1000X;
b53_serdes_write(dev, lane, B53_SERDES_DIGITAL_CONTROL(1), b53_serdes_write(dev, lane, B53_SERDES_DIGITAL_CONTROL(1),
SERDES_DIGITAL_BLK, reg); SERDES_DIGITAL_BLK, reg);
return 0;
} }
EXPORT_SYMBOL(b53_serdes_config);
void b53_serdes_an_restart(struct b53_device *dev, int port) static void b53_serdes_an_restart(struct phylink_pcs *pcs)
{ {
u8 lane = b53_serdes_map_lane(dev, port); struct b53_device *dev = pcs_to_b53_pcs(pcs)->dev;
u8 lane = pcs_to_b53_pcs(pcs)->lane;
u16 reg; u16 reg;
if (lane == B53_INVALID_LANE)
return;
reg = b53_serdes_read(dev, lane, B53_SERDES_MII_REG(MII_BMCR), reg = b53_serdes_read(dev, lane, B53_SERDES_MII_REG(MII_BMCR),
SERDES_MII_BLK); SERDES_MII_BLK);
reg |= BMCR_ANRESTART; reg |= BMCR_ANRESTART;
b53_serdes_write(dev, lane, B53_SERDES_MII_REG(MII_BMCR), b53_serdes_write(dev, lane, B53_SERDES_MII_REG(MII_BMCR),
SERDES_MII_BLK, reg); SERDES_MII_BLK, reg);
} }
EXPORT_SYMBOL(b53_serdes_an_restart);
int b53_serdes_link_state(struct b53_device *dev, int port, static void b53_serdes_get_state(struct phylink_pcs *pcs,
struct phylink_link_state *state) struct phylink_link_state *state)
{ {
u8 lane = b53_serdes_map_lane(dev, port); struct b53_device *dev = pcs_to_b53_pcs(pcs)->dev;
u8 lane = pcs_to_b53_pcs(pcs)->lane;
u16 dig, bmsr; u16 dig, bmsr;
if (lane == B53_INVALID_LANE)
return 1;
dig = b53_serdes_read(dev, lane, B53_SERDES_DIGITAL_STATUS, dig = b53_serdes_read(dev, lane, B53_SERDES_DIGITAL_STATUS,
SERDES_DIGITAL_BLK); SERDES_DIGITAL_BLK);
bmsr = b53_serdes_read(dev, lane, B53_SERDES_MII_REG(MII_BMSR), bmsr = b53_serdes_read(dev, lane, B53_SERDES_MII_REG(MII_BMSR),
...@@ -133,10 +134,7 @@ int b53_serdes_link_state(struct b53_device *dev, int port, ...@@ -133,10 +134,7 @@ int b53_serdes_link_state(struct b53_device *dev, int port,
state->pause |= MLO_PAUSE_RX; state->pause |= MLO_PAUSE_RX;
if (dig & PAUSE_RESOLUTION_TX_SIDE) if (dig & PAUSE_RESOLUTION_TX_SIDE)
state->pause |= MLO_PAUSE_TX; state->pause |= MLO_PAUSE_TX;
return 0;
} }
EXPORT_SYMBOL(b53_serdes_link_state);
void b53_serdes_link_set(struct b53_device *dev, int port, unsigned int mode, void b53_serdes_link_set(struct b53_device *dev, int port, unsigned int mode,
phy_interface_t interface, bool link_up) phy_interface_t interface, bool link_up)
...@@ -158,6 +156,12 @@ void b53_serdes_link_set(struct b53_device *dev, int port, unsigned int mode, ...@@ -158,6 +156,12 @@ void b53_serdes_link_set(struct b53_device *dev, int port, unsigned int mode,
} }
EXPORT_SYMBOL(b53_serdes_link_set); EXPORT_SYMBOL(b53_serdes_link_set);
static const struct phylink_pcs_ops b53_pcs_ops = {
.pcs_get_state = b53_serdes_get_state,
.pcs_config = b53_serdes_config,
.pcs_an_restart = b53_serdes_an_restart,
};
void b53_serdes_phylink_get_caps(struct b53_device *dev, int port, void b53_serdes_phylink_get_caps(struct b53_device *dev, int port,
struct phylink_config *config) struct phylink_config *config)
{ {
...@@ -187,9 +191,28 @@ void b53_serdes_phylink_get_caps(struct b53_device *dev, int port, ...@@ -187,9 +191,28 @@ void b53_serdes_phylink_get_caps(struct b53_device *dev, int port,
} }
EXPORT_SYMBOL(b53_serdes_phylink_get_caps); EXPORT_SYMBOL(b53_serdes_phylink_get_caps);
struct phylink_pcs *b53_serdes_phylink_mac_select_pcs(struct b53_device *dev,
int port,
phy_interface_t interface)
{
u8 lane = b53_serdes_map_lane(dev, port);
if (lane == B53_INVALID_LANE || lane >= B53_N_PCS ||
!dev->pcs[lane].dev)
return NULL;
if (!phy_interface_mode_is_8023z(interface) &&
interface != PHY_INTERFACE_MODE_SGMII)
return NULL;
return &dev->pcs[lane].pcs;
}
EXPORT_SYMBOL(b53_serdes_phylink_mac_select_pcs);
int b53_serdes_init(struct b53_device *dev, int port) int b53_serdes_init(struct b53_device *dev, int port)
{ {
u8 lane = b53_serdes_map_lane(dev, port); u8 lane = b53_serdes_map_lane(dev, port);
struct b53_pcs *pcs;
u16 id0, msb, lsb; u16 id0, msb, lsb;
if (lane == B53_INVALID_LANE) if (lane == B53_INVALID_LANE)
...@@ -212,6 +235,11 @@ int b53_serdes_init(struct b53_device *dev, int port) ...@@ -212,6 +235,11 @@ int b53_serdes_init(struct b53_device *dev, int port)
(id0 >> SERDES_ID0_REV_NUM_SHIFT) & SERDES_ID0_REV_NUM_MASK, (id0 >> SERDES_ID0_REV_NUM_SHIFT) & SERDES_ID0_REV_NUM_MASK,
(u32)msb << 16 | lsb); (u32)msb << 16 | lsb);
pcs = &dev->pcs[lane];
pcs->dev = dev;
pcs->lane = lane;
pcs->pcs.ops = &b53_pcs_ops;
return 0; return 0;
} }
EXPORT_SYMBOL(b53_serdes_init); EXPORT_SYMBOL(b53_serdes_init);
......
...@@ -107,14 +107,11 @@ static inline u8 b53_serdes_map_lane(struct b53_device *dev, int port) ...@@ -107,14 +107,11 @@ static inline u8 b53_serdes_map_lane(struct b53_device *dev, int port)
return dev->ops->serdes_map_lane(dev, port); return dev->ops->serdes_map_lane(dev, port);
} }
int b53_serdes_get_link(struct b53_device *dev, int port);
int b53_serdes_link_state(struct b53_device *dev, int port,
struct phylink_link_state *state);
void b53_serdes_config(struct b53_device *dev, int port, unsigned int mode,
const struct phylink_link_state *state);
void b53_serdes_an_restart(struct b53_device *dev, int port);
void b53_serdes_link_set(struct b53_device *dev, int port, unsigned int mode, void b53_serdes_link_set(struct b53_device *dev, int port, unsigned int mode,
phy_interface_t interface, bool link_up); phy_interface_t interface, bool link_up);
struct phylink_pcs *b53_serdes_phylink_mac_select_pcs(struct b53_device *dev,
int port,
phy_interface_t interface);
void b53_serdes_phylink_get_caps(struct b53_device *dev, int port, void b53_serdes_phylink_get_caps(struct b53_device *dev, int port,
struct phylink_config *config); struct phylink_config *config);
#if IS_ENABLED(CONFIG_B53_SERDES) #if IS_ENABLED(CONFIG_B53_SERDES)
......
...@@ -491,10 +491,8 @@ static const struct b53_io_ops b53_srab_ops = { ...@@ -491,10 +491,8 @@ static const struct b53_io_ops b53_srab_ops = {
.irq_disable = b53_srab_irq_disable, .irq_disable = b53_srab_irq_disable,
.phylink_get_caps = b53_srab_phylink_get_caps, .phylink_get_caps = b53_srab_phylink_get_caps,
#if IS_ENABLED(CONFIG_B53_SERDES) #if IS_ENABLED(CONFIG_B53_SERDES)
.phylink_mac_select_pcs = b53_serdes_phylink_mac_select_pcs,
.serdes_map_lane = b53_srab_serdes_map_lane, .serdes_map_lane = b53_srab_serdes_map_lane,
.serdes_link_state = b53_serdes_link_state,
.serdes_config = b53_serdes_config,
.serdes_an_restart = b53_serdes_an_restart,
.serdes_link_set = b53_serdes_link_set, .serdes_link_set = b53_serdes_link_set,
#endif #endif
}; };
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment