| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120 |
- From 40b5d2f15c091fa9c854acde91ad2acb504027d7 Mon Sep 17 00:00:00 2001
- From: =?UTF-8?q?Ren=C3=A9=20van=20Dorst?= <[email protected]>
- Date: Mon, 12 Apr 2021 08:50:31 +0200
- Subject: [PATCH] net: dsa: mt7530: Add support for EEE features
- MIME-Version: 1.0
- Content-Type: text/plain; charset=UTF-8
- Content-Transfer-Encoding: 8bit
- This patch adds EEE support.
- Signed-off-by: René van Dorst <[email protected]>
- Signed-off-by: David S. Miller <[email protected]>
- ---
- drivers/net/dsa/mt7530.c | 43 ++++++++++++++++++++++++++++++++++++++++
- drivers/net/dsa/mt7530.h | 14 ++++++++++++-
- 2 files changed, 56 insertions(+), 1 deletion(-)
- --- a/drivers/net/dsa/mt7530.c
- +++ b/drivers/net/dsa/mt7530.c
- @@ -2366,6 +2366,17 @@ static void mt753x_phylink_mac_link_up(s
- mcr |= PMCR_RX_FC_EN;
- }
-
- + if (mode == MLO_AN_PHY && phydev && phy_init_eee(phydev, 0) >= 0) {
- + switch (speed) {
- + case SPEED_1000:
- + mcr |= PMCR_FORCE_EEE1G;
- + break;
- + case SPEED_100:
- + mcr |= PMCR_FORCE_EEE100;
- + break;
- + }
- + }
- +
- mt7530_set(priv, MT7530_PMCR_P(port), mcr);
- }
-
- @@ -2596,6 +2607,36 @@ mt753x_phy_write(struct dsa_switch *ds,
- return priv->info->phy_write(ds, port, regnum, val);
- }
-
- +static int mt753x_get_mac_eee(struct dsa_switch *ds, int port,
- + struct ethtool_eee *e)
- +{
- + struct mt7530_priv *priv = ds->priv;
- + u32 eeecr = mt7530_read(priv, MT7530_PMEEECR_P(port));
- +
- + e->tx_lpi_enabled = !(eeecr & LPI_MODE_EN);
- + e->tx_lpi_timer = GET_LPI_THRESH(eeecr);
- +
- + return 0;
- +}
- +
- +static int mt753x_set_mac_eee(struct dsa_switch *ds, int port,
- + struct ethtool_eee *e)
- +{
- + struct mt7530_priv *priv = ds->priv;
- + u32 set, mask = LPI_THRESH_MASK | LPI_MODE_EN;
- +
- + if (e->tx_lpi_timer > 0xFFF)
- + return -EINVAL;
- +
- + set = SET_LPI_THRESH(e->tx_lpi_timer);
- + if (!e->tx_lpi_enabled)
- + /* Force LPI Mode without a delay */
- + set |= LPI_MODE_EN;
- + mt7530_rmw(priv, MT7530_PMEEECR_P(port), mask, set);
- +
- + return 0;
- +}
- +
- static const struct dsa_switch_ops mt7530_switch_ops = {
- .get_tag_protocol = mtk_get_tag_protocol,
- .setup = mt753x_setup,
- @@ -2624,6 +2665,8 @@ static const struct dsa_switch_ops mt753
- .phylink_mac_an_restart = mt753x_phylink_mac_an_restart,
- .phylink_mac_link_down = mt753x_phylink_mac_link_down,
- .phylink_mac_link_up = mt753x_phylink_mac_link_up,
- + .get_mac_eee = mt753x_get_mac_eee,
- + .set_mac_eee = mt753x_set_mac_eee,
- };
-
- static const struct mt753x_info mt753x_table[] = {
- --- a/drivers/net/dsa/mt7530.h
- +++ b/drivers/net/dsa/mt7530.h
- @@ -240,6 +240,8 @@ enum mt7530_vlan_port_attr {
- #define PMCR_RX_EN BIT(13)
- #define PMCR_BACKOFF_EN BIT(9)
- #define PMCR_BACKPR_EN BIT(8)
- +#define PMCR_FORCE_EEE1G BIT(7)
- +#define PMCR_FORCE_EEE100 BIT(6)
- #define PMCR_TX_FC_EN BIT(5)
- #define PMCR_RX_FC_EN BIT(4)
- #define PMCR_FORCE_SPEED_1000 BIT(3)
- @@ -264,7 +266,8 @@ enum mt7530_vlan_port_attr {
- #define PMCR_LINK_SETTINGS_MASK (PMCR_TX_EN | PMCR_FORCE_SPEED_1000 | \
- PMCR_RX_EN | PMCR_FORCE_SPEED_100 | \
- PMCR_TX_FC_EN | PMCR_RX_FC_EN | \
- - PMCR_FORCE_FDX | PMCR_FORCE_LNK)
- + PMCR_FORCE_FDX | PMCR_FORCE_LNK | \
- + PMCR_FORCE_EEE1G | PMCR_FORCE_EEE100)
- #define PMCR_CPU_PORT_SETTING(id) (PMCR_FORCE_MODE_ID((id)) | \
- PMCR_IFG_XMIT(1) | PMCR_MAC_MODE | \
- PMCR_BACKOFF_EN | PMCR_BACKPR_EN | \
- @@ -273,6 +276,15 @@ enum mt7530_vlan_port_attr {
- PMCR_FORCE_SPEED_1000 | \
- PMCR_FORCE_FDX | PMCR_FORCE_LNK)
-
- +#define MT7530_PMEEECR_P(x) (0x3004 + (x) * 0x100)
- +#define WAKEUP_TIME_1000(x) (((x) & 0xFF) << 24)
- +#define WAKEUP_TIME_100(x) (((x) & 0xFF) << 16)
- +#define LPI_THRESH_MASK GENMASK(15, 4)
- +#define LPI_THRESH_SHT 4
- +#define SET_LPI_THRESH(x) (((x) << LPI_THRESH_SHT) & LPI_THRESH_MASK)
- +#define GET_LPI_THRESH(x) (((x) & LPI_THRESH_MASK) >> LPI_THRESH_SHT)
- +#define LPI_MODE_EN BIT(0)
- +
- #define MT7530_PMSR_P(x) (0x3008 + (x) * 0x100)
- #define PMSR_EEE1G BIT(7)
- #define PMSR_EEE100M BIT(6)
|
