From 182bf3ddfc0168ca2df3da477b143bab17543b65 Mon Sep 17 00:00:00 2001 From: Ioana Radulescu Date: Wed, 13 Mar 2019 19:12:47 +0200 Subject: [PATCH] staging: fsl-dpaa2/mac: add pause frames support for managed phys Read the configured dpmac options and depending on the supported features set the according advertising bit. Signed-off-by: Ioana Ciornei Signed-off-by: Bogdan Purcareata Signed-off-by: Ioana Radulescu --- drivers/staging/fsl-dpaa2/mac/mac.c | 19 +++++++++++++++++++ 1 file changed, 19 insertions(+) --- a/drivers/staging/fsl-dpaa2/mac/mac.c +++ b/drivers/staging/fsl-dpaa2/mac/mac.c @@ -148,6 +148,11 @@ static void dpaa2_mac_link_changed(struc if (phydev->autoneg) state.options |= DPMAC_LINK_OPT_AUTONEG; + if (phydev->pause && linkmode_test_bit(ETHTOOL_LINK_MODE_Pause_BIT, phydev->advertising)) + state.options |= DPMAC_LINK_OPT_PAUSE; + if (phydev->pause && linkmode_test_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, phydev->advertising)) + state.options |= DPMAC_LINK_OPT_ASYM_PAUSE; + netif_carrier_on(netdev); } else { netif_carrier_off(netdev); @@ -415,6 +420,20 @@ static void configure_link(struct dpaa2_ link_mode_dpmac2phydev(cfg->advertising, phydev->advertising); } + if (linkmode_test_bit(ETHTOOL_LINK_MODE_Pause_BIT, phydev->supported)) { + if (cfg->options & DPMAC_LINK_OPT_PAUSE) + linkmode_set_bit(ETHTOOL_LINK_MODE_Pause_BIT, phydev->advertising); + else + linkmode_clear_bit(ETHTOOL_LINK_MODE_Pause_BIT, phydev->advertising); + } + + if (linkmode_test_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, phydev->supported)) { + if (cfg->options & DPMAC_LINK_OPT_ASYM_PAUSE) + linkmode_set_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, phydev->advertising); + else + linkmode_clear_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, phydev->advertising); + } + if (cfg->options & DPMAC_LINK_OPT_AUTONEG) { phydev->autoneg = AUTONEG_ENABLE; linkmode_set_bit(ETHTOOL_LINK_MODE_Autoneg_BIT, phydev->advertising);