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

Commit b95b6d99 authored by Nelson Chang's avatar Nelson Chang Committed by David S. Miller
Browse files

net: ethernet: mediatek: get the chip id by ETHDMASYS registers 



The driver gets the chip id by ETHSYS_CHIPID0_3/ETHSYS_CHIPID4_7 registers
in mtk_probe().

Signed-off-by: default avatarNelson Chang <nelson.chang@mediatek.com>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 0d818c28

drivers/net/ethernet/mediatek/mtk_eth_soc.c

+29 −0
Original line number Diff line number Diff line
@@ -2323,6 +2323,31 @@ static int mtk_add_mac(struct mtk_eth *eth, struct device_node *np) 
	return err;

}



static int mtk_get_chip_id(struct mtk_eth *eth, u32 *chip_id)

{

	u32 val[2], id[4];



	regmap_read(eth->ethsys, ETHSYS_CHIPID0_3, &val[0]);

	regmap_read(eth->ethsys, ETHSYS_CHIPID4_7, &val[1]);



	id[3] = ((val[0] >> 16) & 0xff) - '0';

	id[2] = ((val[0] >> 24) & 0xff) - '0';

	id[1] = (val[1] & 0xff) - '0';

	id[0] = ((val[1] >> 8) & 0xff) - '0';



	*chip_id = (id[3] * 1000) + (id[2] * 100) +

		   (id[1] * 10) + id[0];



	if (!(*chip_id)) {

		dev_err(eth->dev, "failed to get chip id\n");

		return -ENODEV;

	}



	dev_info(eth->dev, "chip id = %d\n", *chip_id);



	return 0;

}



static int mtk_probe(struct platform_device *pdev)

{

	struct resource *res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
@@ -2388,6 +2413,10 @@ static int mtk_probe(struct platform_device *pdev) 
	if (err)

		return err;



	err = mtk_get_chip_id(eth, &eth->chip_id);

	if (err)

		return err;



	for_each_child_of_node(pdev->dev.of_node, mac_np) {

		if (!of_device_is_compatible(mac_np,

					     "mediatek,eth-mac"))

drivers/net/ethernet/mediatek/mtk_eth_soc.h

+5 −0
Original line number Diff line number Diff line
@@ -342,6 +342,10 @@ 
#define GPIO_BIAS_CTRL		0xed0

#define GPIO_DRV_SEL10		0xf00



/* ethernet subsystem chip id register */

#define ETHSYS_CHIPID0_3	0x0

#define ETHSYS_CHIPID4_7	0x4



/* ethernet subsystem config register */

#define ETHSYS_SYSCFG0		0x14

#define SYSCFG0_GE_MASK		0x3
@@ -534,6 +538,7 @@ struct mtk_eth { 
	unsigned long			sysclk;

	struct regmap			*ethsys;

	struct regmap			*pctl;

	u32				chip_id;

	bool				hwlro;

	atomic_t			dma_refcnt;

	struct mtk_tx_ring		tx_ring;