net: dsa: lantiq_gswip: support Energy Efficient Ethernet
Subsystems (3)
RFC PATCH 11/23 net: dsa: lantiq_gswip: support Energy Efficient Ethernet
Introduce support for Energy Efficient Ethernet (EEE) on switch API 2.3 or later.
Signed-off-by Daniel Golle <[email protected]>
--- drivers/net/dsa/lantiq_gswip.c | 57 +++++++++++++++++++++++++++++++--- drivers/net/dsa/lantiq_gswip.h | 7 +++++ 2 files changed, 60 insertions(+), 4 deletions(-)
drivers/net/dsa/lantiq_gswip.c +53 -4
@@ -1625,10 +1625,57 @@ static int gswip_get_sset_count(struct dsa_switch *ds, int port, int sset)return ARRAY_SIZE (gswip_rmon_cnt); } -static const struct phylink_mac_ops gswip_phylink_mac_ops = { - .mac_config = gswip_phylink_mac_config, - .mac_link_down = gswip_phylink_mac_link_down, - .mac_link_up = gswip_phylink_mac_link_up, +static int gswip_set_mac_eee (struct dsa_switch *ds,int port, +struct ethtool_keee *e) +{ +if (e->tx_lpi_timer >0x7f ) +return -EINVAL ; + +return 0 ; +} + +static void gswip_phylink_mac_disable_tx_lpi (struct phylink_config *config) +{ +struct dsa_port *dp =dsa_phylink_to_port (config); +struct gswip_priv *priv = dp->ds->priv; + +gswip_switch_mask (priv,GSWIP_MAC_CTRL_4_LPIEN ,0 , +GSWIP_MAC_CTRL_4p (dp->index)); +} + +static int gswip_phylink_mac_enable_tx_lpi (struct phylink_config *config, +u32 timer,bool tx_clock_stop) +{ +struct dsa_port *dp =dsa_phylink_to_port (config); +struct gswip_priv *priv = dp->ds->priv; + +gswip_switch_mask (priv,GSWIP_MAC_CTRL_4_LPIEN | +GSWIP_MAC_CTRL_4_GWAIT_MASK | +GSWIP_MAC_CTRL_4_WAIT_MASK , +GSWIP_MAC_CTRL_4_LPIEN | +GSWIP_MAC_CTRL_4_GWAIT (timer) | +GSWIP_MAC_CTRL_4_WAIT (timer), +GSWIP_MAC_CTRL_4p (dp->index)); + +return 0 ; +} + +static bool gswip_support_eee (struct dsa_switch *ds,int port) +{ +struct gswip_priv *priv = ds->priv; + +if (GSWIP_VERSION_GE (priv,GSWIP_VERSION_2_3 )) +return true; + +return false; +} + +const struct phylink_mac_ops gswip_phylink_mac_ops = { + .mac_config = gswip_phylink_mac_config, + .mac_link_down = gswip_phylink_mac_link_down, + .mac_link_up = gswip_phylink_mac_link_up, + .mac_disable_tx_lpi = gswip_phylink_mac_disable_tx_lpi, + .mac_enable_tx_lpi = gswip_phylink_mac_enable_tx_lpi, };static const struct dsa_switch_ops gswip_switch_ops = {
@@ -1652,6 +1699,8 @@ static const struct dsa_switch_ops gswip_switch_ops = { .get_strings = gswip_get_strings, .get_ethtool_stats = gswip_get_ethtool_stats, .get_sset_count = gswip_get_sset_count, + .set_mac_eee = gswip_set_mac_eee, + .support_eee = gswip_support_eee, };static const struct xway_gphy_match_data xrx200a1x_gphy_data = {
drivers/net/dsa/lantiq_gswip.h +7 -0
@@ -2,6 +2,7 @@#ifndef __LANTIQ_GSWIP_H#define __LANTIQ_GSWIP_H +#include <linux/bitfield.h> #include <linux/clk.h> #include <linux/mutex.h> #include <linux/platform_device.h>
@@ -183,6 +184,12 @@#define GSWIP_MAC_CTRL_2p (p) (0x905 + ((p) * 0xC))#define GSWIP_MAC_CTRL_2_LCHKL BIT(2)/* Frame Length Check Long Enable */ #define GSWIP_MAC_CTRL_2_MLEN BIT(3)/* Maximum Untagged Frame Lnegth */ +#define GSWIP_MAC_CTRL_4p (p) (0x907 + ((p) * 0xC)) +#define GSWIP_MAC_CTRL_4_LPIEN BIT(7)/* LPI Mode Enable */ +#define GSWIP_MAC_CTRL_4_GWAIT_MASK GENMASK(14, 8)/* LPI Wait Time 1G */ +#define GSWIP_MAC_CTRL_4_GWAIT (t) u16_encode_bits((t), GSWIP_MAC_CTRL_4_GWAIT_MASK) +#define GSWIP_MAC_CTRL_4_WAIT_MASK GENMASK(6, 0)/* LPI Wait Time 100M */ +#define GSWIP_MAC_CTRL_4_WAIT (t) u16_encode_bits((t), GSWIP_MAC_CTRL_4_WAIT_MASK)/* Ethernet Switch Fetch DMA Port Control Register */ #define GSWIP_FDMA_PCTRLp (p) (0xA80 + ((p) * 0x6))
Signature · 1 line
2.50.1