mirror of https://gitee.com/openkylin/linux.git
net: macb: convert to phylink
This patch converts the MACB Ethernet driver to the Phylink framework. The MAC configuration is moved to the Phylink ops and Phylink helpers are now used in the ethtools functions. This helps to access the flow control and pauseparam logic and this will be helpful in the future for boards using this controller with SFP cages. Tested-by: Alexandre Belloni <alexandre.belloni@bootlin.com> Signed-off-by: Antoine Tenart <antoine.tenart@bootlin.com> Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
parent
6e952d95ca
commit
7897b071ac
|
@ -22,7 +22,7 @@ if NET_VENDOR_CADENCE
|
|||
config MACB
|
||||
tristate "Cadence MACB/GEM support"
|
||||
depends on HAS_DMA && COMMON_CLK
|
||||
select PHYLIB
|
||||
select PHYLINK
|
||||
---help---
|
||||
The Cadence MACB ethernet interface is found on many Atmel AT32 and
|
||||
AT91 parts. This driver also supports the Cadence GEM (Gigabit
|
||||
|
|
|
@ -7,7 +7,7 @@
|
|||
#ifndef _MACB_H
|
||||
#define _MACB_H
|
||||
|
||||
#include <linux/phy.h>
|
||||
#include <linux/phylink.h>
|
||||
#include <linux/ptp_clock_kernel.h>
|
||||
#include <linux/net_tstamp.h>
|
||||
#include <linux/interrupt.h>
|
||||
|
@ -1185,15 +1185,14 @@ struct macb {
|
|||
struct macb_or_gem_ops macbgem_ops;
|
||||
|
||||
struct mii_bus *mii_bus;
|
||||
struct device_node *phy_node;
|
||||
int link;
|
||||
int speed;
|
||||
int duplex;
|
||||
struct phylink *phylink;
|
||||
struct phylink_config phylink_config;
|
||||
|
||||
u32 caps;
|
||||
unsigned int dma_burst_length;
|
||||
|
||||
phy_interface_t phy_interface;
|
||||
int speed;
|
||||
|
||||
/* AT91RM9200 transmit */
|
||||
struct sk_buff *skb; /* holds skb until xmit interrupt completes */
|
||||
|
|
|
@ -25,7 +25,7 @@
|
|||
#include <linux/dma-mapping.h>
|
||||
#include <linux/platform_data/macb.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/phy.h>
|
||||
#include <linux/phylink.h>
|
||||
#include <linux/of.h>
|
||||
#include <linux/of_device.h>
|
||||
#include <linux/of_gpio.h>
|
||||
|
@ -453,114 +453,178 @@ static void macb_set_tx_clk(struct clk *clk, int speed, struct net_device *dev)
|
|||
netdev_err(dev, "adjusting tx_clk failed.\n");
|
||||
}
|
||||
|
||||
static void macb_handle_link_change(struct net_device *dev)
|
||||
static void macb_validate(struct phylink_config *config,
|
||||
unsigned long *supported,
|
||||
struct phylink_link_state *state)
|
||||
{
|
||||
struct macb *bp = netdev_priv(dev);
|
||||
struct phy_device *phydev = dev->phydev;
|
||||
struct net_device *ndev = to_net_dev(config->dev);
|
||||
__ETHTOOL_DECLARE_LINK_MODE_MASK(mask) = { 0, };
|
||||
struct macb *bp = netdev_priv(ndev);
|
||||
|
||||
/* We only support MII, RMII, GMII, RGMII & SGMII. */
|
||||
if (state->interface != PHY_INTERFACE_MODE_NA &&
|
||||
state->interface != PHY_INTERFACE_MODE_MII &&
|
||||
state->interface != PHY_INTERFACE_MODE_RMII &&
|
||||
state->interface != PHY_INTERFACE_MODE_GMII &&
|
||||
state->interface != PHY_INTERFACE_MODE_SGMII &&
|
||||
!phy_interface_mode_is_rgmii(state->interface)) {
|
||||
bitmap_zero(supported, __ETHTOOL_LINK_MODE_MASK_NBITS);
|
||||
return;
|
||||
}
|
||||
|
||||
if (!macb_is_gem(bp) &&
|
||||
(state->interface == PHY_INTERFACE_MODE_GMII ||
|
||||
phy_interface_mode_is_rgmii(state->interface))) {
|
||||
bitmap_zero(supported, __ETHTOOL_LINK_MODE_MASK_NBITS);
|
||||
return;
|
||||
}
|
||||
|
||||
phylink_set_port_modes(mask);
|
||||
phylink_set(mask, Autoneg);
|
||||
phylink_set(mask, Asym_Pause);
|
||||
|
||||
phylink_set(mask, 10baseT_Half);
|
||||
phylink_set(mask, 10baseT_Full);
|
||||
phylink_set(mask, 100baseT_Half);
|
||||
phylink_set(mask, 100baseT_Full);
|
||||
|
||||
if (bp->caps & MACB_CAPS_GIGABIT_MODE_AVAILABLE &&
|
||||
(state->interface == PHY_INTERFACE_MODE_NA ||
|
||||
state->interface == PHY_INTERFACE_MODE_GMII ||
|
||||
state->interface == PHY_INTERFACE_MODE_SGMII ||
|
||||
phy_interface_mode_is_rgmii(state->interface))) {
|
||||
phylink_set(mask, 1000baseT_Full);
|
||||
phylink_set(mask, 1000baseX_Full);
|
||||
|
||||
if (!(bp->caps & MACB_CAPS_NO_GIGABIT_HALF))
|
||||
phylink_set(mask, 1000baseT_Half);
|
||||
}
|
||||
|
||||
bitmap_and(supported, supported, mask, __ETHTOOL_LINK_MODE_MASK_NBITS);
|
||||
bitmap_and(state->advertising, state->advertising, mask,
|
||||
__ETHTOOL_LINK_MODE_MASK_NBITS);
|
||||
}
|
||||
|
||||
static int macb_mac_link_state(struct phylink_config *config,
|
||||
struct phylink_link_state *state)
|
||||
{
|
||||
return -EOPNOTSUPP;
|
||||
}
|
||||
|
||||
static void macb_mac_an_restart(struct phylink_config *config)
|
||||
{
|
||||
/* Not supported */
|
||||
}
|
||||
|
||||
static void macb_mac_config(struct phylink_config *config, unsigned int mode,
|
||||
const struct phylink_link_state *state)
|
||||
{
|
||||
struct net_device *ndev = to_net_dev(config->dev);
|
||||
struct macb *bp = netdev_priv(ndev);
|
||||
unsigned long flags;
|
||||
int status_change = 0;
|
||||
u32 old_ctrl, ctrl;
|
||||
|
||||
spin_lock_irqsave(&bp->lock, flags);
|
||||
|
||||
if (phydev->link) {
|
||||
if ((bp->speed != phydev->speed) ||
|
||||
(bp->duplex != phydev->duplex)) {
|
||||
u32 reg;
|
||||
old_ctrl = ctrl = macb_or_gem_readl(bp, NCFGR);
|
||||
|
||||
reg = macb_readl(bp, NCFGR);
|
||||
reg &= ~(MACB_BIT(SPD) | MACB_BIT(FD));
|
||||
if (macb_is_gem(bp))
|
||||
reg &= ~GEM_BIT(GBE);
|
||||
/* Clear all the bits we might set later */
|
||||
ctrl &= ~(GEM_BIT(GBE) | MACB_BIT(SPD) | MACB_BIT(FD) | MACB_BIT(PAE) |
|
||||
GEM_BIT(SGMIIEN) | GEM_BIT(PCSSEL));
|
||||
|
||||
if (phydev->duplex)
|
||||
reg |= MACB_BIT(FD);
|
||||
if (phydev->speed == SPEED_100)
|
||||
reg |= MACB_BIT(SPD);
|
||||
if (phydev->speed == SPEED_1000 &&
|
||||
bp->caps & MACB_CAPS_GIGABIT_MODE_AVAILABLE)
|
||||
reg |= GEM_BIT(GBE);
|
||||
if (state->speed == SPEED_1000)
|
||||
ctrl |= GEM_BIT(GBE);
|
||||
else if (state->speed == SPEED_100)
|
||||
ctrl |= MACB_BIT(SPD);
|
||||
|
||||
macb_or_gem_writel(bp, NCFGR, reg);
|
||||
if (state->duplex)
|
||||
ctrl |= MACB_BIT(FD);
|
||||
|
||||
bp->speed = phydev->speed;
|
||||
bp->duplex = phydev->duplex;
|
||||
status_change = 1;
|
||||
}
|
||||
}
|
||||
/* We do not support MLO_PAUSE_RX yet */
|
||||
if (state->pause & MLO_PAUSE_TX)
|
||||
ctrl |= MACB_BIT(PAE);
|
||||
|
||||
if (phydev->link != bp->link) {
|
||||
if (!phydev->link) {
|
||||
bp->speed = 0;
|
||||
bp->duplex = -1;
|
||||
}
|
||||
bp->link = phydev->link;
|
||||
if (state->interface == PHY_INTERFACE_MODE_SGMII)
|
||||
ctrl |= GEM_BIT(SGMIIEN) | GEM_BIT(PCSSEL);
|
||||
|
||||
status_change = 1;
|
||||
}
|
||||
/* Apply the new configuration, if any */
|
||||
if (old_ctrl ^ ctrl)
|
||||
macb_or_gem_writel(bp, NCFGR, ctrl);
|
||||
|
||||
bp->speed = state->speed;
|
||||
|
||||
spin_unlock_irqrestore(&bp->lock, flags);
|
||||
|
||||
if (status_change) {
|
||||
if (phydev->link) {
|
||||
/* Update the TX clock rate if and only if the link is
|
||||
* up and there has been a link change.
|
||||
*/
|
||||
macb_set_tx_clk(bp->tx_clk, phydev->speed, dev);
|
||||
|
||||
netif_carrier_on(dev);
|
||||
netdev_info(dev, "link up (%d/%s)\n",
|
||||
phydev->speed,
|
||||
phydev->duplex == DUPLEX_FULL ?
|
||||
"Full" : "Half");
|
||||
} else {
|
||||
netif_carrier_off(dev);
|
||||
netdev_info(dev, "link down\n");
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/* based on au1000_eth. c*/
|
||||
static int macb_mii_probe(struct net_device *dev)
|
||||
static void macb_mac_link_down(struct phylink_config *config, unsigned int mode,
|
||||
phy_interface_t interface)
|
||||
{
|
||||
struct macb *bp = netdev_priv(dev);
|
||||
struct net_device *ndev = to_net_dev(config->dev);
|
||||
struct macb *bp = netdev_priv(ndev);
|
||||
struct macb_queue *queue;
|
||||
unsigned int q;
|
||||
u32 ctrl;
|
||||
|
||||
for (q = 0, queue = bp->queues; q < bp->num_queues; ++q, ++queue)
|
||||
queue_writel(queue, IDR,
|
||||
bp->rx_intr_mask | MACB_TX_INT_FLAGS | MACB_BIT(HRESP));
|
||||
|
||||
/* Disable Rx and Tx */
|
||||
ctrl = macb_readl(bp, NCR) & ~(MACB_BIT(RE) | MACB_BIT(TE));
|
||||
macb_writel(bp, NCR, ctrl);
|
||||
|
||||
netif_tx_stop_all_queues(ndev);
|
||||
}
|
||||
|
||||
static void macb_mac_link_up(struct phylink_config *config, unsigned int mode,
|
||||
phy_interface_t interface, struct phy_device *phy)
|
||||
{
|
||||
struct net_device *ndev = to_net_dev(config->dev);
|
||||
struct macb *bp = netdev_priv(ndev);
|
||||
struct macb_queue *queue;
|
||||
unsigned int q;
|
||||
|
||||
macb_set_tx_clk(bp->tx_clk, bp->speed, ndev);
|
||||
|
||||
/* Initialize rings & buffers as clearing MACB_BIT(TE) in link down
|
||||
* cleared the pipeline and control registers.
|
||||
*/
|
||||
bp->macbgem_ops.mog_init_rings(bp);
|
||||
macb_init_buffers(bp);
|
||||
|
||||
for (q = 0, queue = bp->queues; q < bp->num_queues; ++q, ++queue)
|
||||
queue_writel(queue, IER,
|
||||
bp->rx_intr_mask | MACB_TX_INT_FLAGS | MACB_BIT(HRESP));
|
||||
|
||||
/* Enable Rx and Tx */
|
||||
macb_writel(bp, NCR, macb_readl(bp, NCR) | MACB_BIT(RE) | MACB_BIT(TE));
|
||||
|
||||
netif_tx_wake_all_queues(ndev);
|
||||
}
|
||||
|
||||
static const struct phylink_mac_ops macb_phylink_ops = {
|
||||
.validate = macb_validate,
|
||||
.mac_link_state = macb_mac_link_state,
|
||||
.mac_an_restart = macb_mac_an_restart,
|
||||
.mac_config = macb_mac_config,
|
||||
.mac_link_down = macb_mac_link_down,
|
||||
.mac_link_up = macb_mac_link_up,
|
||||
};
|
||||
|
||||
static int macb_phylink_connect(struct macb *bp)
|
||||
{
|
||||
struct net_device *dev = bp->dev;
|
||||
struct phy_device *phydev;
|
||||
struct device_node *np;
|
||||
int ret, i;
|
||||
int ret;
|
||||
|
||||
np = bp->pdev->dev.of_node;
|
||||
ret = 0;
|
||||
|
||||
if (np) {
|
||||
if (of_phy_is_fixed_link(np)) {
|
||||
bp->phy_node = of_node_get(np);
|
||||
} else {
|
||||
bp->phy_node = of_parse_phandle(np, "phy-handle", 0);
|
||||
/* fallback to standard phy registration if no
|
||||
* phy-handle was found nor any phy found during
|
||||
* dt phy registration
|
||||
*/
|
||||
if (!bp->phy_node && !phy_find_first(bp->mii_bus)) {
|
||||
for (i = 0; i < PHY_MAX_ADDR; i++) {
|
||||
phydev = mdiobus_scan(bp->mii_bus, i);
|
||||
if (IS_ERR(phydev) &&
|
||||
PTR_ERR(phydev) != -ENODEV) {
|
||||
ret = PTR_ERR(phydev);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
if (ret)
|
||||
return -ENODEV;
|
||||
}
|
||||
if (bp->pdev->dev.of_node &&
|
||||
of_parse_phandle(bp->pdev->dev.of_node, "phy-handle", 0)) {
|
||||
ret = phylink_of_phy_connect(bp->phylink, bp->pdev->dev.of_node,
|
||||
0);
|
||||
if (ret) {
|
||||
netdev_err(dev, "Could not attach PHY (%d)\n", ret);
|
||||
return ret;
|
||||
}
|
||||
}
|
||||
|
||||
if (bp->phy_node) {
|
||||
phydev = of_phy_connect(dev, bp->phy_node,
|
||||
&macb_handle_link_change, 0,
|
||||
bp->phy_interface);
|
||||
if (!phydev)
|
||||
return -ENODEV;
|
||||
} else {
|
||||
phydev = phy_find_first(bp->mii_bus);
|
||||
if (!phydev) {
|
||||
|
@ -569,27 +633,33 @@ static int macb_mii_probe(struct net_device *dev)
|
|||
}
|
||||
|
||||
/* attach the mac to the phy */
|
||||
ret = phy_connect_direct(dev, phydev, &macb_handle_link_change,
|
||||
bp->phy_interface);
|
||||
ret = phylink_connect_phy(bp->phylink, phydev);
|
||||
if (ret) {
|
||||
netdev_err(dev, "Could not attach to PHY\n");
|
||||
netdev_err(dev, "Could not attach to PHY (%d)\n", ret);
|
||||
return ret;
|
||||
}
|
||||
}
|
||||
|
||||
/* mask with MAC supported features */
|
||||
if (macb_is_gem(bp) && bp->caps & MACB_CAPS_GIGABIT_MODE_AVAILABLE)
|
||||
phy_set_max_speed(phydev, SPEED_1000);
|
||||
else
|
||||
phy_set_max_speed(phydev, SPEED_100);
|
||||
phylink_start(bp->phylink);
|
||||
|
||||
if (bp->caps & MACB_CAPS_NO_GIGABIT_HALF)
|
||||
phy_remove_link_mode(phydev,
|
||||
ETHTOOL_LINK_MODE_1000baseT_Half_BIT);
|
||||
return 0;
|
||||
}
|
||||
|
||||
bp->link = 0;
|
||||
bp->speed = 0;
|
||||
bp->duplex = -1;
|
||||
/* based on au1000_eth. c*/
|
||||
static int macb_mii_probe(struct net_device *dev)
|
||||
{
|
||||
struct macb *bp = netdev_priv(dev);
|
||||
|
||||
bp->phylink_config.dev = &dev->dev;
|
||||
bp->phylink_config.type = PHYLINK_NETDEV;
|
||||
|
||||
bp->phylink = phylink_create(&bp->phylink_config, bp->pdev->dev.fwnode,
|
||||
bp->phy_interface, &macb_phylink_ops);
|
||||
if (IS_ERR(bp->phylink)) {
|
||||
netdev_err(dev, "Could not create a phylink instance (%ld)\n",
|
||||
PTR_ERR(bp->phylink));
|
||||
return PTR_ERR(bp->phylink);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
@ -619,20 +689,10 @@ static int macb_mii_init(struct macb *bp)
|
|||
dev_set_drvdata(&bp->dev->dev, bp->mii_bus);
|
||||
|
||||
np = bp->pdev->dev.of_node;
|
||||
if (np && of_phy_is_fixed_link(np)) {
|
||||
if (of_phy_register_fixed_link(np) < 0) {
|
||||
dev_err(&bp->pdev->dev,
|
||||
"broken fixed-link specification %pOF\n", np);
|
||||
goto err_out_free_mdiobus;
|
||||
}
|
||||
|
||||
err = mdiobus_register(bp->mii_bus);
|
||||
} else {
|
||||
err = of_mdiobus_register(bp->mii_bus, np);
|
||||
}
|
||||
|
||||
err = of_mdiobus_register(bp->mii_bus, np);
|
||||
if (err)
|
||||
goto err_out_free_fixed_link;
|
||||
goto err_out_free_mdiobus;
|
||||
|
||||
err = macb_mii_probe(bp->dev);
|
||||
if (err)
|
||||
|
@ -642,11 +702,7 @@ static int macb_mii_init(struct macb *bp)
|
|||
|
||||
err_out_unregister_bus:
|
||||
mdiobus_unregister(bp->mii_bus);
|
||||
err_out_free_fixed_link:
|
||||
if (np && of_phy_is_fixed_link(np))
|
||||
of_phy_deregister_fixed_link(np);
|
||||
err_out_free_mdiobus:
|
||||
of_node_put(bp->phy_node);
|
||||
mdiobus_free(bp->mii_bus);
|
||||
err_out:
|
||||
return err;
|
||||
|
@ -2230,19 +2286,13 @@ static void macb_configure_dma(struct macb *bp)
|
|||
|
||||
static void macb_init_hw(struct macb *bp)
|
||||
{
|
||||
struct macb_queue *queue;
|
||||
unsigned int q;
|
||||
|
||||
u32 config;
|
||||
|
||||
macb_reset_hw(bp);
|
||||
macb_set_hwaddr(bp);
|
||||
|
||||
config = macb_mdc_clk_div(bp);
|
||||
if (bp->phy_interface == PHY_INTERFACE_MODE_SGMII)
|
||||
config |= GEM_BIT(SGMIIEN) | GEM_BIT(PCSSEL);
|
||||
config |= MACB_BF(RBOF, NET_IP_ALIGN); /* Make eth data aligned */
|
||||
config |= MACB_BIT(PAE); /* PAuse Enable */
|
||||
config |= MACB_BIT(DRFCS); /* Discard Rx FCS */
|
||||
if (bp->caps & MACB_CAPS_JUMBO)
|
||||
config |= MACB_BIT(JFRAME); /* Enable jumbo frames */
|
||||
|
@ -2258,36 +2308,11 @@ static void macb_init_hw(struct macb *bp)
|
|||
macb_writel(bp, NCFGR, config);
|
||||
if ((bp->caps & MACB_CAPS_JUMBO) && bp->jumbo_max_len)
|
||||
gem_writel(bp, JML, bp->jumbo_max_len);
|
||||
bp->speed = SPEED_10;
|
||||
bp->duplex = DUPLEX_HALF;
|
||||
bp->rx_frm_len_mask = MACB_RX_FRMLEN_MASK;
|
||||
if (bp->caps & MACB_CAPS_JUMBO)
|
||||
bp->rx_frm_len_mask = MACB_RX_JFRMLEN_MASK;
|
||||
|
||||
macb_configure_dma(bp);
|
||||
|
||||
/* Initialize TX and RX buffers */
|
||||
for (q = 0, queue = bp->queues; q < bp->num_queues; ++q, ++queue) {
|
||||
queue_writel(queue, RBQP, lower_32_bits(queue->rx_ring_dma));
|
||||
#ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT
|
||||
if (bp->hw_dma_cap & HW_DMA_CAP_64B)
|
||||
queue_writel(queue, RBQPH, upper_32_bits(queue->rx_ring_dma));
|
||||
#endif
|
||||
queue_writel(queue, TBQP, lower_32_bits(queue->tx_ring_dma));
|
||||
#ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT
|
||||
if (bp->hw_dma_cap & HW_DMA_CAP_64B)
|
||||
queue_writel(queue, TBQPH, upper_32_bits(queue->tx_ring_dma));
|
||||
#endif
|
||||
|
||||
/* Enable interrupts */
|
||||
queue_writel(queue, IER,
|
||||
bp->rx_intr_mask |
|
||||
MACB_TX_INT_FLAGS |
|
||||
MACB_BIT(HRESP));
|
||||
}
|
||||
|
||||
/* Enable TX and RX */
|
||||
macb_writel(bp, NCR, macb_readl(bp, NCR) | MACB_BIT(RE) | MACB_BIT(TE));
|
||||
}
|
||||
|
||||
/* The hash address register is 64 bits long and takes up two
|
||||
|
@ -2411,8 +2436,8 @@ static void macb_set_rx_mode(struct net_device *dev)
|
|||
|
||||
static int macb_open(struct net_device *dev)
|
||||
{
|
||||
struct macb *bp = netdev_priv(dev);
|
||||
size_t bufsz = dev->mtu + ETH_HLEN + ETH_FCS_LEN + NET_IP_ALIGN;
|
||||
struct macb *bp = netdev_priv(dev);
|
||||
struct macb_queue *queue;
|
||||
unsigned int q;
|
||||
int err;
|
||||
|
@ -2423,15 +2448,6 @@ static int macb_open(struct net_device *dev)
|
|||
if (err < 0)
|
||||
goto pm_exit;
|
||||
|
||||
/* carrier starts down */
|
||||
netif_carrier_off(dev);
|
||||
|
||||
/* if the phy is not yet register, retry later*/
|
||||
if (!dev->phydev) {
|
||||
err = -EAGAIN;
|
||||
goto pm_exit;
|
||||
}
|
||||
|
||||
/* RX buffers initialization */
|
||||
macb_init_rx_buffer_size(bp, bufsz);
|
||||
|
||||
|
@ -2445,11 +2461,11 @@ static int macb_open(struct net_device *dev)
|
|||
for (q = 0, queue = bp->queues; q < bp->num_queues; ++q, ++queue)
|
||||
napi_enable(&queue->napi);
|
||||
|
||||
bp->macbgem_ops.mog_init_rings(bp);
|
||||
macb_init_hw(bp);
|
||||
|
||||
/* schedule a link state check */
|
||||
phy_start(dev->phydev);
|
||||
err = macb_phylink_connect(bp);
|
||||
if (err)
|
||||
goto pm_exit;
|
||||
|
||||
netif_tx_start_all_queues(dev);
|
||||
|
||||
|
@ -2476,8 +2492,8 @@ static int macb_close(struct net_device *dev)
|
|||
for (q = 0, queue = bp->queues; q < bp->num_queues; ++q, ++queue)
|
||||
napi_disable(&queue->napi);
|
||||
|
||||
if (dev->phydev)
|
||||
phy_stop(dev->phydev);
|
||||
phylink_stop(bp->phylink);
|
||||
phylink_disconnect_phy(bp->phylink);
|
||||
|
||||
spin_lock_irqsave(&bp->lock, flags);
|
||||
macb_reset_hw(bp);
|
||||
|
@ -2711,17 +2727,18 @@ static void macb_get_wol(struct net_device *netdev, struct ethtool_wolinfo *wol)
|
|||
wol->supported = 0;
|
||||
wol->wolopts = 0;
|
||||
|
||||
if (bp->wol & MACB_WOL_HAS_MAGIC_PACKET) {
|
||||
wol->supported = WAKE_MAGIC;
|
||||
|
||||
if (bp->wol & MACB_WOL_ENABLED)
|
||||
wol->wolopts |= WAKE_MAGIC;
|
||||
}
|
||||
if (bp->wol & MACB_WOL_HAS_MAGIC_PACKET)
|
||||
phylink_ethtool_get_wol(bp->phylink, wol);
|
||||
}
|
||||
|
||||
static int macb_set_wol(struct net_device *netdev, struct ethtool_wolinfo *wol)
|
||||
{
|
||||
struct macb *bp = netdev_priv(netdev);
|
||||
int ret;
|
||||
|
||||
ret = phylink_ethtool_set_wol(bp->phylink, wol);
|
||||
if (!ret)
|
||||
return 0;
|
||||
|
||||
if (!(bp->wol & MACB_WOL_HAS_MAGIC_PACKET) ||
|
||||
(wol->wolopts & ~WAKE_MAGIC))
|
||||
|
@ -2737,6 +2754,22 @@ static int macb_set_wol(struct net_device *netdev, struct ethtool_wolinfo *wol)
|
|||
return 0;
|
||||
}
|
||||
|
||||
static int macb_get_link_ksettings(struct net_device *netdev,
|
||||
struct ethtool_link_ksettings *kset)
|
||||
{
|
||||
struct macb *bp = netdev_priv(netdev);
|
||||
|
||||
return phylink_ethtool_ksettings_get(bp->phylink, kset);
|
||||
}
|
||||
|
||||
static int macb_set_link_ksettings(struct net_device *netdev,
|
||||
const struct ethtool_link_ksettings *kset)
|
||||
{
|
||||
struct macb *bp = netdev_priv(netdev);
|
||||
|
||||
return phylink_ethtool_ksettings_set(bp->phylink, kset);
|
||||
}
|
||||
|
||||
static void macb_get_ringparam(struct net_device *netdev,
|
||||
struct ethtool_ringparam *ring)
|
||||
{
|
||||
|
@ -3173,8 +3206,8 @@ static const struct ethtool_ops macb_ethtool_ops = {
|
|||
.get_ts_info = ethtool_op_get_ts_info,
|
||||
.get_wol = macb_get_wol,
|
||||
.set_wol = macb_set_wol,
|
||||
.get_link_ksettings = phy_ethtool_get_link_ksettings,
|
||||
.set_link_ksettings = phy_ethtool_set_link_ksettings,
|
||||
.get_link_ksettings = macb_get_link_ksettings,
|
||||
.set_link_ksettings = macb_set_link_ksettings,
|
||||
.get_ringparam = macb_get_ringparam,
|
||||
.set_ringparam = macb_set_ringparam,
|
||||
};
|
||||
|
@ -3187,8 +3220,8 @@ static const struct ethtool_ops gem_ethtool_ops = {
|
|||
.get_ethtool_stats = gem_get_ethtool_stats,
|
||||
.get_strings = gem_get_ethtool_strings,
|
||||
.get_sset_count = gem_get_sset_count,
|
||||
.get_link_ksettings = phy_ethtool_get_link_ksettings,
|
||||
.set_link_ksettings = phy_ethtool_set_link_ksettings,
|
||||
.get_link_ksettings = macb_get_link_ksettings,
|
||||
.set_link_ksettings = macb_set_link_ksettings,
|
||||
.get_ringparam = macb_get_ringparam,
|
||||
.set_ringparam = macb_set_ringparam,
|
||||
.get_rxnfc = gem_get_rxnfc,
|
||||
|
@ -3197,26 +3230,21 @@ static const struct ethtool_ops gem_ethtool_ops = {
|
|||
|
||||
static int macb_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
|
||||
{
|
||||
struct phy_device *phydev = dev->phydev;
|
||||
struct macb *bp = netdev_priv(dev);
|
||||
|
||||
if (!netif_running(dev))
|
||||
return -EINVAL;
|
||||
|
||||
if (!phydev)
|
||||
return -ENODEV;
|
||||
|
||||
if (!bp->ptp_info)
|
||||
return phy_mii_ioctl(phydev, rq, cmd);
|
||||
|
||||
switch (cmd) {
|
||||
case SIOCSHWTSTAMP:
|
||||
return bp->ptp_info->set_hwtst(dev, rq, cmd);
|
||||
case SIOCGHWTSTAMP:
|
||||
return bp->ptp_info->get_hwtst(dev, rq);
|
||||
default:
|
||||
return phy_mii_ioctl(phydev, rq, cmd);
|
||||
if (bp->ptp_info) {
|
||||
switch (cmd) {
|
||||
case SIOCSHWTSTAMP:
|
||||
return bp->ptp_info->set_hwtst(dev, rq, cmd);
|
||||
case SIOCGHWTSTAMP:
|
||||
return bp->ptp_info->get_hwtst(dev, rq);
|
||||
}
|
||||
}
|
||||
|
||||
return phylink_mii_ioctl(bp->phylink, rq, cmd);
|
||||
}
|
||||
|
||||
static inline void macb_set_txcsum_feature(struct macb *bp,
|
||||
|
@ -3339,7 +3367,8 @@ static void macb_configure_caps(struct macb *bp,
|
|||
#ifdef CONFIG_MACB_USE_HWSTAMP
|
||||
if (gem_has_ptp(bp)) {
|
||||
if (!GEM_BFEXT(TSU, gem_readl(bp, DCFG5)))
|
||||
pr_err("GEM doesn't support hardware ptp.\n");
|
||||
dev_err(&bp->pdev->dev,
|
||||
"GEM doesn't support hardware ptp.\n");
|
||||
else {
|
||||
bp->hw_dma_cap |= HW_DMA_CAP_PTP;
|
||||
bp->ptp_info = &gem_ptp_info;
|
||||
|
@ -3716,8 +3745,9 @@ static int at91ether_open(struct net_device *dev)
|
|||
MACB_BIT(ISR_ROVR) |
|
||||
MACB_BIT(HRESP));
|
||||
|
||||
/* schedule a link state check */
|
||||
phy_start(dev->phydev);
|
||||
ret = macb_phylink_connect(lp);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
netif_start_queue(dev);
|
||||
|
||||
|
@ -3746,6 +3776,9 @@ static int at91ether_close(struct net_device *dev)
|
|||
|
||||
netif_stop_queue(dev);
|
||||
|
||||
phylink_stop(lp->phylink);
|
||||
phylink_disconnect_phy(lp->phylink);
|
||||
|
||||
dma_free_coherent(&lp->pdev->dev,
|
||||
AT91ETHER_MAX_RX_DESCR *
|
||||
macb_dma_desc_get_size(lp),
|
||||
|
@ -4190,7 +4223,6 @@ static int macb_probe(struct platform_device *pdev)
|
|||
struct clk *tsu_clk = NULL;
|
||||
unsigned int queue_mask, num_queues;
|
||||
bool native_io;
|
||||
struct phy_device *phydev;
|
||||
phy_interface_t interface;
|
||||
struct net_device *dev;
|
||||
struct resource *regs;
|
||||
|
@ -4325,6 +4357,8 @@ static int macb_probe(struct platform_device *pdev)
|
|||
else
|
||||
bp->phy_interface = interface;
|
||||
|
||||
bp->speed = SPEED_UNKNOWN;
|
||||
|
||||
/* IP specific init */
|
||||
err = init(pdev);
|
||||
if (err)
|
||||
|
@ -4334,8 +4368,6 @@ static int macb_probe(struct platform_device *pdev)
|
|||
if (err)
|
||||
goto err_out_free_netdev;
|
||||
|
||||
phydev = dev->phydev;
|
||||
|
||||
netif_carrier_off(dev);
|
||||
|
||||
err = register_netdev(dev);
|
||||
|
@ -4347,8 +4379,6 @@ static int macb_probe(struct platform_device *pdev)
|
|||
tasklet_init(&bp->hresp_err_tasklet, macb_hresp_error_task,
|
||||
(unsigned long)bp);
|
||||
|
||||
phy_attached_info(phydev);
|
||||
|
||||
netdev_info(dev, "Cadence %s rev 0x%08x at 0x%08lx irq %d (%pM)\n",
|
||||
macb_is_gem(bp) ? "GEM" : "MACB", macb_readl(bp, MID),
|
||||
dev->base_addr, dev->irq, dev->dev_addr);
|
||||
|
@ -4359,11 +4389,7 @@ static int macb_probe(struct platform_device *pdev)
|
|||
return 0;
|
||||
|
||||
err_out_unregister_mdio:
|
||||
phy_disconnect(dev->phydev);
|
||||
mdiobus_unregister(bp->mii_bus);
|
||||
of_node_put(bp->phy_node);
|
||||
if (np && of_phy_is_fixed_link(np))
|
||||
of_phy_deregister_fixed_link(np);
|
||||
mdiobus_free(bp->mii_bus);
|
||||
|
||||
err_out_free_netdev:
|
||||
|
@ -4387,18 +4413,12 @@ static int macb_remove(struct platform_device *pdev)
|
|||
{
|
||||
struct net_device *dev;
|
||||
struct macb *bp;
|
||||
struct device_node *np = pdev->dev.of_node;
|
||||
|
||||
dev = platform_get_drvdata(pdev);
|
||||
|
||||
if (dev) {
|
||||
bp = netdev_priv(dev);
|
||||
if (dev->phydev)
|
||||
phy_disconnect(dev->phydev);
|
||||
mdiobus_unregister(bp->mii_bus);
|
||||
if (np && of_phy_is_fixed_link(np))
|
||||
of_phy_deregister_fixed_link(np);
|
||||
dev->phydev = NULL;
|
||||
mdiobus_free(bp->mii_bus);
|
||||
|
||||
unregister_netdev(dev);
|
||||
|
@ -4413,7 +4433,7 @@ static int macb_remove(struct platform_device *pdev)
|
|||
clk_disable_unprepare(bp->tsu_clk);
|
||||
pm_runtime_set_suspended(&pdev->dev);
|
||||
}
|
||||
of_node_put(bp->phy_node);
|
||||
phylink_destroy(bp->phylink);
|
||||
free_netdev(dev);
|
||||
}
|
||||
|
||||
|
@ -4431,7 +4451,6 @@ static int __maybe_unused macb_suspend(struct device *dev)
|
|||
if (!netif_running(netdev))
|
||||
return 0;
|
||||
|
||||
|
||||
if (bp->wol & MACB_WOL_ENABLED) {
|
||||
macb_writel(bp, IER, MACB_BIT(WOL));
|
||||
macb_writel(bp, WOL, MACB_BIT(MAG));
|
||||
|
@ -4442,8 +4461,9 @@ static int __maybe_unused macb_suspend(struct device *dev)
|
|||
for (q = 0, queue = bp->queues; q < bp->num_queues;
|
||||
++q, ++queue)
|
||||
napi_disable(&queue->napi);
|
||||
phy_stop(netdev->phydev);
|
||||
phy_suspend(netdev->phydev);
|
||||
rtnl_lock();
|
||||
phylink_stop(bp->phylink);
|
||||
rtnl_unlock();
|
||||
spin_lock_irqsave(&bp->lock, flags);
|
||||
macb_reset_hw(bp);
|
||||
spin_unlock_irqrestore(&bp->lock, flags);
|
||||
|
@ -4491,12 +4511,11 @@ static int __maybe_unused macb_resume(struct device *dev)
|
|||
for (q = 0, queue = bp->queues; q < bp->num_queues;
|
||||
++q, ++queue)
|
||||
napi_enable(&queue->napi);
|
||||
phy_resume(netdev->phydev);
|
||||
phy_init_hw(netdev->phydev);
|
||||
phy_start(netdev->phydev);
|
||||
rtnl_lock();
|
||||
phylink_start(bp->phylink);
|
||||
rtnl_unlock();
|
||||
}
|
||||
|
||||
bp->macbgem_ops.mog_init_rings(bp);
|
||||
macb_init_hw(bp);
|
||||
macb_set_rx_mode(netdev);
|
||||
macb_restore_features(bp);
|
||||
|
|
Loading…
Reference in New Issue