mirror of
				https://github.com/smaeul/u-boot.git
				synced 2025-11-04 14:00:19 +00:00 
			
		
		
		
	They are not required to be global, make them static. Signed-off-by: Yang Xiwen <forbidden405@outlook.com>
		
			
				
	
	
		
			633 lines
		
	
	
		
			17 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			633 lines
		
	
	
		
			17 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
// SPDX-License-Identifier: GPL-2.0-or-later
 | 
						|
/*
 | 
						|
 * Hisilicon Fast Ethernet MAC Driver
 | 
						|
 * Adapted from linux
 | 
						|
 *
 | 
						|
 * Copyright (c) 2016 HiSilicon Technologies Co., Ltd.
 | 
						|
 * Copyright (c) 2023 Yang Xiwen <forbidden405@outlook.com>
 | 
						|
 */
 | 
						|
 | 
						|
#include <dm.h>
 | 
						|
#include <clk.h>
 | 
						|
#include <miiphy.h>
 | 
						|
#include <net.h>
 | 
						|
#include <reset.h>
 | 
						|
#include <wait_bit.h>
 | 
						|
#include <asm/io.h>
 | 
						|
#include <dm/device_compat.h>
 | 
						|
#include <dm/lists.h>
 | 
						|
#include <linux/bitfield.h>
 | 
						|
#include <linux/ethtool.h>
 | 
						|
#include <linux/delay.h>
 | 
						|
#include <linux/kernel.h>
 | 
						|
 | 
						|
/* MAC control register list */
 | 
						|
#define MAC_PORTSEL			0x0200
 | 
						|
#define MAC_PORTSEL_STAT_CPU		BIT(0)
 | 
						|
#define MAC_PORTSEL_RMII		BIT(1)
 | 
						|
#define MAC_PORTSET			0x0208
 | 
						|
#define MAC_PORTSET_DUPLEX_FULL		BIT(0)
 | 
						|
#define MAC_PORTSET_LINKED		BIT(1)
 | 
						|
#define MAC_PORTSET_SPEED_100M		BIT(2)
 | 
						|
#define MAC_SET				0x0210
 | 
						|
#define MAX_FRAME_SIZE			1600
 | 
						|
#define MAX_FRAME_SIZE_MASK		GENMASK(10, 0)
 | 
						|
#define BIT_PAUSE_EN			BIT(18)
 | 
						|
#define RX_COALESCE_SET			0x0340
 | 
						|
#define RX_COALESCED_FRAME_OFFSET	24
 | 
						|
#define RX_COALESCED_FRAMES		8
 | 
						|
#define RX_COALESCED_TIMER		0x74
 | 
						|
#define QLEN_SET			0x0344
 | 
						|
#define RX_DEPTH_OFFSET			8
 | 
						|
#define MAX_HW_FIFO_DEPTH		64
 | 
						|
#define HW_TX_FIFO_DEPTH		1
 | 
						|
#define MAX_HW_RX_FIFO_DEPTH		(MAX_HW_FIFO_DEPTH - HW_TX_FIFO_DEPTH)
 | 
						|
#define HW_RX_FIFO_DEPTH		min(PKTBUFSRX, MAX_HW_RX_FIFO_DEPTH)
 | 
						|
#define IQFRM_DES			0x0354
 | 
						|
#define RX_FRAME_LEN_MASK		GENMASK(11, 0)
 | 
						|
#define RX_FRAME_IN_INDEX_MASK		GENMASK(17, 12)
 | 
						|
#define IQ_ADDR				0x0358
 | 
						|
#define EQ_ADDR				0x0360
 | 
						|
#define EQFRM_LEN			0x0364
 | 
						|
#define ADDRQ_STAT			0x036C
 | 
						|
#define TX_CNT_INUSE_MASK		GENMASK(5, 0)
 | 
						|
#define BIT_TX_READY			BIT(24)
 | 
						|
#define BIT_RX_READY			BIT(25)
 | 
						|
/* global control register list */
 | 
						|
#define GLB_HOSTMAC_L32			0x0000
 | 
						|
#define GLB_HOSTMAC_H16			0x0004
 | 
						|
#define GLB_SOFT_RESET			0x0008
 | 
						|
#define SOFT_RESET_ALL			BIT(0)
 | 
						|
#define GLB_FWCTRL			0x0010
 | 
						|
#define FWCTRL_VLAN_ENABLE		BIT(0)
 | 
						|
#define FWCTRL_FW2CPU_ENA		BIT(5)
 | 
						|
#define FWCTRL_FWALL2CPU		BIT(7)
 | 
						|
#define GLB_MACTCTRL			0x0014
 | 
						|
#define MACTCTRL_UNI2CPU		BIT(1)
 | 
						|
#define MACTCTRL_MULTI2CPU		BIT(3)
 | 
						|
#define MACTCTRL_BROAD2CPU		BIT(5)
 | 
						|
#define MACTCTRL_MACT_ENA		BIT(7)
 | 
						|
#define GLB_IRQ_STAT			0x0030
 | 
						|
#define GLB_IRQ_ENA			0x0034
 | 
						|
#define IRQ_ENA_PORT0_MASK		GENMASK(7, 0)
 | 
						|
#define IRQ_ENA_PORT0			BIT(18)
 | 
						|
#define IRQ_ENA_ALL			BIT(19)
 | 
						|
#define GLB_IRQ_RAW			0x0038
 | 
						|
#define IRQ_INT_RX_RDY			BIT(0)
 | 
						|
#define IRQ_INT_TX_PER_PACKET		BIT(1)
 | 
						|
#define IRQ_INT_TX_FIFO_EMPTY		BIT(6)
 | 
						|
#define IRQ_INT_MULTI_RXRDY		BIT(7)
 | 
						|
#define DEF_INT_MASK			(IRQ_INT_MULTI_RXRDY | \
 | 
						|
					IRQ_INT_TX_PER_PACKET | \
 | 
						|
					IRQ_INT_TX_FIFO_EMPTY)
 | 
						|
#define GLB_MAC_L32_BASE		0x0100
 | 
						|
#define GLB_MAC_H16_BASE		0x0104
 | 
						|
#define MACFLT_HI16_MASK		GENMASK(15, 0)
 | 
						|
#define BIT_MACFLT_ENA			BIT(17)
 | 
						|
#define BIT_MACFLT_FW2CPU		BIT(21)
 | 
						|
#define GLB_MAC_H16(reg)		(GLB_MAC_H16_BASE + ((reg) * 0x8))
 | 
						|
#define GLB_MAC_L32(reg)		(GLB_MAC_L32_BASE + ((reg) * 0x8))
 | 
						|
#define MAX_MAC_FILTER_NUM		8
 | 
						|
#define MAX_UNICAST_ADDRESSES		2
 | 
						|
#define MAX_MULTICAST_ADDRESSES		(MAX_MAC_FILTER_NUM - \
 | 
						|
					MAX_UNICAST_ADDRESSES)
 | 
						|
/* software tx and rx queue number, should be power of 2 */
 | 
						|
#define TXQ_NUM				64
 | 
						|
#define RXQ_NUM				128
 | 
						|
 | 
						|
#define PHY_RESET_DELAYS_PROPERTY	"hisilicon,phy-reset-delays-us"
 | 
						|
#define MAC_RESET_DELAY_PROPERTY	"hisilicon,mac-reset-delay-us"
 | 
						|
#define MAC_RESET_ASSERT_PERIOD		200000
 | 
						|
 | 
						|
enum phy_reset_delays {
 | 
						|
	PRE_DELAY,
 | 
						|
	PULSE,
 | 
						|
	POST_DELAY,
 | 
						|
	DELAYS_NUM,
 | 
						|
};
 | 
						|
 | 
						|
enum clk_type {
 | 
						|
	CLK_MAC,
 | 
						|
	CLK_BUS,
 | 
						|
	CLK_PHY,
 | 
						|
	CLK_NUM,
 | 
						|
};
 | 
						|
 | 
						|
struct hisi_femac_priv {
 | 
						|
	void __iomem *port_base;
 | 
						|
	void __iomem *glb_base;
 | 
						|
	struct clk *clks[CLK_NUM];
 | 
						|
	struct reset_ctl *mac_rst;
 | 
						|
	struct reset_ctl *phy_rst;
 | 
						|
	u32 phy_reset_delays[DELAYS_NUM];
 | 
						|
	u32 mac_reset_delay;
 | 
						|
 | 
						|
	struct phy_device *phy;
 | 
						|
 | 
						|
	u32 link_status;
 | 
						|
};
 | 
						|
 | 
						|
struct hisi_femac_stat_entry {
 | 
						|
	const char *name;
 | 
						|
	u32 offset;
 | 
						|
	u32 mask;
 | 
						|
};
 | 
						|
 | 
						|
/* please refer to the datasheet for the description of these entries */
 | 
						|
static const struct hisi_femac_stat_entry hisi_femac_stats_table[] = {
 | 
						|
	{ "rxsof_cnt",		0x584,	GENMASK(31, 28) },
 | 
						|
	{ "rxeof_cnt",		0x584,	GENMASK(27, 24) },
 | 
						|
	{ "rxcrcok_cnt",	0x584,	GENMASK(23, 20) },
 | 
						|
	{ "rxcrcbad_cnt",	0x584,	GENMASK(19, 16) },
 | 
						|
	{ "txsof_cnt",		0x584,	GENMASK(15, 12) },
 | 
						|
	{ "txeof_cnt",		0x584,	GENMASK(11, 8) },
 | 
						|
	{ "txcrcok_cnt",	0x584,	GENMASK(7, 4) },
 | 
						|
	{ "txcrcbad_cnt",	0x584,	GENMASK(3, 0) },
 | 
						|
	{ "pkts_cpu",		0x5a0,	GENMASK(15, 0) },
 | 
						|
	{ "addr_cpu",		0x5a4,	GENMASK(15, 0) },
 | 
						|
	{ "pkts_port",		0x5a8,	GENMASK(15, 0) },
 | 
						|
	{ "pkts_cpu2tx",	0x5ac,	GENMASK(15, 0) },
 | 
						|
	{ "rxdvrise",		0x600,	GENMASK(31, 0) },
 | 
						|
	{ "ifinoctets",		0x604,	GENMASK(31, 0) },
 | 
						|
	{ "octets_rx",		0x608,	GENMASK(31, 0) },
 | 
						|
	{ "local_mac_match",	0x60c,	GENMASK(31, 0) },
 | 
						|
	{ "pkts",		0x610,	GENMASK(31, 0) },
 | 
						|
	{ "broadcastpkts",	0x614,	GENMASK(31, 0) },
 | 
						|
	{ "multicastpkts",	0x618,	GENMASK(31, 0) },
 | 
						|
	{ "ifinucastpkts",	0x61c,	GENMASK(31, 0) },
 | 
						|
	{ "ifinerrors",		0x620,	GENMASK(31, 0) },
 | 
						|
	{ "crcerr",		0x624,	GENMASK(31, 0) },
 | 
						|
	{ "abnormalsizepkts",	0x628,	GENMASK(31, 0) },
 | 
						|
	{ "dot3alignmenterr",	0x62c,	GENMASK(31, 0) },
 | 
						|
	{ "dot3pause",		0x630,	GENMASK(31, 0) },
 | 
						|
	{ "dropevents",		0x634,	GENMASK(31, 0) },
 | 
						|
	{ "flux_frame_cnt",	0x638,	GENMASK(31, 0) },
 | 
						|
	{ "flux_drop_cnt",	0x63c,	GENMASK(31, 0) },
 | 
						|
	{ "mac_not2cpu_pkts",	0x64c,	GENMASK(31, 0) },
 | 
						|
	{ "pkts_tx",		0x780,	GENMASK(31, 0) },
 | 
						|
	{ "broadcastpkts_tx",	0x784,	GENMASK(31, 0) },
 | 
						|
	{ "multicastpkts_tx",	0x788,	GENMASK(31, 0) },
 | 
						|
	{ "ifoutucastpkts_tx",	0x78c,	GENMASK(31, 0) },
 | 
						|
	{ "octets_tx",		0x790,	GENMASK(31, 0) },
 | 
						|
	{ "dot3pause",		0x794,	GENMASK(31, 0) },
 | 
						|
	{ "retry_times_tx",	0x798,	GENMASK(31, 0) },
 | 
						|
	{ "collisions",		0x79c,	GENMASK(31, 0) },
 | 
						|
	{ "dot3latecol",	0x7a0,	GENMASK(31, 0) },
 | 
						|
	{ "dot3colok",		0x7a4,	GENMASK(31, 0) },
 | 
						|
	{ "dot3excessivecol",	0x7a8,	GENMASK(31, 0) },
 | 
						|
	{ "dot3colcnt",		0x7ac,	GENMASK(31, 0) },
 | 
						|
};
 | 
						|
 | 
						|
static void hisi_femac_irq_enable(struct hisi_femac_priv *priv, int irqs)
 | 
						|
{
 | 
						|
	u32 val;
 | 
						|
 | 
						|
	val = readl(priv->glb_base + GLB_IRQ_ENA);
 | 
						|
	writel(val | irqs, priv->glb_base + GLB_IRQ_ENA);
 | 
						|
}
 | 
						|
 | 
						|
static void hisi_femac_irq_disable(struct hisi_femac_priv *priv, int irqs)
 | 
						|
{
 | 
						|
	u32 val;
 | 
						|
 | 
						|
	val = readl(priv->glb_base + GLB_IRQ_ENA);
 | 
						|
	writel(val & (~irqs), priv->glb_base + GLB_IRQ_ENA);
 | 
						|
}
 | 
						|
 | 
						|
static void hisi_femac_port_init(struct hisi_femac_priv *priv)
 | 
						|
{
 | 
						|
	u32 val;
 | 
						|
 | 
						|
	/* MAC gets link status info and phy mode by software config */
 | 
						|
	val = MAC_PORTSEL_STAT_CPU;
 | 
						|
	if (priv->phy->interface == PHY_INTERFACE_MODE_RMII)
 | 
						|
		val |= MAC_PORTSEL_RMII;
 | 
						|
	writel(val, priv->port_base + MAC_PORTSEL);
 | 
						|
 | 
						|
	/*clear all interrupt status */
 | 
						|
	writel(IRQ_ENA_PORT0_MASK, priv->glb_base + GLB_IRQ_RAW);
 | 
						|
	hisi_femac_irq_disable(priv, IRQ_ENA_PORT0_MASK | IRQ_ENA_PORT0);
 | 
						|
 | 
						|
	val = readl(priv->glb_base + GLB_FWCTRL);
 | 
						|
	val &= ~(FWCTRL_VLAN_ENABLE | FWCTRL_FWALL2CPU);
 | 
						|
	val |= FWCTRL_FW2CPU_ENA;
 | 
						|
	writel(val, priv->glb_base + GLB_FWCTRL);
 | 
						|
 | 
						|
	val = readl(priv->glb_base + GLB_MACTCTRL);
 | 
						|
	val |= (MACTCTRL_BROAD2CPU | MACTCTRL_MACT_ENA);
 | 
						|
	writel(val, priv->glb_base + GLB_MACTCTRL);
 | 
						|
 | 
						|
	val = readl(priv->port_base + MAC_SET);
 | 
						|
	val &= ~MAX_FRAME_SIZE_MASK;
 | 
						|
	val |= MAX_FRAME_SIZE;
 | 
						|
	writel(val, priv->port_base + MAC_SET);
 | 
						|
 | 
						|
	val = RX_COALESCED_TIMER |
 | 
						|
		(RX_COALESCED_FRAMES << RX_COALESCED_FRAME_OFFSET);
 | 
						|
	writel(val, priv->port_base + RX_COALESCE_SET);
 | 
						|
 | 
						|
	val = (HW_RX_FIFO_DEPTH << RX_DEPTH_OFFSET) | HW_TX_FIFO_DEPTH;
 | 
						|
	writel(val, priv->port_base + QLEN_SET);
 | 
						|
}
 | 
						|
 | 
						|
static void hisi_femac_rx_refill(struct hisi_femac_priv *priv)
 | 
						|
{
 | 
						|
	int i;
 | 
						|
	ulong addr;
 | 
						|
 | 
						|
	for (i = 0; i < HW_RX_FIFO_DEPTH; i++) {
 | 
						|
		addr = (ulong)net_rx_packets[i];
 | 
						|
		writel(addr, priv->port_base + IQ_ADDR);
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
static void hisi_femac_adjust_link(struct udevice *dev)
 | 
						|
{
 | 
						|
	struct hisi_femac_priv *priv = dev_get_priv(dev);
 | 
						|
	struct phy_device *phy = priv->phy;
 | 
						|
	u32 status = 0;
 | 
						|
 | 
						|
	if (phy->link)
 | 
						|
		status |= MAC_PORTSET_LINKED;
 | 
						|
	if (phy->duplex == DUPLEX_FULL)
 | 
						|
		status |= MAC_PORTSET_DUPLEX_FULL;
 | 
						|
	if (phy->speed == SPEED_100)
 | 
						|
		status |= MAC_PORTSET_SPEED_100M;
 | 
						|
 | 
						|
	writel(status, priv->port_base + MAC_PORTSET);
 | 
						|
}
 | 
						|
 | 
						|
static int hisi_femac_port_reset(struct hisi_femac_priv *priv)
 | 
						|
{
 | 
						|
	u32 val;
 | 
						|
 | 
						|
	val = readl(priv->glb_base + GLB_SOFT_RESET);
 | 
						|
	val |= SOFT_RESET_ALL;
 | 
						|
	writel(val, priv->glb_base + GLB_SOFT_RESET);
 | 
						|
 | 
						|
	udelay(800);
 | 
						|
 | 
						|
	val &= ~SOFT_RESET_ALL;
 | 
						|
	writel(val, priv->glb_base + GLB_SOFT_RESET);
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
static int hisi_femac_set_hw_mac_addr(struct udevice *dev)
 | 
						|
{
 | 
						|
	struct hisi_femac_priv *priv = dev_get_priv(dev);
 | 
						|
	struct eth_pdata *plat = dev_get_plat(dev);
 | 
						|
	unsigned char *mac = plat->enetaddr;
 | 
						|
	u32 reg;
 | 
						|
 | 
						|
	reg = mac[1] | (mac[0] << 8);
 | 
						|
	writel(reg, priv->glb_base + GLB_HOSTMAC_H16);
 | 
						|
 | 
						|
	reg = mac[5] | (mac[4] << 8) | (mac[3] << 16) | (mac[2] << 24);
 | 
						|
	writel(reg, priv->glb_base + GLB_HOSTMAC_L32);
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
static int hisi_femac_start(struct udevice *dev)
 | 
						|
{
 | 
						|
	int ret;
 | 
						|
	struct hisi_femac_priv *priv = dev_get_priv(dev);
 | 
						|
 | 
						|
	hisi_femac_port_reset(priv);
 | 
						|
	hisi_femac_set_hw_mac_addr(dev);
 | 
						|
	hisi_femac_rx_refill(priv);
 | 
						|
 | 
						|
	ret = phy_startup(priv->phy);
 | 
						|
	if (ret) {
 | 
						|
		dev_err(dev, "Failed to startup phy: %d\n", ret);
 | 
						|
		return log_msg_ret("phy", ret);
 | 
						|
	}
 | 
						|
 | 
						|
	if (!priv->phy->link) {
 | 
						|
		debug("%s: link down\n", __func__);
 | 
						|
		return -ENODEV;
 | 
						|
	}
 | 
						|
 | 
						|
	hisi_femac_adjust_link(dev);
 | 
						|
 | 
						|
	writel(IRQ_ENA_PORT0_MASK, priv->glb_base + GLB_IRQ_RAW);
 | 
						|
	hisi_femac_irq_enable(priv, IRQ_ENA_ALL | IRQ_ENA_PORT0 | DEF_INT_MASK);
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
static int hisi_femac_send(struct udevice *dev, void *packet, int length)
 | 
						|
{
 | 
						|
	struct hisi_femac_priv *priv = dev_get_priv(dev);
 | 
						|
	ulong addr = (ulong)packet;
 | 
						|
	int ret;
 | 
						|
 | 
						|
	// clear previous irq
 | 
						|
	writel(IRQ_INT_TX_PER_PACKET, priv->glb_base + GLB_IRQ_RAW);
 | 
						|
 | 
						|
	// flush cache
 | 
						|
	flush_cache(addr, length + ETH_FCS_LEN);
 | 
						|
 | 
						|
	// write packet address
 | 
						|
	writel(addr, priv->port_base + EQ_ADDR);
 | 
						|
 | 
						|
	// write packet length (and send it)
 | 
						|
	writel(length + ETH_FCS_LEN, priv->port_base + EQFRM_LEN);
 | 
						|
 | 
						|
	// wait until FIFO is empty
 | 
						|
	ret = wait_for_bit_le32(priv->glb_base + GLB_IRQ_RAW, IRQ_INT_TX_PER_PACKET, true, 50, false);
 | 
						|
	if (ret == -ETIMEDOUT) {
 | 
						|
		dev_err(dev, "FIFO timeout\n");
 | 
						|
		return log_msg_ret("net", ret);
 | 
						|
	}
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
static int hisi_femac_recv(struct udevice *dev, int flags, uchar **packetp)
 | 
						|
{
 | 
						|
	struct hisi_femac_priv *priv = dev_get_priv(dev);
 | 
						|
	int val, index, length;
 | 
						|
 | 
						|
	val = readl(priv->glb_base + GLB_IRQ_RAW);
 | 
						|
	if (!(val & IRQ_INT_RX_RDY))
 | 
						|
		return -EAGAIN;
 | 
						|
 | 
						|
	val = readl(priv->port_base + IQFRM_DES);
 | 
						|
	index = (val & RX_FRAME_IN_INDEX_MASK) >> 12;
 | 
						|
	length = val & RX_FRAME_LEN_MASK;
 | 
						|
 | 
						|
	// invalidate cache
 | 
						|
	invalidate_dcache_range((ulong)net_rx_packets[index], (ulong)net_rx_packets[index] + length);
 | 
						|
	*packetp = net_rx_packets[index];
 | 
						|
 | 
						|
	// Tell hardware we will process the packet
 | 
						|
	writel(IRQ_INT_RX_RDY, priv->glb_base + GLB_IRQ_RAW);
 | 
						|
 | 
						|
	return length;
 | 
						|
}
 | 
						|
 | 
						|
static int hisi_femac_free_pkt(struct udevice *dev, uchar *packet, int length)
 | 
						|
{
 | 
						|
	struct hisi_femac_priv *priv = dev_get_priv(dev);
 | 
						|
	ulong addr = (ulong)packet;
 | 
						|
 | 
						|
	// Tell hardware the packet can be reused
 | 
						|
	writel(addr, priv->port_base + IQ_ADDR);
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
static void hisi_femac_stop(struct udevice *dev)
 | 
						|
{
 | 
						|
	struct hisi_femac_priv *priv = dev_get_priv(dev);
 | 
						|
 | 
						|
	// assert internal reset
 | 
						|
	writel(SOFT_RESET_ALL, priv->glb_base + GLB_SOFT_RESET);
 | 
						|
}
 | 
						|
 | 
						|
static int hisi_femac_get_sset_count(struct udevice *dev)
 | 
						|
{
 | 
						|
	return ARRAY_SIZE(hisi_femac_stats_table);
 | 
						|
}
 | 
						|
 | 
						|
static void hisi_femac_get_strings(struct udevice *dev, u8 *data)
 | 
						|
{
 | 
						|
	int i;
 | 
						|
 | 
						|
	for (i = 0; i < ARRAY_SIZE(hisi_femac_stats_table); i++)
 | 
						|
		strcpy(data + i * ETH_GSTRING_LEN, hisi_femac_stats_table[i].name);
 | 
						|
}
 | 
						|
 | 
						|
/* Non-constant mask variant of FIELD_GET/FIELD_PREP */
 | 
						|
#define field_get(_mask, _reg) (((_reg) & (_mask)) >> (ffs(_mask) - 1))
 | 
						|
 | 
						|
static void hisi_femac_get_stats(struct udevice *dev, u64 *data)
 | 
						|
{
 | 
						|
	int i;
 | 
						|
	u32 mask, reg;
 | 
						|
	struct hisi_femac_priv *priv = dev_get_priv(dev);
 | 
						|
	void __iomem *port_base = priv->port_base;
 | 
						|
 | 
						|
	for (i = 0; i < ARRAY_SIZE(hisi_femac_stats_table); i++) {
 | 
						|
		mask = hisi_femac_stats_table[i].mask;
 | 
						|
		reg = readl(port_base + hisi_femac_stats_table[i].offset);
 | 
						|
 | 
						|
		data[i] = field_get(mask, reg);
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
static int hisi_femac_of_to_plat(struct udevice *dev)
 | 
						|
{
 | 
						|
	int ret, i;
 | 
						|
	struct hisi_femac_priv *priv = dev_get_priv(dev);
 | 
						|
	ofnode mdio_node;
 | 
						|
	bool mdio_registered = false;
 | 
						|
	static const char * const clk_strs[] = {
 | 
						|
		[CLK_MAC] = "mac",
 | 
						|
		[CLK_BUS] = "bus",
 | 
						|
		[CLK_PHY] = "phy",
 | 
						|
	};
 | 
						|
 | 
						|
	priv->port_base = dev_remap_addr_name(dev, "port");
 | 
						|
	if (!priv->port_base) {
 | 
						|
		dev_err(dev, "Failed to remap port address space\n");
 | 
						|
		return log_msg_ret("net", -EINVAL);
 | 
						|
	}
 | 
						|
 | 
						|
	priv->glb_base = dev_remap_addr_name(dev, "glb");
 | 
						|
	if (IS_ERR(priv->glb_base)) {
 | 
						|
		dev_err(dev, "Failed to remap global address space\n");
 | 
						|
		return log_msg_ret("net", -EINVAL);
 | 
						|
	}
 | 
						|
 | 
						|
	for (i = 0; i < ARRAY_SIZE(clk_strs); i++) {
 | 
						|
		priv->clks[i] = devm_clk_get(dev, clk_strs[i]);
 | 
						|
		if (IS_ERR(priv->clks[i])) {
 | 
						|
			dev_err(dev, "Error getting clock %s\n", clk_strs[i]);
 | 
						|
			return log_msg_ret("clk", PTR_ERR(priv->clks[i]));
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	priv->mac_rst = devm_reset_control_get(dev, "mac");
 | 
						|
	if (IS_ERR(priv->mac_rst)) {
 | 
						|
		dev_err(dev, "Failed to get MAC reset %ld\n", PTR_ERR(priv->mac_rst));
 | 
						|
		return log_msg_ret("rst", PTR_ERR(priv->mac_rst));
 | 
						|
	}
 | 
						|
 | 
						|
	priv->phy_rst = devm_reset_control_get(dev, "phy");
 | 
						|
	if (IS_ERR(priv->phy_rst)) {
 | 
						|
		dev_err(dev, "Failed to get PHY reset %ld\n", PTR_ERR(priv->phy_rst));
 | 
						|
		return log_msg_ret("rst", PTR_ERR(priv->phy_rst));
 | 
						|
	}
 | 
						|
 | 
						|
	ret = dev_read_u32_array(dev,
 | 
						|
				 PHY_RESET_DELAYS_PROPERTY,
 | 
						|
				 priv->phy_reset_delays,
 | 
						|
				 DELAYS_NUM);
 | 
						|
	if (ret < 0) {
 | 
						|
		dev_err(dev, "Failed to get PHY reset delays %d\n", ret);
 | 
						|
		return log_msg_ret("rst", ret);
 | 
						|
	}
 | 
						|
 | 
						|
	priv->mac_reset_delay = dev_read_u32_default(dev,
 | 
						|
						     MAC_RESET_DELAY_PROPERTY,
 | 
						|
						     MAC_RESET_ASSERT_PERIOD);
 | 
						|
 | 
						|
	/* Create MDIO bus */
 | 
						|
	ofnode_for_each_subnode(mdio_node, dev_ofnode(dev)) {
 | 
						|
		const char *subnode_name = ofnode_get_name(mdio_node);
 | 
						|
		struct udevice *mdiodev;
 | 
						|
 | 
						|
		// Skip subnodes not starting with "mdio"
 | 
						|
		if (strncmp(subnode_name, "mdio", 4))
 | 
						|
			continue;
 | 
						|
 | 
						|
		ret = device_bind_driver_to_node(dev, "hisi-femac-mdio",
 | 
						|
						 subnode_name, mdio_node, &mdiodev);
 | 
						|
		if (ret) {
 | 
						|
			dev_err(dev, "Failed to register MDIO bus device %d\n", ret);
 | 
						|
			return log_msg_ret("net", ret);
 | 
						|
		}
 | 
						|
 | 
						|
		mdio_registered = true;
 | 
						|
		break;
 | 
						|
	}
 | 
						|
 | 
						|
	if (!mdio_registered) {
 | 
						|
		dev_err(dev, "No MDIO subnode is found!\n");
 | 
						|
		return log_msg_ret("mdio", -ENODATA);
 | 
						|
	}
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
static int hisi_femac_phy_reset(struct hisi_femac_priv *priv)
 | 
						|
{
 | 
						|
	struct reset_ctl *rst = priv->phy_rst;
 | 
						|
	u32 *delays = priv->phy_reset_delays;
 | 
						|
	int ret;
 | 
						|
 | 
						|
	// Disable MAC clk before phy reset
 | 
						|
	ret = clk_disable(priv->clks[CLK_MAC]);
 | 
						|
	if (ret < 0) {
 | 
						|
		pr_err("%s: Failed to disable MAC clock %d\n", __func__, ret);
 | 
						|
		return log_msg_ret("clk", ret);
 | 
						|
	}
 | 
						|
	ret = clk_disable(priv->clks[CLK_BUS]);
 | 
						|
	if (ret < 0) {
 | 
						|
		pr_err("%s: Failed to disable bus clock %d\n", __func__, ret);
 | 
						|
		return log_msg_ret("clk", ret);
 | 
						|
	}
 | 
						|
 | 
						|
	udelay(delays[PRE_DELAY]);
 | 
						|
 | 
						|
	ret = reset_assert(rst);
 | 
						|
	if (ret < 0) {
 | 
						|
		pr_err("%s: Failed to assert reset %d\n", __func__, ret);
 | 
						|
		return log_msg_ret("rst", ret);
 | 
						|
	}
 | 
						|
 | 
						|
	udelay(delays[PULSE]);
 | 
						|
 | 
						|
	ret = reset_deassert(rst);
 | 
						|
	if (ret < 0) {
 | 
						|
		pr_err("%s: Failed to deassert reset %d\n", __func__, ret);
 | 
						|
		return log_msg_ret("rst", ret);
 | 
						|
	}
 | 
						|
 | 
						|
	udelay(delays[POST_DELAY]);
 | 
						|
 | 
						|
	ret = clk_enable(priv->clks[CLK_MAC]);
 | 
						|
	if (ret < 0) {
 | 
						|
		pr_err("%s: Failed to enable MAC clock %d\n", __func__, ret);
 | 
						|
		return log_msg_ret("clk", ret);
 | 
						|
	}
 | 
						|
	ret = clk_enable(priv->clks[CLK_BUS]);
 | 
						|
	if (ret < 0) {
 | 
						|
		pr_err("%s: Failed to enable MAC bus clock %d\n", __func__, ret);
 | 
						|
		return log_msg_ret("clk", ret);
 | 
						|
	}
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
static int hisi_femac_probe(struct udevice *dev)
 | 
						|
{
 | 
						|
	struct hisi_femac_priv *priv = dev_get_priv(dev);
 | 
						|
	int ret, i;
 | 
						|
 | 
						|
	// Enable clocks
 | 
						|
	for (i = 0; i < CLK_NUM; i++) {
 | 
						|
		ret = clk_prepare_enable(priv->clks[i]);
 | 
						|
		if (ret < 0) {
 | 
						|
			dev_err(dev, "Failed to enable clk %d: %d\n", i, ret);
 | 
						|
			return log_msg_ret("clk", ret);
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	// Reset MAC
 | 
						|
	ret = reset_assert(priv->mac_rst);
 | 
						|
	if (ret < 0) {
 | 
						|
		dev_err(dev, "Failed to assert MAC reset: %d\n", ret);
 | 
						|
		return log_msg_ret("net", ret);
 | 
						|
	}
 | 
						|
 | 
						|
	udelay(priv->mac_reset_delay);
 | 
						|
 | 
						|
	ret = reset_deassert(priv->mac_rst);
 | 
						|
	if (ret < 0) {
 | 
						|
		dev_err(dev, "Failed to deassert MAC reset: %d\n", ret);
 | 
						|
		return log_msg_ret("net", ret);
 | 
						|
	}
 | 
						|
 | 
						|
	// Reset PHY
 | 
						|
	ret = hisi_femac_phy_reset(priv);
 | 
						|
	if (ret < 0) {
 | 
						|
		dev_err(dev, "Failed to reset PHY: %d\n", ret);
 | 
						|
		return log_msg_ret("net", ret);
 | 
						|
	}
 | 
						|
 | 
						|
	// Connect to PHY
 | 
						|
	priv->phy = dm_eth_phy_connect(dev);
 | 
						|
	if (!priv->phy) {
 | 
						|
		dev_err(dev, "Failed to connect to phy\n");
 | 
						|
		return log_msg_ret("phy", -EINVAL);
 | 
						|
	}
 | 
						|
 | 
						|
	hisi_femac_port_init(priv);
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
static const struct eth_ops hisi_femac_ops = {
 | 
						|
	.start		= hisi_femac_start,
 | 
						|
	.send		= hisi_femac_send,
 | 
						|
	.recv		= hisi_femac_recv,
 | 
						|
	.free_pkt	= hisi_femac_free_pkt,
 | 
						|
	.stop		= hisi_femac_stop,
 | 
						|
	.write_hwaddr	= hisi_femac_set_hw_mac_addr,
 | 
						|
	.get_sset_count	= hisi_femac_get_sset_count,
 | 
						|
	.get_strings	= hisi_femac_get_strings,
 | 
						|
	.get_stats	= hisi_femac_get_stats,
 | 
						|
};
 | 
						|
 | 
						|
static const struct udevice_id hisi_femac_ids[] = {
 | 
						|
	{.compatible = "hisilicon,hisi-femac-v1",},
 | 
						|
	{.compatible = "hisilicon,hisi-femac-v2",},
 | 
						|
	{.compatible = "hisilicon,hi3516cv300-femac",},
 | 
						|
	{.compatible = "hisilicon,hi3798mv200-femac",},
 | 
						|
	{},
 | 
						|
};
 | 
						|
 | 
						|
U_BOOT_DRIVER(hisi_femac_driver) = {
 | 
						|
	.name = "eth_hisi_femac",
 | 
						|
	.id = UCLASS_ETH,
 | 
						|
	.of_match = of_match_ptr(hisi_femac_ids),
 | 
						|
	.of_to_plat = hisi_femac_of_to_plat,
 | 
						|
	.ops = &hisi_femac_ops,
 | 
						|
	.probe = hisi_femac_probe,
 | 
						|
	.plat_auto = sizeof(struct eth_pdata),
 | 
						|
	.priv_auto = sizeof(struct hisi_femac_priv),
 | 
						|
};
 |