net: stmmac: add support for hash table size 128/256 in dwmac4
1. get hash table size in hw feature reigster, and add support for taller hash table(128/256) in dwmac4. 2. only clear GMAC_PACKET_FILTER bits used in this function, to avoid side effect to functions of other bits. stmmac selftests output log with flow control on: ethtool -t eth0 The test result is PASS The test extra info: 1. MAC Loopback 0 2. PHY Loopback -95 3. MMC Counters 0 4. EEE -95 5. Hash Filter MC 0 6. Perfect Filter UC 0 7. MC Filter 0 8. UC Filter 0 9. Flow Control 0 Signed-off-by: Biao Huang <biao.huang@mediatek.com> Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
		
							parent
							
								
									efd58adf8f
								
							
						
					
					
						commit
						b8ef7020d6
					
				| @ -326,6 +326,7 @@ struct dma_features { | ||||
| 	/* 802.3az - Energy-Efficient Ethernet (EEE) */ | ||||
| 	unsigned int eee; | ||||
| 	unsigned int av; | ||||
| 	unsigned int hash_tb_sz; | ||||
| 	unsigned int tsoen; | ||||
| 	/* TX and RX csum */ | ||||
| 	unsigned int tx_coe; | ||||
| @ -424,9 +425,9 @@ struct mac_device_info { | ||||
| 	struct mii_regs mii;	/* MII register Addresses */ | ||||
| 	struct mac_link link; | ||||
| 	void __iomem *pcsr;     /* vpointer to device CSRs */ | ||||
| 	int multicast_filter_bins; | ||||
| 	int unicast_filter_entries; | ||||
| 	int mcast_bits_log2; | ||||
| 	unsigned int multicast_filter_bins; | ||||
| 	unsigned int unicast_filter_entries; | ||||
| 	unsigned int mcast_bits_log2; | ||||
| 	unsigned int rx_csum; | ||||
| 	unsigned int pcs; | ||||
| 	unsigned int pmt; | ||||
|  | ||||
| @ -15,8 +15,7 @@ | ||||
| /*  MAC registers */ | ||||
| #define GMAC_CONFIG			0x00000000 | ||||
| #define GMAC_PACKET_FILTER		0x00000008 | ||||
| #define GMAC_HASH_TAB_0_31		0x00000010 | ||||
| #define GMAC_HASH_TAB_32_63		0x00000014 | ||||
| #define GMAC_HASH_TAB(x)		(0x10 + (x) * 4) | ||||
| #define GMAC_RX_FLOW_CTRL		0x00000090 | ||||
| #define GMAC_QX_TX_FLOW_CTRL(x)		(0x70 + x * 4) | ||||
| #define GMAC_TXQ_PRTY_MAP0		0x98 | ||||
| @ -181,6 +180,7 @@ enum power_event { | ||||
| #define GMAC_HW_FEAT_MIISEL		BIT(0) | ||||
| 
 | ||||
| /* MAC HW features1 bitmap */ | ||||
| #define GMAC_HW_HASH_TB_SZ		GENMASK(25, 24) | ||||
| #define GMAC_HW_FEAT_AVSEL		BIT(20) | ||||
| #define GMAC_HW_TSOEN			BIT(18) | ||||
| #define GMAC_HW_TXFIFOSIZE		GENMASK(10, 6) | ||||
|  | ||||
| @ -400,41 +400,50 @@ static void dwmac4_set_filter(struct mac_device_info *hw, | ||||
| 			      struct net_device *dev) | ||||
| { | ||||
| 	void __iomem *ioaddr = (void __iomem *)dev->base_addr; | ||||
| 	unsigned int value = 0; | ||||
| 	int numhashregs = (hw->multicast_filter_bins >> 5); | ||||
| 	int mcbitslog2 = hw->mcast_bits_log2; | ||||
| 	unsigned int value; | ||||
| 	int i; | ||||
| 
 | ||||
| 	value = readl(ioaddr + GMAC_PACKET_FILTER); | ||||
| 	value &= ~GMAC_PACKET_FILTER_HMC; | ||||
| 	value &= ~GMAC_PACKET_FILTER_HPF; | ||||
| 	value &= ~GMAC_PACKET_FILTER_PCF; | ||||
| 	value &= ~GMAC_PACKET_FILTER_PM; | ||||
| 	value &= ~GMAC_PACKET_FILTER_PR; | ||||
| 	if (dev->flags & IFF_PROMISC) { | ||||
| 		value = GMAC_PACKET_FILTER_PR | GMAC_PACKET_FILTER_PCF; | ||||
| 	} else if ((dev->flags & IFF_ALLMULTI) || | ||||
| 			(netdev_mc_count(dev) > HASH_TABLE_SIZE)) { | ||||
| 		   (netdev_mc_count(dev) > hw->multicast_filter_bins)) { | ||||
| 		/* Pass all multi */ | ||||
| 		value = GMAC_PACKET_FILTER_PM; | ||||
| 		/* Set the 64 bits of the HASH tab. To be updated if taller
 | ||||
| 		 * hash table is used | ||||
| 		 */ | ||||
| 		writel(0xffffffff, ioaddr + GMAC_HASH_TAB_0_31); | ||||
| 		writel(0xffffffff, ioaddr + GMAC_HASH_TAB_32_63); | ||||
| 		value |= GMAC_PACKET_FILTER_PM; | ||||
| 		/* Set all the bits of the HASH tab */ | ||||
| 		for (i = 0; i < numhashregs; i++) | ||||
| 			writel(0xffffffff, ioaddr + GMAC_HASH_TAB(i)); | ||||
| 	} else if (!netdev_mc_empty(dev)) { | ||||
| 		u32 mc_filter[2]; | ||||
| 		struct netdev_hw_addr *ha; | ||||
| 		u32 mc_filter[8]; | ||||
| 
 | ||||
| 		/* Hash filter for multicast */ | ||||
| 		value = GMAC_PACKET_FILTER_HMC; | ||||
| 		value |= GMAC_PACKET_FILTER_HMC; | ||||
| 
 | ||||
| 		memset(mc_filter, 0, sizeof(mc_filter)); | ||||
| 		netdev_for_each_mc_addr(ha, dev) { | ||||
| 			/* The upper 6 bits of the calculated CRC are used to
 | ||||
| 			 * index the content of the Hash Table Reg 0 and 1. | ||||
| 			/* The upper n bits of the calculated CRC are used to
 | ||||
| 			 * index the contents of the hash table. The number of | ||||
| 			 * bits used depends on the hardware configuration | ||||
| 			 * selected at core configuration time. | ||||
| 			 */ | ||||
| 			int bit_nr = | ||||
| 				(bitrev32(~crc32_le(~0, ha->addr, 6)) >> 26); | ||||
| 			/* The most significant bit determines the register
 | ||||
| 			 * to use while the other 5 bits determines the bit | ||||
| 			 * within the selected register | ||||
| 			int bit_nr = bitrev32(~crc32_le(~0, ha->addr, | ||||
| 					ETH_ALEN)) >> (32 - mcbitslog2); | ||||
| 			/* The most significant bit determines the register to
 | ||||
| 			 * use (H/L) while the other 5 bits determine the bit | ||||
| 			 * within the register. | ||||
| 			 */ | ||||
| 			mc_filter[bit_nr >> 5] |= (1 << (bit_nr & 0x1F)); | ||||
| 			mc_filter[bit_nr >> 5] |= (1 << (bit_nr & 0x1f)); | ||||
| 		} | ||||
| 		writel(mc_filter[0], ioaddr + GMAC_HASH_TAB_0_31); | ||||
| 		writel(mc_filter[1], ioaddr + GMAC_HASH_TAB_32_63); | ||||
| 		for (i = 0; i < numhashregs; i++) | ||||
| 			writel(mc_filter[i], ioaddr + GMAC_HASH_TAB(i)); | ||||
| 	} | ||||
| 
 | ||||
| 	value |= GMAC_PACKET_FILTER_HPF; | ||||
|  | ||||
| @ -351,6 +351,7 @@ static void dwmac4_get_hw_feature(void __iomem *ioaddr, | ||||
| 
 | ||||
| 	/* MAC HW feature1 */ | ||||
| 	hw_cap = readl(ioaddr + GMAC_HW_FEATURE1); | ||||
| 	dma_cap->hash_tb_sz = (hw_cap & GMAC_HW_HASH_TB_SZ) >> 24; | ||||
| 	dma_cap->av = (hw_cap & GMAC_HW_FEAT_AVSEL) >> 20; | ||||
| 	dma_cap->tsoen = (hw_cap & GMAC_HW_TSOEN) >> 18; | ||||
| 	/* RX and TX FIFO sizes are encoded as log2(n / 128). Undo that by
 | ||||
|  | ||||
| @ -4107,6 +4107,12 @@ static int stmmac_hw_init(struct stmmac_priv *priv) | ||||
| 		priv->plat->enh_desc = priv->dma_cap.enh_desc; | ||||
| 		priv->plat->pmt = priv->dma_cap.pmt_remote_wake_up; | ||||
| 		priv->hw->pmt = priv->plat->pmt; | ||||
| 		if (priv->dma_cap.hash_tb_sz) { | ||||
| 			priv->hw->multicast_filter_bins = | ||||
| 					(BIT(priv->dma_cap.hash_tb_sz) << 5); | ||||
| 			priv->hw->mcast_bits_log2 = | ||||
| 					ilog2(priv->hw->multicast_filter_bins); | ||||
| 		} | ||||
| 
 | ||||
| 		/* TXCOE doesn't work in thresh DMA mode */ | ||||
| 		if (priv->plat->force_thresh_dma_mode) | ||||
|  | ||||
		Loading…
	
		Reference in New Issue
	
	Block a user