Commit 5d7f6f68 authored by Wei Fang's avatar Wei Fang Committed by Jakub Kicinski
Browse files

net: enetc: move generic VLAN hash filter functions to enetc_pf_common.c 



The VLAN hash filters of ENETC v1 and v4 are basically the same, the only
difference is that the offset of the VLAN hash filter registers has been
changed in ENETC v4. So some functions like enetc_vlan_rx_add_vid() and
enetc_vlan_rx_del_vid() only need to be slightly modified to be reused
by ENETC v4. Currently, we just move these functions from enetc_pf.c to
enetc_pf_common.c. Appropriate modifications will be made for ENETC4 in
a subsequent patch.

Signed-off-by: default avatarWei Fang <wei.fang@nxp.com>
Reviewed-by: default avatarVladimir Oltean <vladimir.oltean@nxp.com>
Link: https://patch.msgid.link/20250506080735.3444381-13-wei.fang@nxp.com


Signed-off-by: default avatarJakub Kicinski <kuba@kernel.org>
parent 014e33e2

drivers/net/ethernet/freescale/enetc/enetc_pf.c

+0 −57
Original line number Diff line number Diff line
@@ -216,63 +216,6 @@ static void enetc_pf_set_rx_mode(struct net_device *ndev) 
	enetc_port_wr(hw, ENETC_PSIPMR, psipmr);

}



static void enetc_set_vlan_ht_filter(struct enetc_hw *hw, int si_idx,

				     unsigned long hash)

{

	enetc_port_wr(hw, ENETC_PSIVHFR0(si_idx), lower_32_bits(hash));

	enetc_port_wr(hw, ENETC_PSIVHFR1(si_idx), upper_32_bits(hash));

}



static int enetc_vid_hash_idx(unsigned int vid)

{

	int res = 0;

	int i;



	for (i = 0; i < 6; i++)

		res |= (hweight8(vid & (BIT(i) | BIT(i + 6))) & 0x1) << i;



	return res;

}



static void enetc_refresh_vlan_ht_filter(struct enetc_pf *pf)

{

	int i;



	bitmap_zero(pf->vlan_ht_filter, ENETC_VLAN_HT_SIZE);

	for_each_set_bit(i, pf->active_vlans, VLAN_N_VID) {

		int hidx = enetc_vid_hash_idx(i);



		__set_bit(hidx, pf->vlan_ht_filter);

	}

}



static int enetc_vlan_rx_add_vid(struct net_device *ndev, __be16 prot, u16 vid)

{

	struct enetc_ndev_priv *priv = netdev_priv(ndev);

	struct enetc_pf *pf = enetc_si_priv(priv->si);

	int idx;



	__set_bit(vid, pf->active_vlans);



	idx = enetc_vid_hash_idx(vid);

	if (!__test_and_set_bit(idx, pf->vlan_ht_filter))

		enetc_set_vlan_ht_filter(&pf->si->hw, 0, *pf->vlan_ht_filter);



	return 0;

}



static int enetc_vlan_rx_del_vid(struct net_device *ndev, __be16 prot, u16 vid)

{

	struct enetc_ndev_priv *priv = netdev_priv(ndev);

	struct enetc_pf *pf = enetc_si_priv(priv->si);



	__clear_bit(vid, pf->active_vlans);

	enetc_refresh_vlan_ht_filter(pf);

	enetc_set_vlan_ht_filter(&pf->si->hw, 0, *pf->vlan_ht_filter);



	return 0;

}



static void enetc_set_loopback(struct net_device *ndev, bool en)

{

	struct enetc_ndev_priv *priv = netdev_priv(ndev);

drivers/net/ethernet/freescale/enetc/enetc_pf_common.c

+60 −0
Original line number Diff line number Diff line
@@ -353,5 +353,65 @@ void enetc_set_default_rss_key(struct enetc_pf *pf) 
}

EXPORT_SYMBOL_GPL(enetc_set_default_rss_key);



static int enetc_vid_hash_idx(unsigned int vid)

{

	int res = 0;

	int i;



	for (i = 0; i < 6; i++)

		res |= (hweight8(vid & (BIT(i) | BIT(i + 6))) & 0x1) << i;



	return res;

}



static void enetc_refresh_vlan_ht_filter(struct enetc_pf *pf)

{

	int i;



	bitmap_zero(pf->vlan_ht_filter, ENETC_VLAN_HT_SIZE);

	for_each_set_bit(i, pf->active_vlans, VLAN_N_VID) {

		int hidx = enetc_vid_hash_idx(i);



		__set_bit(hidx, pf->vlan_ht_filter);

	}

}



static void enetc_set_vlan_ht_filter(struct enetc_hw *hw, int si_idx,

				     unsigned long hash)

{

	enetc_port_wr(hw, ENETC_PSIVHFR0(si_idx), lower_32_bits(hash));

	enetc_port_wr(hw, ENETC_PSIVHFR1(si_idx), upper_32_bits(hash));

}



int enetc_vlan_rx_add_vid(struct net_device *ndev, __be16 prot, u16 vid)

{

	struct enetc_ndev_priv *priv = netdev_priv(ndev);

	struct enetc_pf *pf = enetc_si_priv(priv->si);

	int idx;



	__set_bit(vid, pf->active_vlans);



	idx = enetc_vid_hash_idx(vid);

	if (!__test_and_set_bit(idx, pf->vlan_ht_filter))

		enetc_set_vlan_ht_filter(&pf->si->hw, 0, *pf->vlan_ht_filter);



	return 0;

}

EXPORT_SYMBOL_GPL(enetc_vlan_rx_add_vid);



int enetc_vlan_rx_del_vid(struct net_device *ndev, __be16 prot, u16 vid)

{

	struct enetc_ndev_priv *priv = netdev_priv(ndev);

	struct enetc_pf *pf = enetc_si_priv(priv->si);



	if (__test_and_clear_bit(vid, pf->active_vlans)) {

		enetc_refresh_vlan_ht_filter(pf);

		enetc_set_vlan_ht_filter(&pf->si->hw, 0, *pf->vlan_ht_filter);

	}



	return 0;

}

EXPORT_SYMBOL_GPL(enetc_vlan_rx_del_vid);



MODULE_DESCRIPTION("NXP ENETC PF common functionality driver");

MODULE_LICENSE("Dual BSD/GPL");

drivers/net/ethernet/freescale/enetc/enetc_pf_common.h

+2 −0
Original line number Diff line number Diff line
@@ -13,6 +13,8 @@ int enetc_phylink_create(struct enetc_ndev_priv *priv, struct device_node *node, 
			 const struct phylink_mac_ops *ops);

void enetc_phylink_destroy(struct enetc_ndev_priv *priv);

void enetc_set_default_rss_key(struct enetc_pf *pf);

int enetc_vlan_rx_add_vid(struct net_device *ndev, __be16 prot, u16 vid);

int enetc_vlan_rx_del_vid(struct net_device *ndev, __be16 prot, u16 vid);



static inline u16 enetc_get_ip_revision(struct enetc_hw *hw)

{