xref: /OK3568_Linux_fs/kernel/drivers/net/ethernet/lantiq_etop.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  *
4*4882a593Smuzhiyun  *   Copyright (C) 2011 John Crispin <blogic@openwrt.org>
5*4882a593Smuzhiyun  */
6*4882a593Smuzhiyun 
7*4882a593Smuzhiyun #include <linux/kernel.h>
8*4882a593Smuzhiyun #include <linux/slab.h>
9*4882a593Smuzhiyun #include <linux/errno.h>
10*4882a593Smuzhiyun #include <linux/types.h>
11*4882a593Smuzhiyun #include <linux/interrupt.h>
12*4882a593Smuzhiyun #include <linux/uaccess.h>
13*4882a593Smuzhiyun #include <linux/in.h>
14*4882a593Smuzhiyun #include <linux/netdevice.h>
15*4882a593Smuzhiyun #include <linux/etherdevice.h>
16*4882a593Smuzhiyun #include <linux/phy.h>
17*4882a593Smuzhiyun #include <linux/ip.h>
18*4882a593Smuzhiyun #include <linux/tcp.h>
19*4882a593Smuzhiyun #include <linux/skbuff.h>
20*4882a593Smuzhiyun #include <linux/mm.h>
21*4882a593Smuzhiyun #include <linux/platform_device.h>
22*4882a593Smuzhiyun #include <linux/ethtool.h>
23*4882a593Smuzhiyun #include <linux/init.h>
24*4882a593Smuzhiyun #include <linux/delay.h>
25*4882a593Smuzhiyun #include <linux/io.h>
26*4882a593Smuzhiyun #include <linux/dma-mapping.h>
27*4882a593Smuzhiyun #include <linux/module.h>
28*4882a593Smuzhiyun 
29*4882a593Smuzhiyun #include <asm/checksum.h>
30*4882a593Smuzhiyun 
31*4882a593Smuzhiyun #include <lantiq_soc.h>
32*4882a593Smuzhiyun #include <xway_dma.h>
33*4882a593Smuzhiyun #include <lantiq_platform.h>
34*4882a593Smuzhiyun 
35*4882a593Smuzhiyun #define LTQ_ETOP_MDIO		0x11804
36*4882a593Smuzhiyun #define MDIO_REQUEST		0x80000000
37*4882a593Smuzhiyun #define MDIO_READ		0x40000000
38*4882a593Smuzhiyun #define MDIO_ADDR_MASK		0x1f
39*4882a593Smuzhiyun #define MDIO_ADDR_OFFSET	0x15
40*4882a593Smuzhiyun #define MDIO_REG_MASK		0x1f
41*4882a593Smuzhiyun #define MDIO_REG_OFFSET		0x10
42*4882a593Smuzhiyun #define MDIO_VAL_MASK		0xffff
43*4882a593Smuzhiyun 
44*4882a593Smuzhiyun #define PPE32_CGEN		0x800
45*4882a593Smuzhiyun #define LQ_PPE32_ENET_MAC_CFG	0x1840
46*4882a593Smuzhiyun 
47*4882a593Smuzhiyun #define LTQ_ETOP_ENETS0		0x11850
48*4882a593Smuzhiyun #define LTQ_ETOP_MAC_DA0	0x1186C
49*4882a593Smuzhiyun #define LTQ_ETOP_MAC_DA1	0x11870
50*4882a593Smuzhiyun #define LTQ_ETOP_CFG		0x16020
51*4882a593Smuzhiyun #define LTQ_ETOP_IGPLEN		0x16080
52*4882a593Smuzhiyun 
53*4882a593Smuzhiyun #define MAX_DMA_CHAN		0x8
54*4882a593Smuzhiyun #define MAX_DMA_CRC_LEN		0x4
55*4882a593Smuzhiyun #define MAX_DMA_DATA_LEN	0x600
56*4882a593Smuzhiyun 
57*4882a593Smuzhiyun #define ETOP_FTCU		BIT(28)
58*4882a593Smuzhiyun #define ETOP_MII_MASK		0xf
59*4882a593Smuzhiyun #define ETOP_MII_NORMAL		0xd
60*4882a593Smuzhiyun #define ETOP_MII_REVERSE	0xe
61*4882a593Smuzhiyun #define ETOP_PLEN_UNDER		0x40
62*4882a593Smuzhiyun #define ETOP_CGEN		0x800
63*4882a593Smuzhiyun 
64*4882a593Smuzhiyun /* use 2 static channels for TX/RX */
65*4882a593Smuzhiyun #define LTQ_ETOP_TX_CHANNEL	1
66*4882a593Smuzhiyun #define LTQ_ETOP_RX_CHANNEL	6
67*4882a593Smuzhiyun #define IS_TX(x)		(x == LTQ_ETOP_TX_CHANNEL)
68*4882a593Smuzhiyun #define IS_RX(x)		(x == LTQ_ETOP_RX_CHANNEL)
69*4882a593Smuzhiyun 
70*4882a593Smuzhiyun #define ltq_etop_r32(x)		ltq_r32(ltq_etop_membase + (x))
71*4882a593Smuzhiyun #define ltq_etop_w32(x, y)	ltq_w32(x, ltq_etop_membase + (y))
72*4882a593Smuzhiyun #define ltq_etop_w32_mask(x, y, z)	\
73*4882a593Smuzhiyun 		ltq_w32_mask(x, y, ltq_etop_membase + (z))
74*4882a593Smuzhiyun 
75*4882a593Smuzhiyun #define DRV_VERSION	"1.0"
76*4882a593Smuzhiyun 
77*4882a593Smuzhiyun static void __iomem *ltq_etop_membase;
78*4882a593Smuzhiyun 
79*4882a593Smuzhiyun struct ltq_etop_chan {
80*4882a593Smuzhiyun 	int idx;
81*4882a593Smuzhiyun 	int tx_free;
82*4882a593Smuzhiyun 	struct net_device *netdev;
83*4882a593Smuzhiyun 	struct napi_struct napi;
84*4882a593Smuzhiyun 	struct ltq_dma_channel dma;
85*4882a593Smuzhiyun 	struct sk_buff *skb[LTQ_DESC_NUM];
86*4882a593Smuzhiyun };
87*4882a593Smuzhiyun 
88*4882a593Smuzhiyun struct ltq_etop_priv {
89*4882a593Smuzhiyun 	struct net_device *netdev;
90*4882a593Smuzhiyun 	struct platform_device *pdev;
91*4882a593Smuzhiyun 	struct ltq_eth_data *pldata;
92*4882a593Smuzhiyun 	struct resource *res;
93*4882a593Smuzhiyun 
94*4882a593Smuzhiyun 	struct mii_bus *mii_bus;
95*4882a593Smuzhiyun 
96*4882a593Smuzhiyun 	struct ltq_etop_chan ch[MAX_DMA_CHAN];
97*4882a593Smuzhiyun 	int tx_free[MAX_DMA_CHAN >> 1];
98*4882a593Smuzhiyun 
99*4882a593Smuzhiyun 	spinlock_t lock;
100*4882a593Smuzhiyun };
101*4882a593Smuzhiyun 
102*4882a593Smuzhiyun static int
ltq_etop_alloc_skb(struct ltq_etop_chan * ch)103*4882a593Smuzhiyun ltq_etop_alloc_skb(struct ltq_etop_chan *ch)
104*4882a593Smuzhiyun {
105*4882a593Smuzhiyun 	struct ltq_etop_priv *priv = netdev_priv(ch->netdev);
106*4882a593Smuzhiyun 
107*4882a593Smuzhiyun 	ch->skb[ch->dma.desc] = netdev_alloc_skb(ch->netdev, MAX_DMA_DATA_LEN);
108*4882a593Smuzhiyun 	if (!ch->skb[ch->dma.desc])
109*4882a593Smuzhiyun 		return -ENOMEM;
110*4882a593Smuzhiyun 	ch->dma.desc_base[ch->dma.desc].addr = dma_map_single(&priv->pdev->dev,
111*4882a593Smuzhiyun 		ch->skb[ch->dma.desc]->data, MAX_DMA_DATA_LEN,
112*4882a593Smuzhiyun 		DMA_FROM_DEVICE);
113*4882a593Smuzhiyun 	ch->dma.desc_base[ch->dma.desc].addr =
114*4882a593Smuzhiyun 		CPHYSADDR(ch->skb[ch->dma.desc]->data);
115*4882a593Smuzhiyun 	ch->dma.desc_base[ch->dma.desc].ctl =
116*4882a593Smuzhiyun 		LTQ_DMA_OWN | LTQ_DMA_RX_OFFSET(NET_IP_ALIGN) |
117*4882a593Smuzhiyun 		MAX_DMA_DATA_LEN;
118*4882a593Smuzhiyun 	skb_reserve(ch->skb[ch->dma.desc], NET_IP_ALIGN);
119*4882a593Smuzhiyun 	return 0;
120*4882a593Smuzhiyun }
121*4882a593Smuzhiyun 
122*4882a593Smuzhiyun static void
ltq_etop_hw_receive(struct ltq_etop_chan * ch)123*4882a593Smuzhiyun ltq_etop_hw_receive(struct ltq_etop_chan *ch)
124*4882a593Smuzhiyun {
125*4882a593Smuzhiyun 	struct ltq_etop_priv *priv = netdev_priv(ch->netdev);
126*4882a593Smuzhiyun 	struct ltq_dma_desc *desc = &ch->dma.desc_base[ch->dma.desc];
127*4882a593Smuzhiyun 	struct sk_buff *skb = ch->skb[ch->dma.desc];
128*4882a593Smuzhiyun 	int len = (desc->ctl & LTQ_DMA_SIZE_MASK) - MAX_DMA_CRC_LEN;
129*4882a593Smuzhiyun 	unsigned long flags;
130*4882a593Smuzhiyun 
131*4882a593Smuzhiyun 	spin_lock_irqsave(&priv->lock, flags);
132*4882a593Smuzhiyun 	if (ltq_etop_alloc_skb(ch)) {
133*4882a593Smuzhiyun 		netdev_err(ch->netdev,
134*4882a593Smuzhiyun 			"failed to allocate new rx buffer, stopping DMA\n");
135*4882a593Smuzhiyun 		ltq_dma_close(&ch->dma);
136*4882a593Smuzhiyun 	}
137*4882a593Smuzhiyun 	ch->dma.desc++;
138*4882a593Smuzhiyun 	ch->dma.desc %= LTQ_DESC_NUM;
139*4882a593Smuzhiyun 	spin_unlock_irqrestore(&priv->lock, flags);
140*4882a593Smuzhiyun 
141*4882a593Smuzhiyun 	skb_put(skb, len);
142*4882a593Smuzhiyun 	skb->protocol = eth_type_trans(skb, ch->netdev);
143*4882a593Smuzhiyun 	netif_receive_skb(skb);
144*4882a593Smuzhiyun }
145*4882a593Smuzhiyun 
146*4882a593Smuzhiyun static int
ltq_etop_poll_rx(struct napi_struct * napi,int budget)147*4882a593Smuzhiyun ltq_etop_poll_rx(struct napi_struct *napi, int budget)
148*4882a593Smuzhiyun {
149*4882a593Smuzhiyun 	struct ltq_etop_chan *ch = container_of(napi,
150*4882a593Smuzhiyun 				struct ltq_etop_chan, napi);
151*4882a593Smuzhiyun 	int work_done = 0;
152*4882a593Smuzhiyun 
153*4882a593Smuzhiyun 	while (work_done < budget) {
154*4882a593Smuzhiyun 		struct ltq_dma_desc *desc = &ch->dma.desc_base[ch->dma.desc];
155*4882a593Smuzhiyun 
156*4882a593Smuzhiyun 		if ((desc->ctl & (LTQ_DMA_OWN | LTQ_DMA_C)) != LTQ_DMA_C)
157*4882a593Smuzhiyun 			break;
158*4882a593Smuzhiyun 		ltq_etop_hw_receive(ch);
159*4882a593Smuzhiyun 		work_done++;
160*4882a593Smuzhiyun 	}
161*4882a593Smuzhiyun 	if (work_done < budget) {
162*4882a593Smuzhiyun 		napi_complete_done(&ch->napi, work_done);
163*4882a593Smuzhiyun 		ltq_dma_ack_irq(&ch->dma);
164*4882a593Smuzhiyun 	}
165*4882a593Smuzhiyun 	return work_done;
166*4882a593Smuzhiyun }
167*4882a593Smuzhiyun 
168*4882a593Smuzhiyun static int
ltq_etop_poll_tx(struct napi_struct * napi,int budget)169*4882a593Smuzhiyun ltq_etop_poll_tx(struct napi_struct *napi, int budget)
170*4882a593Smuzhiyun {
171*4882a593Smuzhiyun 	struct ltq_etop_chan *ch =
172*4882a593Smuzhiyun 		container_of(napi, struct ltq_etop_chan, napi);
173*4882a593Smuzhiyun 	struct ltq_etop_priv *priv = netdev_priv(ch->netdev);
174*4882a593Smuzhiyun 	struct netdev_queue *txq =
175*4882a593Smuzhiyun 		netdev_get_tx_queue(ch->netdev, ch->idx >> 1);
176*4882a593Smuzhiyun 	unsigned long flags;
177*4882a593Smuzhiyun 
178*4882a593Smuzhiyun 	spin_lock_irqsave(&priv->lock, flags);
179*4882a593Smuzhiyun 	while ((ch->dma.desc_base[ch->tx_free].ctl &
180*4882a593Smuzhiyun 			(LTQ_DMA_OWN | LTQ_DMA_C)) == LTQ_DMA_C) {
181*4882a593Smuzhiyun 		dev_kfree_skb_any(ch->skb[ch->tx_free]);
182*4882a593Smuzhiyun 		ch->skb[ch->tx_free] = NULL;
183*4882a593Smuzhiyun 		memset(&ch->dma.desc_base[ch->tx_free], 0,
184*4882a593Smuzhiyun 			sizeof(struct ltq_dma_desc));
185*4882a593Smuzhiyun 		ch->tx_free++;
186*4882a593Smuzhiyun 		ch->tx_free %= LTQ_DESC_NUM;
187*4882a593Smuzhiyun 	}
188*4882a593Smuzhiyun 	spin_unlock_irqrestore(&priv->lock, flags);
189*4882a593Smuzhiyun 
190*4882a593Smuzhiyun 	if (netif_tx_queue_stopped(txq))
191*4882a593Smuzhiyun 		netif_tx_start_queue(txq);
192*4882a593Smuzhiyun 	napi_complete(&ch->napi);
193*4882a593Smuzhiyun 	ltq_dma_ack_irq(&ch->dma);
194*4882a593Smuzhiyun 	return 1;
195*4882a593Smuzhiyun }
196*4882a593Smuzhiyun 
197*4882a593Smuzhiyun static irqreturn_t
ltq_etop_dma_irq(int irq,void * _priv)198*4882a593Smuzhiyun ltq_etop_dma_irq(int irq, void *_priv)
199*4882a593Smuzhiyun {
200*4882a593Smuzhiyun 	struct ltq_etop_priv *priv = _priv;
201*4882a593Smuzhiyun 	int ch = irq - LTQ_DMA_CH0_INT;
202*4882a593Smuzhiyun 
203*4882a593Smuzhiyun 	napi_schedule(&priv->ch[ch].napi);
204*4882a593Smuzhiyun 	return IRQ_HANDLED;
205*4882a593Smuzhiyun }
206*4882a593Smuzhiyun 
207*4882a593Smuzhiyun static void
ltq_etop_free_channel(struct net_device * dev,struct ltq_etop_chan * ch)208*4882a593Smuzhiyun ltq_etop_free_channel(struct net_device *dev, struct ltq_etop_chan *ch)
209*4882a593Smuzhiyun {
210*4882a593Smuzhiyun 	struct ltq_etop_priv *priv = netdev_priv(dev);
211*4882a593Smuzhiyun 
212*4882a593Smuzhiyun 	ltq_dma_free(&ch->dma);
213*4882a593Smuzhiyun 	if (ch->dma.irq)
214*4882a593Smuzhiyun 		free_irq(ch->dma.irq, priv);
215*4882a593Smuzhiyun 	if (IS_RX(ch->idx)) {
216*4882a593Smuzhiyun 		int desc;
217*4882a593Smuzhiyun 		for (desc = 0; desc < LTQ_DESC_NUM; desc++)
218*4882a593Smuzhiyun 			dev_kfree_skb_any(ch->skb[ch->dma.desc]);
219*4882a593Smuzhiyun 	}
220*4882a593Smuzhiyun }
221*4882a593Smuzhiyun 
222*4882a593Smuzhiyun static void
ltq_etop_hw_exit(struct net_device * dev)223*4882a593Smuzhiyun ltq_etop_hw_exit(struct net_device *dev)
224*4882a593Smuzhiyun {
225*4882a593Smuzhiyun 	struct ltq_etop_priv *priv = netdev_priv(dev);
226*4882a593Smuzhiyun 	int i;
227*4882a593Smuzhiyun 
228*4882a593Smuzhiyun 	ltq_pmu_disable(PMU_PPE);
229*4882a593Smuzhiyun 	for (i = 0; i < MAX_DMA_CHAN; i++)
230*4882a593Smuzhiyun 		if (IS_TX(i) || IS_RX(i))
231*4882a593Smuzhiyun 			ltq_etop_free_channel(dev, &priv->ch[i]);
232*4882a593Smuzhiyun }
233*4882a593Smuzhiyun 
234*4882a593Smuzhiyun static int
ltq_etop_hw_init(struct net_device * dev)235*4882a593Smuzhiyun ltq_etop_hw_init(struct net_device *dev)
236*4882a593Smuzhiyun {
237*4882a593Smuzhiyun 	struct ltq_etop_priv *priv = netdev_priv(dev);
238*4882a593Smuzhiyun 	int i;
239*4882a593Smuzhiyun 
240*4882a593Smuzhiyun 	ltq_pmu_enable(PMU_PPE);
241*4882a593Smuzhiyun 
242*4882a593Smuzhiyun 	switch (priv->pldata->mii_mode) {
243*4882a593Smuzhiyun 	case PHY_INTERFACE_MODE_RMII:
244*4882a593Smuzhiyun 		ltq_etop_w32_mask(ETOP_MII_MASK,
245*4882a593Smuzhiyun 			ETOP_MII_REVERSE, LTQ_ETOP_CFG);
246*4882a593Smuzhiyun 		break;
247*4882a593Smuzhiyun 
248*4882a593Smuzhiyun 	case PHY_INTERFACE_MODE_MII:
249*4882a593Smuzhiyun 		ltq_etop_w32_mask(ETOP_MII_MASK,
250*4882a593Smuzhiyun 			ETOP_MII_NORMAL, LTQ_ETOP_CFG);
251*4882a593Smuzhiyun 		break;
252*4882a593Smuzhiyun 
253*4882a593Smuzhiyun 	default:
254*4882a593Smuzhiyun 		netdev_err(dev, "unknown mii mode %d\n",
255*4882a593Smuzhiyun 			priv->pldata->mii_mode);
256*4882a593Smuzhiyun 		return -ENOTSUPP;
257*4882a593Smuzhiyun 	}
258*4882a593Smuzhiyun 
259*4882a593Smuzhiyun 	/* enable crc generation */
260*4882a593Smuzhiyun 	ltq_etop_w32(PPE32_CGEN, LQ_PPE32_ENET_MAC_CFG);
261*4882a593Smuzhiyun 
262*4882a593Smuzhiyun 	ltq_dma_init_port(DMA_PORT_ETOP);
263*4882a593Smuzhiyun 
264*4882a593Smuzhiyun 	for (i = 0; i < MAX_DMA_CHAN; i++) {
265*4882a593Smuzhiyun 		int irq = LTQ_DMA_CH0_INT + i;
266*4882a593Smuzhiyun 		struct ltq_etop_chan *ch = &priv->ch[i];
267*4882a593Smuzhiyun 
268*4882a593Smuzhiyun 		ch->idx = ch->dma.nr = i;
269*4882a593Smuzhiyun 		ch->dma.dev = &priv->pdev->dev;
270*4882a593Smuzhiyun 
271*4882a593Smuzhiyun 		if (IS_TX(i)) {
272*4882a593Smuzhiyun 			ltq_dma_alloc_tx(&ch->dma);
273*4882a593Smuzhiyun 			request_irq(irq, ltq_etop_dma_irq, 0, "etop_tx", priv);
274*4882a593Smuzhiyun 		} else if (IS_RX(i)) {
275*4882a593Smuzhiyun 			ltq_dma_alloc_rx(&ch->dma);
276*4882a593Smuzhiyun 			for (ch->dma.desc = 0; ch->dma.desc < LTQ_DESC_NUM;
277*4882a593Smuzhiyun 					ch->dma.desc++)
278*4882a593Smuzhiyun 				if (ltq_etop_alloc_skb(ch))
279*4882a593Smuzhiyun 					return -ENOMEM;
280*4882a593Smuzhiyun 			ch->dma.desc = 0;
281*4882a593Smuzhiyun 			request_irq(irq, ltq_etop_dma_irq, 0, "etop_rx", priv);
282*4882a593Smuzhiyun 		}
283*4882a593Smuzhiyun 		ch->dma.irq = irq;
284*4882a593Smuzhiyun 	}
285*4882a593Smuzhiyun 	return 0;
286*4882a593Smuzhiyun }
287*4882a593Smuzhiyun 
288*4882a593Smuzhiyun static void
ltq_etop_get_drvinfo(struct net_device * dev,struct ethtool_drvinfo * info)289*4882a593Smuzhiyun ltq_etop_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
290*4882a593Smuzhiyun {
291*4882a593Smuzhiyun 	strlcpy(info->driver, "Lantiq ETOP", sizeof(info->driver));
292*4882a593Smuzhiyun 	strlcpy(info->bus_info, "internal", sizeof(info->bus_info));
293*4882a593Smuzhiyun 	strlcpy(info->version, DRV_VERSION, sizeof(info->version));
294*4882a593Smuzhiyun }
295*4882a593Smuzhiyun 
296*4882a593Smuzhiyun static const struct ethtool_ops ltq_etop_ethtool_ops = {
297*4882a593Smuzhiyun 	.get_drvinfo = ltq_etop_get_drvinfo,
298*4882a593Smuzhiyun 	.nway_reset = phy_ethtool_nway_reset,
299*4882a593Smuzhiyun 	.get_link_ksettings = phy_ethtool_get_link_ksettings,
300*4882a593Smuzhiyun 	.set_link_ksettings = phy_ethtool_set_link_ksettings,
301*4882a593Smuzhiyun };
302*4882a593Smuzhiyun 
303*4882a593Smuzhiyun static int
ltq_etop_mdio_wr(struct mii_bus * bus,int phy_addr,int phy_reg,u16 phy_data)304*4882a593Smuzhiyun ltq_etop_mdio_wr(struct mii_bus *bus, int phy_addr, int phy_reg, u16 phy_data)
305*4882a593Smuzhiyun {
306*4882a593Smuzhiyun 	u32 val = MDIO_REQUEST |
307*4882a593Smuzhiyun 		((phy_addr & MDIO_ADDR_MASK) << MDIO_ADDR_OFFSET) |
308*4882a593Smuzhiyun 		((phy_reg & MDIO_REG_MASK) << MDIO_REG_OFFSET) |
309*4882a593Smuzhiyun 		phy_data;
310*4882a593Smuzhiyun 
311*4882a593Smuzhiyun 	while (ltq_etop_r32(LTQ_ETOP_MDIO) & MDIO_REQUEST)
312*4882a593Smuzhiyun 		;
313*4882a593Smuzhiyun 	ltq_etop_w32(val, LTQ_ETOP_MDIO);
314*4882a593Smuzhiyun 	return 0;
315*4882a593Smuzhiyun }
316*4882a593Smuzhiyun 
317*4882a593Smuzhiyun static int
ltq_etop_mdio_rd(struct mii_bus * bus,int phy_addr,int phy_reg)318*4882a593Smuzhiyun ltq_etop_mdio_rd(struct mii_bus *bus, int phy_addr, int phy_reg)
319*4882a593Smuzhiyun {
320*4882a593Smuzhiyun 	u32 val = MDIO_REQUEST | MDIO_READ |
321*4882a593Smuzhiyun 		((phy_addr & MDIO_ADDR_MASK) << MDIO_ADDR_OFFSET) |
322*4882a593Smuzhiyun 		((phy_reg & MDIO_REG_MASK) << MDIO_REG_OFFSET);
323*4882a593Smuzhiyun 
324*4882a593Smuzhiyun 	while (ltq_etop_r32(LTQ_ETOP_MDIO) & MDIO_REQUEST)
325*4882a593Smuzhiyun 		;
326*4882a593Smuzhiyun 	ltq_etop_w32(val, LTQ_ETOP_MDIO);
327*4882a593Smuzhiyun 	while (ltq_etop_r32(LTQ_ETOP_MDIO) & MDIO_REQUEST)
328*4882a593Smuzhiyun 		;
329*4882a593Smuzhiyun 	val = ltq_etop_r32(LTQ_ETOP_MDIO) & MDIO_VAL_MASK;
330*4882a593Smuzhiyun 	return val;
331*4882a593Smuzhiyun }
332*4882a593Smuzhiyun 
333*4882a593Smuzhiyun static void
ltq_etop_mdio_link(struct net_device * dev)334*4882a593Smuzhiyun ltq_etop_mdio_link(struct net_device *dev)
335*4882a593Smuzhiyun {
336*4882a593Smuzhiyun 	/* nothing to do  */
337*4882a593Smuzhiyun }
338*4882a593Smuzhiyun 
339*4882a593Smuzhiyun static int
ltq_etop_mdio_probe(struct net_device * dev)340*4882a593Smuzhiyun ltq_etop_mdio_probe(struct net_device *dev)
341*4882a593Smuzhiyun {
342*4882a593Smuzhiyun 	struct ltq_etop_priv *priv = netdev_priv(dev);
343*4882a593Smuzhiyun 	struct phy_device *phydev;
344*4882a593Smuzhiyun 
345*4882a593Smuzhiyun 	phydev = phy_find_first(priv->mii_bus);
346*4882a593Smuzhiyun 
347*4882a593Smuzhiyun 	if (!phydev) {
348*4882a593Smuzhiyun 		netdev_err(dev, "no PHY found\n");
349*4882a593Smuzhiyun 		return -ENODEV;
350*4882a593Smuzhiyun 	}
351*4882a593Smuzhiyun 
352*4882a593Smuzhiyun 	phydev = phy_connect(dev, phydev_name(phydev),
353*4882a593Smuzhiyun 			     &ltq_etop_mdio_link, priv->pldata->mii_mode);
354*4882a593Smuzhiyun 
355*4882a593Smuzhiyun 	if (IS_ERR(phydev)) {
356*4882a593Smuzhiyun 		netdev_err(dev, "Could not attach to PHY\n");
357*4882a593Smuzhiyun 		return PTR_ERR(phydev);
358*4882a593Smuzhiyun 	}
359*4882a593Smuzhiyun 
360*4882a593Smuzhiyun 	phy_set_max_speed(phydev, SPEED_100);
361*4882a593Smuzhiyun 
362*4882a593Smuzhiyun 	phy_attached_info(phydev);
363*4882a593Smuzhiyun 
364*4882a593Smuzhiyun 	return 0;
365*4882a593Smuzhiyun }
366*4882a593Smuzhiyun 
367*4882a593Smuzhiyun static int
ltq_etop_mdio_init(struct net_device * dev)368*4882a593Smuzhiyun ltq_etop_mdio_init(struct net_device *dev)
369*4882a593Smuzhiyun {
370*4882a593Smuzhiyun 	struct ltq_etop_priv *priv = netdev_priv(dev);
371*4882a593Smuzhiyun 	int err;
372*4882a593Smuzhiyun 
373*4882a593Smuzhiyun 	priv->mii_bus = mdiobus_alloc();
374*4882a593Smuzhiyun 	if (!priv->mii_bus) {
375*4882a593Smuzhiyun 		netdev_err(dev, "failed to allocate mii bus\n");
376*4882a593Smuzhiyun 		err = -ENOMEM;
377*4882a593Smuzhiyun 		goto err_out;
378*4882a593Smuzhiyun 	}
379*4882a593Smuzhiyun 
380*4882a593Smuzhiyun 	priv->mii_bus->priv = dev;
381*4882a593Smuzhiyun 	priv->mii_bus->read = ltq_etop_mdio_rd;
382*4882a593Smuzhiyun 	priv->mii_bus->write = ltq_etop_mdio_wr;
383*4882a593Smuzhiyun 	priv->mii_bus->name = "ltq_mii";
384*4882a593Smuzhiyun 	snprintf(priv->mii_bus->id, MII_BUS_ID_SIZE, "%s-%x",
385*4882a593Smuzhiyun 		priv->pdev->name, priv->pdev->id);
386*4882a593Smuzhiyun 	if (mdiobus_register(priv->mii_bus)) {
387*4882a593Smuzhiyun 		err = -ENXIO;
388*4882a593Smuzhiyun 		goto err_out_free_mdiobus;
389*4882a593Smuzhiyun 	}
390*4882a593Smuzhiyun 
391*4882a593Smuzhiyun 	if (ltq_etop_mdio_probe(dev)) {
392*4882a593Smuzhiyun 		err = -ENXIO;
393*4882a593Smuzhiyun 		goto err_out_unregister_bus;
394*4882a593Smuzhiyun 	}
395*4882a593Smuzhiyun 	return 0;
396*4882a593Smuzhiyun 
397*4882a593Smuzhiyun err_out_unregister_bus:
398*4882a593Smuzhiyun 	mdiobus_unregister(priv->mii_bus);
399*4882a593Smuzhiyun err_out_free_mdiobus:
400*4882a593Smuzhiyun 	mdiobus_free(priv->mii_bus);
401*4882a593Smuzhiyun err_out:
402*4882a593Smuzhiyun 	return err;
403*4882a593Smuzhiyun }
404*4882a593Smuzhiyun 
405*4882a593Smuzhiyun static void
ltq_etop_mdio_cleanup(struct net_device * dev)406*4882a593Smuzhiyun ltq_etop_mdio_cleanup(struct net_device *dev)
407*4882a593Smuzhiyun {
408*4882a593Smuzhiyun 	struct ltq_etop_priv *priv = netdev_priv(dev);
409*4882a593Smuzhiyun 
410*4882a593Smuzhiyun 	phy_disconnect(dev->phydev);
411*4882a593Smuzhiyun 	mdiobus_unregister(priv->mii_bus);
412*4882a593Smuzhiyun 	mdiobus_free(priv->mii_bus);
413*4882a593Smuzhiyun }
414*4882a593Smuzhiyun 
415*4882a593Smuzhiyun static int
ltq_etop_open(struct net_device * dev)416*4882a593Smuzhiyun ltq_etop_open(struct net_device *dev)
417*4882a593Smuzhiyun {
418*4882a593Smuzhiyun 	struct ltq_etop_priv *priv = netdev_priv(dev);
419*4882a593Smuzhiyun 	int i;
420*4882a593Smuzhiyun 
421*4882a593Smuzhiyun 	for (i = 0; i < MAX_DMA_CHAN; i++) {
422*4882a593Smuzhiyun 		struct ltq_etop_chan *ch = &priv->ch[i];
423*4882a593Smuzhiyun 
424*4882a593Smuzhiyun 		if (!IS_TX(i) && (!IS_RX(i)))
425*4882a593Smuzhiyun 			continue;
426*4882a593Smuzhiyun 		ltq_dma_open(&ch->dma);
427*4882a593Smuzhiyun 		ltq_dma_enable_irq(&ch->dma);
428*4882a593Smuzhiyun 		napi_enable(&ch->napi);
429*4882a593Smuzhiyun 	}
430*4882a593Smuzhiyun 	phy_start(dev->phydev);
431*4882a593Smuzhiyun 	netif_tx_start_all_queues(dev);
432*4882a593Smuzhiyun 	return 0;
433*4882a593Smuzhiyun }
434*4882a593Smuzhiyun 
435*4882a593Smuzhiyun static int
ltq_etop_stop(struct net_device * dev)436*4882a593Smuzhiyun ltq_etop_stop(struct net_device *dev)
437*4882a593Smuzhiyun {
438*4882a593Smuzhiyun 	struct ltq_etop_priv *priv = netdev_priv(dev);
439*4882a593Smuzhiyun 	int i;
440*4882a593Smuzhiyun 
441*4882a593Smuzhiyun 	netif_tx_stop_all_queues(dev);
442*4882a593Smuzhiyun 	phy_stop(dev->phydev);
443*4882a593Smuzhiyun 	for (i = 0; i < MAX_DMA_CHAN; i++) {
444*4882a593Smuzhiyun 		struct ltq_etop_chan *ch = &priv->ch[i];
445*4882a593Smuzhiyun 
446*4882a593Smuzhiyun 		if (!IS_RX(i) && !IS_TX(i))
447*4882a593Smuzhiyun 			continue;
448*4882a593Smuzhiyun 		napi_disable(&ch->napi);
449*4882a593Smuzhiyun 		ltq_dma_close(&ch->dma);
450*4882a593Smuzhiyun 	}
451*4882a593Smuzhiyun 	return 0;
452*4882a593Smuzhiyun }
453*4882a593Smuzhiyun 
454*4882a593Smuzhiyun static int
ltq_etop_tx(struct sk_buff * skb,struct net_device * dev)455*4882a593Smuzhiyun ltq_etop_tx(struct sk_buff *skb, struct net_device *dev)
456*4882a593Smuzhiyun {
457*4882a593Smuzhiyun 	int queue = skb_get_queue_mapping(skb);
458*4882a593Smuzhiyun 	struct netdev_queue *txq = netdev_get_tx_queue(dev, queue);
459*4882a593Smuzhiyun 	struct ltq_etop_priv *priv = netdev_priv(dev);
460*4882a593Smuzhiyun 	struct ltq_etop_chan *ch = &priv->ch[(queue << 1) | 1];
461*4882a593Smuzhiyun 	struct ltq_dma_desc *desc = &ch->dma.desc_base[ch->dma.desc];
462*4882a593Smuzhiyun 	int len;
463*4882a593Smuzhiyun 	unsigned long flags;
464*4882a593Smuzhiyun 	u32 byte_offset;
465*4882a593Smuzhiyun 
466*4882a593Smuzhiyun 	len = skb->len < ETH_ZLEN ? ETH_ZLEN : skb->len;
467*4882a593Smuzhiyun 
468*4882a593Smuzhiyun 	if ((desc->ctl & (LTQ_DMA_OWN | LTQ_DMA_C)) || ch->skb[ch->dma.desc]) {
469*4882a593Smuzhiyun 		netdev_err(dev, "tx ring full\n");
470*4882a593Smuzhiyun 		netif_tx_stop_queue(txq);
471*4882a593Smuzhiyun 		return NETDEV_TX_BUSY;
472*4882a593Smuzhiyun 	}
473*4882a593Smuzhiyun 
474*4882a593Smuzhiyun 	/* dma needs to start on a 16 byte aligned address */
475*4882a593Smuzhiyun 	byte_offset = CPHYSADDR(skb->data) % 16;
476*4882a593Smuzhiyun 	ch->skb[ch->dma.desc] = skb;
477*4882a593Smuzhiyun 
478*4882a593Smuzhiyun 	netif_trans_update(dev);
479*4882a593Smuzhiyun 
480*4882a593Smuzhiyun 	spin_lock_irqsave(&priv->lock, flags);
481*4882a593Smuzhiyun 	desc->addr = ((unsigned int) dma_map_single(&priv->pdev->dev, skb->data, len,
482*4882a593Smuzhiyun 						DMA_TO_DEVICE)) - byte_offset;
483*4882a593Smuzhiyun 	wmb();
484*4882a593Smuzhiyun 	desc->ctl = LTQ_DMA_OWN | LTQ_DMA_SOP | LTQ_DMA_EOP |
485*4882a593Smuzhiyun 		LTQ_DMA_TX_OFFSET(byte_offset) | (len & LTQ_DMA_SIZE_MASK);
486*4882a593Smuzhiyun 	ch->dma.desc++;
487*4882a593Smuzhiyun 	ch->dma.desc %= LTQ_DESC_NUM;
488*4882a593Smuzhiyun 	spin_unlock_irqrestore(&priv->lock, flags);
489*4882a593Smuzhiyun 
490*4882a593Smuzhiyun 	if (ch->dma.desc_base[ch->dma.desc].ctl & LTQ_DMA_OWN)
491*4882a593Smuzhiyun 		netif_tx_stop_queue(txq);
492*4882a593Smuzhiyun 
493*4882a593Smuzhiyun 	return NETDEV_TX_OK;
494*4882a593Smuzhiyun }
495*4882a593Smuzhiyun 
496*4882a593Smuzhiyun static int
ltq_etop_change_mtu(struct net_device * dev,int new_mtu)497*4882a593Smuzhiyun ltq_etop_change_mtu(struct net_device *dev, int new_mtu)
498*4882a593Smuzhiyun {
499*4882a593Smuzhiyun 	struct ltq_etop_priv *priv = netdev_priv(dev);
500*4882a593Smuzhiyun 	unsigned long flags;
501*4882a593Smuzhiyun 
502*4882a593Smuzhiyun 	dev->mtu = new_mtu;
503*4882a593Smuzhiyun 
504*4882a593Smuzhiyun 	spin_lock_irqsave(&priv->lock, flags);
505*4882a593Smuzhiyun 	ltq_etop_w32((ETOP_PLEN_UNDER << 16) | new_mtu, LTQ_ETOP_IGPLEN);
506*4882a593Smuzhiyun 	spin_unlock_irqrestore(&priv->lock, flags);
507*4882a593Smuzhiyun 
508*4882a593Smuzhiyun 	return 0;
509*4882a593Smuzhiyun }
510*4882a593Smuzhiyun 
511*4882a593Smuzhiyun static int
ltq_etop_set_mac_address(struct net_device * dev,void * p)512*4882a593Smuzhiyun ltq_etop_set_mac_address(struct net_device *dev, void *p)
513*4882a593Smuzhiyun {
514*4882a593Smuzhiyun 	int ret = eth_mac_addr(dev, p);
515*4882a593Smuzhiyun 
516*4882a593Smuzhiyun 	if (!ret) {
517*4882a593Smuzhiyun 		struct ltq_etop_priv *priv = netdev_priv(dev);
518*4882a593Smuzhiyun 		unsigned long flags;
519*4882a593Smuzhiyun 
520*4882a593Smuzhiyun 		/* store the mac for the unicast filter */
521*4882a593Smuzhiyun 		spin_lock_irqsave(&priv->lock, flags);
522*4882a593Smuzhiyun 		ltq_etop_w32(*((u32 *)dev->dev_addr), LTQ_ETOP_MAC_DA0);
523*4882a593Smuzhiyun 		ltq_etop_w32(*((u16 *)&dev->dev_addr[4]) << 16,
524*4882a593Smuzhiyun 			LTQ_ETOP_MAC_DA1);
525*4882a593Smuzhiyun 		spin_unlock_irqrestore(&priv->lock, flags);
526*4882a593Smuzhiyun 	}
527*4882a593Smuzhiyun 	return ret;
528*4882a593Smuzhiyun }
529*4882a593Smuzhiyun 
530*4882a593Smuzhiyun static void
ltq_etop_set_multicast_list(struct net_device * dev)531*4882a593Smuzhiyun ltq_etop_set_multicast_list(struct net_device *dev)
532*4882a593Smuzhiyun {
533*4882a593Smuzhiyun 	struct ltq_etop_priv *priv = netdev_priv(dev);
534*4882a593Smuzhiyun 	unsigned long flags;
535*4882a593Smuzhiyun 
536*4882a593Smuzhiyun 	/* ensure that the unicast filter is not enabled in promiscious mode */
537*4882a593Smuzhiyun 	spin_lock_irqsave(&priv->lock, flags);
538*4882a593Smuzhiyun 	if ((dev->flags & IFF_PROMISC) || (dev->flags & IFF_ALLMULTI))
539*4882a593Smuzhiyun 		ltq_etop_w32_mask(ETOP_FTCU, 0, LTQ_ETOP_ENETS0);
540*4882a593Smuzhiyun 	else
541*4882a593Smuzhiyun 		ltq_etop_w32_mask(0, ETOP_FTCU, LTQ_ETOP_ENETS0);
542*4882a593Smuzhiyun 	spin_unlock_irqrestore(&priv->lock, flags);
543*4882a593Smuzhiyun }
544*4882a593Smuzhiyun 
545*4882a593Smuzhiyun static int
ltq_etop_init(struct net_device * dev)546*4882a593Smuzhiyun ltq_etop_init(struct net_device *dev)
547*4882a593Smuzhiyun {
548*4882a593Smuzhiyun 	struct ltq_etop_priv *priv = netdev_priv(dev);
549*4882a593Smuzhiyun 	struct sockaddr mac;
550*4882a593Smuzhiyun 	int err;
551*4882a593Smuzhiyun 	bool random_mac = false;
552*4882a593Smuzhiyun 
553*4882a593Smuzhiyun 	dev->watchdog_timeo = 10 * HZ;
554*4882a593Smuzhiyun 	err = ltq_etop_hw_init(dev);
555*4882a593Smuzhiyun 	if (err)
556*4882a593Smuzhiyun 		goto err_hw;
557*4882a593Smuzhiyun 	ltq_etop_change_mtu(dev, 1500);
558*4882a593Smuzhiyun 
559*4882a593Smuzhiyun 	memcpy(&mac, &priv->pldata->mac, sizeof(struct sockaddr));
560*4882a593Smuzhiyun 	if (!is_valid_ether_addr(mac.sa_data)) {
561*4882a593Smuzhiyun 		pr_warn("etop: invalid MAC, using random\n");
562*4882a593Smuzhiyun 		eth_random_addr(mac.sa_data);
563*4882a593Smuzhiyun 		random_mac = true;
564*4882a593Smuzhiyun 	}
565*4882a593Smuzhiyun 
566*4882a593Smuzhiyun 	err = ltq_etop_set_mac_address(dev, &mac);
567*4882a593Smuzhiyun 	if (err)
568*4882a593Smuzhiyun 		goto err_netdev;
569*4882a593Smuzhiyun 
570*4882a593Smuzhiyun 	/* Set addr_assign_type here, ltq_etop_set_mac_address would reset it. */
571*4882a593Smuzhiyun 	if (random_mac)
572*4882a593Smuzhiyun 		dev->addr_assign_type = NET_ADDR_RANDOM;
573*4882a593Smuzhiyun 
574*4882a593Smuzhiyun 	ltq_etop_set_multicast_list(dev);
575*4882a593Smuzhiyun 	err = ltq_etop_mdio_init(dev);
576*4882a593Smuzhiyun 	if (err)
577*4882a593Smuzhiyun 		goto err_netdev;
578*4882a593Smuzhiyun 	return 0;
579*4882a593Smuzhiyun 
580*4882a593Smuzhiyun err_netdev:
581*4882a593Smuzhiyun 	unregister_netdev(dev);
582*4882a593Smuzhiyun 	free_netdev(dev);
583*4882a593Smuzhiyun err_hw:
584*4882a593Smuzhiyun 	ltq_etop_hw_exit(dev);
585*4882a593Smuzhiyun 	return err;
586*4882a593Smuzhiyun }
587*4882a593Smuzhiyun 
588*4882a593Smuzhiyun static void
ltq_etop_tx_timeout(struct net_device * dev,unsigned int txqueue)589*4882a593Smuzhiyun ltq_etop_tx_timeout(struct net_device *dev, unsigned int txqueue)
590*4882a593Smuzhiyun {
591*4882a593Smuzhiyun 	int err;
592*4882a593Smuzhiyun 
593*4882a593Smuzhiyun 	ltq_etop_hw_exit(dev);
594*4882a593Smuzhiyun 	err = ltq_etop_hw_init(dev);
595*4882a593Smuzhiyun 	if (err)
596*4882a593Smuzhiyun 		goto err_hw;
597*4882a593Smuzhiyun 	netif_trans_update(dev);
598*4882a593Smuzhiyun 	netif_wake_queue(dev);
599*4882a593Smuzhiyun 	return;
600*4882a593Smuzhiyun 
601*4882a593Smuzhiyun err_hw:
602*4882a593Smuzhiyun 	ltq_etop_hw_exit(dev);
603*4882a593Smuzhiyun 	netdev_err(dev, "failed to restart etop after TX timeout\n");
604*4882a593Smuzhiyun }
605*4882a593Smuzhiyun 
606*4882a593Smuzhiyun static const struct net_device_ops ltq_eth_netdev_ops = {
607*4882a593Smuzhiyun 	.ndo_open = ltq_etop_open,
608*4882a593Smuzhiyun 	.ndo_stop = ltq_etop_stop,
609*4882a593Smuzhiyun 	.ndo_start_xmit = ltq_etop_tx,
610*4882a593Smuzhiyun 	.ndo_change_mtu = ltq_etop_change_mtu,
611*4882a593Smuzhiyun 	.ndo_do_ioctl = phy_do_ioctl,
612*4882a593Smuzhiyun 	.ndo_set_mac_address = ltq_etop_set_mac_address,
613*4882a593Smuzhiyun 	.ndo_validate_addr = eth_validate_addr,
614*4882a593Smuzhiyun 	.ndo_set_rx_mode = ltq_etop_set_multicast_list,
615*4882a593Smuzhiyun 	.ndo_select_queue = dev_pick_tx_zero,
616*4882a593Smuzhiyun 	.ndo_init = ltq_etop_init,
617*4882a593Smuzhiyun 	.ndo_tx_timeout = ltq_etop_tx_timeout,
618*4882a593Smuzhiyun };
619*4882a593Smuzhiyun 
620*4882a593Smuzhiyun static int __init
ltq_etop_probe(struct platform_device * pdev)621*4882a593Smuzhiyun ltq_etop_probe(struct platform_device *pdev)
622*4882a593Smuzhiyun {
623*4882a593Smuzhiyun 	struct net_device *dev;
624*4882a593Smuzhiyun 	struct ltq_etop_priv *priv;
625*4882a593Smuzhiyun 	struct resource *res;
626*4882a593Smuzhiyun 	int err;
627*4882a593Smuzhiyun 	int i;
628*4882a593Smuzhiyun 
629*4882a593Smuzhiyun 	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
630*4882a593Smuzhiyun 	if (!res) {
631*4882a593Smuzhiyun 		dev_err(&pdev->dev, "failed to get etop resource\n");
632*4882a593Smuzhiyun 		err = -ENOENT;
633*4882a593Smuzhiyun 		goto err_out;
634*4882a593Smuzhiyun 	}
635*4882a593Smuzhiyun 
636*4882a593Smuzhiyun 	res = devm_request_mem_region(&pdev->dev, res->start,
637*4882a593Smuzhiyun 		resource_size(res), dev_name(&pdev->dev));
638*4882a593Smuzhiyun 	if (!res) {
639*4882a593Smuzhiyun 		dev_err(&pdev->dev, "failed to request etop resource\n");
640*4882a593Smuzhiyun 		err = -EBUSY;
641*4882a593Smuzhiyun 		goto err_out;
642*4882a593Smuzhiyun 	}
643*4882a593Smuzhiyun 
644*4882a593Smuzhiyun 	ltq_etop_membase = devm_ioremap(&pdev->dev,
645*4882a593Smuzhiyun 		res->start, resource_size(res));
646*4882a593Smuzhiyun 	if (!ltq_etop_membase) {
647*4882a593Smuzhiyun 		dev_err(&pdev->dev, "failed to remap etop engine %d\n",
648*4882a593Smuzhiyun 			pdev->id);
649*4882a593Smuzhiyun 		err = -ENOMEM;
650*4882a593Smuzhiyun 		goto err_out;
651*4882a593Smuzhiyun 	}
652*4882a593Smuzhiyun 
653*4882a593Smuzhiyun 	dev = alloc_etherdev_mq(sizeof(struct ltq_etop_priv), 4);
654*4882a593Smuzhiyun 	if (!dev) {
655*4882a593Smuzhiyun 		err = -ENOMEM;
656*4882a593Smuzhiyun 		goto err_out;
657*4882a593Smuzhiyun 	}
658*4882a593Smuzhiyun 	strcpy(dev->name, "eth%d");
659*4882a593Smuzhiyun 	dev->netdev_ops = &ltq_eth_netdev_ops;
660*4882a593Smuzhiyun 	dev->ethtool_ops = &ltq_etop_ethtool_ops;
661*4882a593Smuzhiyun 	priv = netdev_priv(dev);
662*4882a593Smuzhiyun 	priv->res = res;
663*4882a593Smuzhiyun 	priv->pdev = pdev;
664*4882a593Smuzhiyun 	priv->pldata = dev_get_platdata(&pdev->dev);
665*4882a593Smuzhiyun 	priv->netdev = dev;
666*4882a593Smuzhiyun 	spin_lock_init(&priv->lock);
667*4882a593Smuzhiyun 	SET_NETDEV_DEV(dev, &pdev->dev);
668*4882a593Smuzhiyun 
669*4882a593Smuzhiyun 	for (i = 0; i < MAX_DMA_CHAN; i++) {
670*4882a593Smuzhiyun 		if (IS_TX(i))
671*4882a593Smuzhiyun 			netif_napi_add(dev, &priv->ch[i].napi,
672*4882a593Smuzhiyun 				ltq_etop_poll_tx, 8);
673*4882a593Smuzhiyun 		else if (IS_RX(i))
674*4882a593Smuzhiyun 			netif_napi_add(dev, &priv->ch[i].napi,
675*4882a593Smuzhiyun 				ltq_etop_poll_rx, 32);
676*4882a593Smuzhiyun 		priv->ch[i].netdev = dev;
677*4882a593Smuzhiyun 	}
678*4882a593Smuzhiyun 
679*4882a593Smuzhiyun 	err = register_netdev(dev);
680*4882a593Smuzhiyun 	if (err)
681*4882a593Smuzhiyun 		goto err_free;
682*4882a593Smuzhiyun 
683*4882a593Smuzhiyun 	platform_set_drvdata(pdev, dev);
684*4882a593Smuzhiyun 	return 0;
685*4882a593Smuzhiyun 
686*4882a593Smuzhiyun err_free:
687*4882a593Smuzhiyun 	free_netdev(dev);
688*4882a593Smuzhiyun err_out:
689*4882a593Smuzhiyun 	return err;
690*4882a593Smuzhiyun }
691*4882a593Smuzhiyun 
692*4882a593Smuzhiyun static int
ltq_etop_remove(struct platform_device * pdev)693*4882a593Smuzhiyun ltq_etop_remove(struct platform_device *pdev)
694*4882a593Smuzhiyun {
695*4882a593Smuzhiyun 	struct net_device *dev = platform_get_drvdata(pdev);
696*4882a593Smuzhiyun 
697*4882a593Smuzhiyun 	if (dev) {
698*4882a593Smuzhiyun 		netif_tx_stop_all_queues(dev);
699*4882a593Smuzhiyun 		ltq_etop_hw_exit(dev);
700*4882a593Smuzhiyun 		ltq_etop_mdio_cleanup(dev);
701*4882a593Smuzhiyun 		unregister_netdev(dev);
702*4882a593Smuzhiyun 	}
703*4882a593Smuzhiyun 	return 0;
704*4882a593Smuzhiyun }
705*4882a593Smuzhiyun 
706*4882a593Smuzhiyun static struct platform_driver ltq_mii_driver = {
707*4882a593Smuzhiyun 	.remove = ltq_etop_remove,
708*4882a593Smuzhiyun 	.driver = {
709*4882a593Smuzhiyun 		.name = "ltq_etop",
710*4882a593Smuzhiyun 	},
711*4882a593Smuzhiyun };
712*4882a593Smuzhiyun 
713*4882a593Smuzhiyun int __init
init_ltq_etop(void)714*4882a593Smuzhiyun init_ltq_etop(void)
715*4882a593Smuzhiyun {
716*4882a593Smuzhiyun 	int ret = platform_driver_probe(&ltq_mii_driver, ltq_etop_probe);
717*4882a593Smuzhiyun 
718*4882a593Smuzhiyun 	if (ret)
719*4882a593Smuzhiyun 		pr_err("ltq_etop: Error registering platform driver!");
720*4882a593Smuzhiyun 	return ret;
721*4882a593Smuzhiyun }
722*4882a593Smuzhiyun 
723*4882a593Smuzhiyun static void __exit
exit_ltq_etop(void)724*4882a593Smuzhiyun exit_ltq_etop(void)
725*4882a593Smuzhiyun {
726*4882a593Smuzhiyun 	platform_driver_unregister(&ltq_mii_driver);
727*4882a593Smuzhiyun }
728*4882a593Smuzhiyun 
729*4882a593Smuzhiyun module_init(init_ltq_etop);
730*4882a593Smuzhiyun module_exit(exit_ltq_etop);
731*4882a593Smuzhiyun 
732*4882a593Smuzhiyun MODULE_AUTHOR("John Crispin <blogic@openwrt.org>");
733*4882a593Smuzhiyun MODULE_DESCRIPTION("Lantiq SoC ETOP");
734*4882a593Smuzhiyun MODULE_LICENSE("GPL");
735