Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 5f0456b4 authored by Jose Abreu's avatar Jose Abreu Committed by David S. Miller
Browse files

net: stmmac: Implement logic to automatically select HW Interface 



Move all the core version detection to a common place ("hwif.c") and
implement a table which can be used to lookup the correct callbacks for
each IP version.

This simplifies the initialization flow of each IP version and eases
future implementation of new IP versions.

Signed-off-by: default avatarJose Abreu <joabreu@synopsys.com>
Cc: David S. Miller <davem@davemloft.net>
Cc: Joao Pinto <jpinto@synopsys.com>
Cc: Vitor Soares <soares@synopsys.com>
Cc: Giuseppe Cavallaro <peppe.cavallaro@st.com>
Cc: Alexandre Torgue <alexandre.torgue@st.com>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 22148df0

drivers/net/ethernet/stmicro/stmmac/Makefile

+2 −1
Original line number Diff line number Diff line
@@ -4,7 +4,8 @@ stmmac-objs:= stmmac_main.o stmmac_ethtool.o stmmac_mdio.o ring_mode.o \ 
	      chain_mode.o dwmac_lib.o dwmac1000_core.o dwmac1000_dma.o	\

	      dwmac100_core.o dwmac100_dma.o enh_desc.o norm_desc.o	\

	      mmc_core.o stmmac_hwtstamp.o stmmac_ptp.o dwmac4_descs.o	\

	      dwmac4_dma.o dwmac4_lib.o dwmac4_core.o dwmac5.o $(stmmac-y)

	      dwmac4_dma.o dwmac4_lib.o dwmac4_core.o dwmac5.o hwif.o \

	      $(stmmac-y)



# Ordering matters. Generic driver must be last.

obj-$(CONFIG_STMMAC_PLATFORM)	+= stmmac-platform.o

drivers/net/ethernet/stmicro/stmmac/common.h

+4 −26
Original line number Diff line number Diff line
@@ -39,6 +39,7 @@ 
#define	DWMAC_CORE_3_40	0x34

#define	DWMAC_CORE_3_50	0x35

#define	DWMAC_CORE_4_00	0x40

#define DWMAC_CORE_4_10	0x41

#define DWMAC_CORE_5_00 0x50

#define DWMAC_CORE_5_10 0x51

#define STMMAC_CHAN0	0	/* Always supported and default for all chips */
@@ -428,12 +429,9 @@ struct stmmac_rx_routing { 
	u32 reg_shift;

};



struct mac_device_info *dwmac1000_setup(void __iomem *ioaddr, int mcbins,

					int perfect_uc_entries,

					int *synopsys_id);

struct mac_device_info *dwmac100_setup(void __iomem *ioaddr, int *synopsys_id);

struct mac_device_info *dwmac4_setup(void __iomem *ioaddr, int mcbins,

				     int perfect_uc_entries, int *synopsys_id);

int dwmac100_setup(struct stmmac_priv *priv);

int dwmac1000_setup(struct stmmac_priv *priv);

int dwmac4_setup(struct stmmac_priv *priv);



void stmmac_set_mac_addr(void __iomem *ioaddr, u8 addr[6],

			 unsigned int high, unsigned int low);
@@ -453,24 +451,4 @@ extern const struct stmmac_mode_ops ring_mode_ops; 
extern const struct stmmac_mode_ops chain_mode_ops;

extern const struct stmmac_desc_ops dwmac4_desc_ops;



/**

 * stmmac_get_synopsys_id - return the SYINID.

 * @priv: driver private structure

 * Description: this simple function is to decode and return the SYINID

 * starting from the HW core register.

 */

static inline u32 stmmac_get_synopsys_id(u32 hwid)

{

	/* Check Synopsys Id (not available on old chips) */

	if (likely(hwid)) {

		u32 uid = ((hwid & 0x0000ff00) >> 8);

		u32 synid = (hwid & 0x000000ff);



		pr_info("stmmac - user ID: 0x%x, Synopsys ID: 0x%x\n",

			uid, synid);



		return synid;

	}

	return 0;

}

#endif /* __COMMON_H__ */

drivers/net/ethernet/stmicro/stmmac/dwmac1000.h

+0 −1
Original line number Diff line number Diff line
@@ -29,7 +29,6 @@ 
#define GMAC_MII_DATA		0x00000014	/* MII Data */

#define GMAC_FLOW_CTRL		0x00000018	/* Flow Control */

#define GMAC_VLAN_TAG		0x0000001c	/* VLAN Tag */

#define GMAC_VERSION		0x00000020	/* GMAC CORE Version */

#define GMAC_DEBUG		0x00000024	/* GMAC debug register */

#define GMAC_WAKEUP_FILTER	0x00000028	/* Wake-up Frame Filter */

drivers/net/ethernet/stmicro/stmmac/dwmac1000_core.c

+10 −19
Original line number Diff line number Diff line
@@ -27,6 +27,7 @@ 
#include <linux/ethtool.h>

#include <net/dsa.h>

#include <asm/io.h>

#include "stmmac.h"

#include "stmmac_pcs.h"

#include "dwmac1000.h"
@@ -498,7 +499,7 @@ static void dwmac1000_debug(void __iomem *ioaddr, struct stmmac_extra_stats *x, 
		x->mac_gmii_rx_proto_engine++;

}



static const struct stmmac_ops dwmac1000_ops = {

const struct stmmac_ops dwmac1000_ops = {

	.core_init = dwmac1000_core_init,

	.set_mac = stmmac_set_mac,

	.rx_ipc = dwmac1000_rx_ipc_enable,
@@ -519,28 +520,21 @@ static const struct stmmac_ops dwmac1000_ops = { 
	.pcs_get_adv_lp = dwmac1000_get_adv_lp,

};



struct mac_device_info *dwmac1000_setup(void __iomem *ioaddr, int mcbins,

					int perfect_uc_entries,

					int *synopsys_id)

int dwmac1000_setup(struct stmmac_priv *priv)

{

	struct mac_device_info *mac;

	u32 hwid = readl(ioaddr + GMAC_VERSION);

	struct mac_device_info *mac = priv->hw;



	mac = kzalloc(sizeof(const struct mac_device_info), GFP_KERNEL);

	if (!mac)

		return NULL;

	dev_info(priv->device, "\tDWMAC1000\n");



	mac->pcsr = ioaddr;

	mac->multicast_filter_bins = mcbins;

	mac->unicast_filter_entries = perfect_uc_entries;

	priv->dev->priv_flags |= IFF_UNICAST_FLT;

	mac->pcsr = priv->ioaddr;

	mac->multicast_filter_bins = priv->plat->multicast_filter_bins;

	mac->unicast_filter_entries = priv->plat->unicast_filter_entries;

	mac->mcast_bits_log2 = 0;



	if (mac->multicast_filter_bins)

		mac->mcast_bits_log2 = ilog2(mac->multicast_filter_bins);



	mac->mac = &dwmac1000_ops;

	mac->dma = &dwmac1000_dma_ops;



	mac->link.duplex = GMAC_CONTROL_DM;

	mac->link.speed10 = GMAC_CONTROL_PS;

	mac->link.speed100 = GMAC_CONTROL_PS | GMAC_CONTROL_FES;
@@ -555,8 +549,5 @@ struct mac_device_info *dwmac1000_setup(void __iomem *ioaddr, int mcbins, 
	mac->mii.clk_csr_shift = 2;

	mac->mii.clk_csr_mask = GENMASK(5, 2);



	/* Get and dump the chip ID */

	*synopsys_id = stmmac_get_synopsys_id(hwid);



	return mac;

	return 0;

}

drivers/net/ethernet/stmicro/stmmac/dwmac100_core.c

+7 −16
Original line number Diff line number Diff line
@@ -27,6 +27,7 @@ 
#include <linux/crc32.h>

#include <net/dsa.h>

#include <asm/io.h>

#include "stmmac.h"

#include "dwmac100.h"



static void dwmac100_core_init(struct mac_device_info *hw,
@@ -159,7 +160,7 @@ static void dwmac100_pmt(struct mac_device_info *hw, unsigned long mode) 
	return;

}



static const struct stmmac_ops dwmac100_ops = {

const struct stmmac_ops dwmac100_ops = {

	.core_init = dwmac100_core_init,

	.set_mac = stmmac_set_mac,

	.rx_ipc = dwmac100_rx_ipc_enable,
@@ -172,20 +173,13 @@ static const struct stmmac_ops dwmac100_ops = { 
	.get_umac_addr = dwmac100_get_umac_addr,

};



struct mac_device_info *dwmac100_setup(void __iomem *ioaddr, int *synopsys_id)

int dwmac100_setup(struct stmmac_priv *priv)

{

	struct mac_device_info *mac;

	struct mac_device_info *mac = priv->hw;



	mac = kzalloc(sizeof(const struct mac_device_info), GFP_KERNEL);

	if (!mac)

		return NULL;



	pr_info("\tDWMAC100\n");



	mac->pcsr = ioaddr;

	mac->mac = &dwmac100_ops;

	mac->dma = &dwmac100_dma_ops;

	dev_info(priv->device, "\tDWMAC100\n");



	mac->pcsr = priv->ioaddr;

	mac->link.duplex = MAC_CONTROL_F;

	mac->link.speed10 = 0;

	mac->link.speed100 = 0;
@@ -200,8 +194,5 @@ struct mac_device_info *dwmac100_setup(void __iomem *ioaddr, int *synopsys_id) 
	mac->mii.clk_csr_shift = 2;

	mac->mii.clk_csr_mask = GENMASK(5, 2);



	/* Synopsys Id is not available on old chips */

	*synopsys_id = 0;



	return mac;

	return 0;

}