This source file includes following definitions.
- ave_desc_read
- ave_desc_read_cmdsts
- ave_desc_write
- ave_desc_write_cmdsts
- ave_desc_write_addr
- ave_irq_disable_all
- ave_irq_restore
- ave_irq_enable
- ave_hw_write_macaddr
- ave_hw_read_version
- ave_ethtool_get_drvinfo
- ave_ethtool_get_msglevel
- ave_ethtool_set_msglevel
- ave_ethtool_get_wol
- __ave_ethtool_set_wol
- ave_ethtool_set_wol
- ave_ethtool_get_pauseparam
- ave_ethtool_set_pauseparam
- ave_mdiobus_read
- ave_mdiobus_write
- ave_dma_map
- ave_dma_unmap
- ave_rxdesc_prepare
- ave_desc_switch
- ave_tx_complete
- ave_rx_receive
- ave_napi_poll_rx
- ave_napi_poll_tx
- ave_global_reset
- ave_rxfifo_reset
- ave_irq_handler
- ave_pfsel_start
- ave_pfsel_stop
- ave_pfsel_set_macaddr
- ave_pfsel_set_promisc
- ave_pfsel_init
- ave_phy_adjust_link
- ave_macaddr_init
- ave_init
- ave_uninit
- ave_open
- ave_stop
- ave_start_xmit
- ave_ioctl
- ave_set_rx_mode
- ave_get_stats64
- ave_set_mac_address
- ave_probe
- ave_remove
- ave_suspend
- ave_resume
- ave_pro4_get_pinmode
- ave_ld11_get_pinmode
- ave_ld20_get_pinmode
- ave_pxs3_get_pinmode
1
2
3
4
5
6
7
8 #include <linux/bitops.h>
9 #include <linux/clk.h>
10 #include <linux/etherdevice.h>
11 #include <linux/interrupt.h>
12 #include <linux/io.h>
13 #include <linux/iopoll.h>
14 #include <linux/mfd/syscon.h>
15 #include <linux/mii.h>
16 #include <linux/module.h>
17 #include <linux/netdevice.h>
18 #include <linux/of_net.h>
19 #include <linux/of_mdio.h>
20 #include <linux/of_platform.h>
21 #include <linux/phy.h>
22 #include <linux/regmap.h>
23 #include <linux/reset.h>
24 #include <linux/types.h>
25 #include <linux/u64_stats_sync.h>
26
27
28 #define AVE_IDR 0x000
29 #define AVE_VR 0x004
30 #define AVE_GRR 0x008
31 #define AVE_CFGR 0x00c
32
33
34 #define AVE_GIMR 0x100
35 #define AVE_GISR 0x104
36
37
38 #define AVE_TXCR 0x200
39 #define AVE_RXCR 0x204
40 #define AVE_RXMAC1R 0x208
41 #define AVE_RXMAC2R 0x20c
42 #define AVE_MDIOCTR 0x214
43 #define AVE_MDIOAR 0x218
44 #define AVE_MDIOWDR 0x21c
45 #define AVE_MDIOSR 0x220
46 #define AVE_MDIORDR 0x224
47
48
49 #define AVE_DESCC 0x300
50 #define AVE_TXDC 0x304
51 #define AVE_RXDC0 0x308
52 #define AVE_IIRQC 0x34c
53
54
55 #define AVE_PKTF_BASE 0x800
56 #define AVE_PFMBYTE_BASE 0xd00
57 #define AVE_PFMBIT_BASE 0xe00
58 #define AVE_PFSEL_BASE 0xf00
59 #define AVE_PFEN 0xffc
60 #define AVE_PKTF(ent) (AVE_PKTF_BASE + (ent) * 0x40)
61 #define AVE_PFMBYTE(ent) (AVE_PFMBYTE_BASE + (ent) * 8)
62 #define AVE_PFMBIT(ent) (AVE_PFMBIT_BASE + (ent) * 4)
63 #define AVE_PFSEL(ent) (AVE_PFSEL_BASE + (ent) * 4)
64
65
66 #define AVE_DESC_SIZE_64 12
67
68 #define AVE_TXDM_64 0x1000
69 #define AVE_RXDM_64 0x1c00
70
71 #define AVE_TXDM_SIZE_64 0x0ba0
72 #define AVE_RXDM_SIZE_64 0x6000
73
74
75 #define AVE_DESC_SIZE_32 8
76
77 #define AVE_TXDM_32 0x1000
78 #define AVE_RXDM_32 0x1800
79
80 #define AVE_TXDM_SIZE_32 0x07c0
81 #define AVE_RXDM_SIZE_32 0x4000
82
83
84 #define AVE_RSTCTRL 0x8028
85 #define AVE_RSTCTRL_RMIIRST BIT(16)
86 #define AVE_LINKSEL 0x8034
87 #define AVE_LINKSEL_100M BIT(0)
88
89
90 #define AVE_GRR_RXFFR BIT(5)
91 #define AVE_GRR_PHYRST BIT(4)
92 #define AVE_GRR_GRST BIT(0)
93
94
95 #define AVE_CFGR_FLE BIT(31)
96 #define AVE_CFGR_CHE BIT(30)
97 #define AVE_CFGR_MII BIT(27)
98 #define AVE_CFGR_IPFCEN BIT(24)
99
100
101 #define AVE_GI_PHY BIT(24)
102 #define AVE_GI_TX BIT(16)
103 #define AVE_GI_RXERR BIT(8)
104 #define AVE_GI_RXOVF BIT(7)
105 #define AVE_GI_RXDROP BIT(6)
106 #define AVE_GI_RXIINT BIT(5)
107
108
109 #define AVE_TXCR_FLOCTR BIT(18)
110 #define AVE_TXCR_TXSPD_1G BIT(17)
111 #define AVE_TXCR_TXSPD_100 BIT(16)
112
113
114 #define AVE_RXCR_RXEN BIT(30)
115 #define AVE_RXCR_FDUPEN BIT(22)
116 #define AVE_RXCR_FLOCTR BIT(21)
117 #define AVE_RXCR_AFEN BIT(19)
118 #define AVE_RXCR_DRPEN BIT(18)
119 #define AVE_RXCR_MPSIZ_MASK GENMASK(10, 0)
120
121
122 #define AVE_MDIOCTR_RREQ BIT(3)
123 #define AVE_MDIOCTR_WREQ BIT(2)
124
125
126 #define AVE_MDIOSR_STS BIT(0)
127
128
129 #define AVE_DESCC_STATUS_MASK GENMASK(31, 16)
130 #define AVE_DESCC_RD0 BIT(8)
131 #define AVE_DESCC_RDSTP BIT(4)
132 #define AVE_DESCC_TD BIT(0)
133
134
135 #define AVE_TXDC_SIZE GENMASK(27, 16)
136 #define AVE_TXDC_ADDR GENMASK(11, 0)
137 #define AVE_TXDC_ADDR_START 0
138
139
140 #define AVE_RXDC0_SIZE GENMASK(30, 16)
141 #define AVE_RXDC0_ADDR GENMASK(14, 0)
142 #define AVE_RXDC0_ADDR_START 0
143
144
145 #define AVE_IIRQC_EN0 BIT(27)
146 #define AVE_IIRQC_BSCK GENMASK(15, 0)
147
148
149 #define AVE_STS_OWN BIT(31)
150 #define AVE_STS_INTR BIT(29)
151 #define AVE_STS_OK BIT(27)
152
153 #define AVE_STS_NOCSUM BIT(28)
154 #define AVE_STS_1ST BIT(26)
155 #define AVE_STS_LAST BIT(25)
156 #define AVE_STS_OWC BIT(21)
157 #define AVE_STS_EC BIT(20)
158 #define AVE_STS_PKTLEN_TX_MASK GENMASK(15, 0)
159
160 #define AVE_STS_CSSV BIT(21)
161 #define AVE_STS_CSER BIT(20)
162 #define AVE_STS_PKTLEN_RX_MASK GENMASK(10, 0)
163
164
165 #define AVE_PFMBYTE_MASK0 (GENMASK(31, 8) | GENMASK(5, 0))
166 #define AVE_PFMBYTE_MASK1 GENMASK(25, 0)
167 #define AVE_PFMBIT_MASK GENMASK(15, 0)
168
169 #define AVE_PF_SIZE 17
170 #define AVE_PF_MULTICAST_SIZE 7
171
172 #define AVE_PFNUM_FILTER 0
173 #define AVE_PFNUM_UNICAST 1
174 #define AVE_PFNUM_BROADCAST 2
175 #define AVE_PFNUM_MULTICAST 11
176
177
178 #define AVE_DEFAULT_MSG_ENABLE (NETIF_MSG_DRV | \
179 NETIF_MSG_PROBE | \
180 NETIF_MSG_LINK | \
181 NETIF_MSG_TIMER | \
182 NETIF_MSG_IFDOWN | \
183 NETIF_MSG_IFUP | \
184 NETIF_MSG_RX_ERR | \
185 NETIF_MSG_TX_ERR)
186
187
188 #define AVE_NR_TXDESC 64
189 #define AVE_NR_RXDESC 256
190
191 #define AVE_DESC_OFS_CMDSTS 0
192 #define AVE_DESC_OFS_ADDRL 4
193 #define AVE_DESC_OFS_ADDRU 8
194
195
196 #define AVE_MAX_ETHFRAME 1518
197 #define AVE_FRAME_HEADROOM 2
198
199
200 #define AVE_INTM_COUNT 20
201 #define AVE_FORCE_TXINTCNT 1
202
203
204 #define SG_ETPINMODE 0x540
205 #define SG_ETPINMODE_EXTPHY BIT(1)
206 #define SG_ETPINMODE_RMII(ins) BIT(ins)
207
208 #define IS_DESC_64BIT(p) ((p)->data->is_desc_64bit)
209
210 #define AVE_MAX_CLKS 4
211 #define AVE_MAX_RSTS 2
212
213 enum desc_id {
214 AVE_DESCID_RX,
215 AVE_DESCID_TX,
216 };
217
218 enum desc_state {
219 AVE_DESC_RX_PERMIT,
220 AVE_DESC_RX_SUSPEND,
221 AVE_DESC_START,
222 AVE_DESC_STOP,
223 };
224
225 struct ave_desc {
226 struct sk_buff *skbs;
227 dma_addr_t skbs_dma;
228 size_t skbs_dmalen;
229 };
230
231 struct ave_desc_info {
232 u32 ndesc;
233 u32 daddr;
234 u32 proc_idx;
235 u32 done_idx;
236 struct ave_desc *desc;
237 };
238
239 struct ave_stats {
240 struct u64_stats_sync syncp;
241 u64 packets;
242 u64 bytes;
243 u64 errors;
244 u64 dropped;
245 u64 collisions;
246 u64 fifo_errors;
247 };
248
249 struct ave_private {
250 void __iomem *base;
251 int irq;
252 int phy_id;
253 unsigned int desc_size;
254 u32 msg_enable;
255 int nclks;
256 struct clk *clk[AVE_MAX_CLKS];
257 int nrsts;
258 struct reset_control *rst[AVE_MAX_RSTS];
259 phy_interface_t phy_mode;
260 struct phy_device *phydev;
261 struct mii_bus *mdio;
262 struct regmap *regmap;
263 unsigned int pinmode_mask;
264 unsigned int pinmode_val;
265 u32 wolopts;
266
267
268 struct ave_stats stats_rx;
269 struct ave_stats stats_tx;
270
271
272 struct net_device *ndev;
273 struct napi_struct napi_rx;
274 struct napi_struct napi_tx;
275
276
277 struct ave_desc_info rx;
278 struct ave_desc_info tx;
279
280
281 int pause_auto;
282 int pause_rx;
283 int pause_tx;
284
285 const struct ave_soc_data *data;
286 };
287
288 struct ave_soc_data {
289 bool is_desc_64bit;
290 const char *clock_names[AVE_MAX_CLKS];
291 const char *reset_names[AVE_MAX_RSTS];
292 int (*get_pinmode)(struct ave_private *priv,
293 phy_interface_t phy_mode, u32 arg);
294 };
295
296 static u32 ave_desc_read(struct net_device *ndev, enum desc_id id, int entry,
297 int offset)
298 {
299 struct ave_private *priv = netdev_priv(ndev);
300 u32 addr;
301
302 addr = ((id == AVE_DESCID_TX) ? priv->tx.daddr : priv->rx.daddr)
303 + entry * priv->desc_size + offset;
304
305 return readl(priv->base + addr);
306 }
307
308 static u32 ave_desc_read_cmdsts(struct net_device *ndev, enum desc_id id,
309 int entry)
310 {
311 return ave_desc_read(ndev, id, entry, AVE_DESC_OFS_CMDSTS);
312 }
313
314 static void ave_desc_write(struct net_device *ndev, enum desc_id id,
315 int entry, int offset, u32 val)
316 {
317 struct ave_private *priv = netdev_priv(ndev);
318 u32 addr;
319
320 addr = ((id == AVE_DESCID_TX) ? priv->tx.daddr : priv->rx.daddr)
321 + entry * priv->desc_size + offset;
322
323 writel(val, priv->base + addr);
324 }
325
326 static void ave_desc_write_cmdsts(struct net_device *ndev, enum desc_id id,
327 int entry, u32 val)
328 {
329 ave_desc_write(ndev, id, entry, AVE_DESC_OFS_CMDSTS, val);
330 }
331
332 static void ave_desc_write_addr(struct net_device *ndev, enum desc_id id,
333 int entry, dma_addr_t paddr)
334 {
335 struct ave_private *priv = netdev_priv(ndev);
336
337 ave_desc_write(ndev, id, entry, AVE_DESC_OFS_ADDRL,
338 lower_32_bits(paddr));
339 if (IS_DESC_64BIT(priv))
340 ave_desc_write(ndev, id,
341 entry, AVE_DESC_OFS_ADDRU,
342 upper_32_bits(paddr));
343 }
344
345 static u32 ave_irq_disable_all(struct net_device *ndev)
346 {
347 struct ave_private *priv = netdev_priv(ndev);
348 u32 ret;
349
350 ret = readl(priv->base + AVE_GIMR);
351 writel(0, priv->base + AVE_GIMR);
352
353 return ret;
354 }
355
356 static void ave_irq_restore(struct net_device *ndev, u32 val)
357 {
358 struct ave_private *priv = netdev_priv(ndev);
359
360 writel(val, priv->base + AVE_GIMR);
361 }
362
363 static void ave_irq_enable(struct net_device *ndev, u32 bitflag)
364 {
365 struct ave_private *priv = netdev_priv(ndev);
366
367 writel(readl(priv->base + AVE_GIMR) | bitflag, priv->base + AVE_GIMR);
368 writel(bitflag, priv->base + AVE_GISR);
369 }
370
371 static void ave_hw_write_macaddr(struct net_device *ndev,
372 const unsigned char *mac_addr,
373 int reg1, int reg2)
374 {
375 struct ave_private *priv = netdev_priv(ndev);
376
377 writel(mac_addr[0] | mac_addr[1] << 8 |
378 mac_addr[2] << 16 | mac_addr[3] << 24, priv->base + reg1);
379 writel(mac_addr[4] | mac_addr[5] << 8, priv->base + reg2);
380 }
381
382 static void ave_hw_read_version(struct net_device *ndev, char *buf, int len)
383 {
384 struct ave_private *priv = netdev_priv(ndev);
385 u32 major, minor, vr;
386
387 vr = readl(priv->base + AVE_VR);
388 major = (vr & GENMASK(15, 8)) >> 8;
389 minor = (vr & GENMASK(7, 0));
390 snprintf(buf, len, "v%u.%u", major, minor);
391 }
392
393 static void ave_ethtool_get_drvinfo(struct net_device *ndev,
394 struct ethtool_drvinfo *info)
395 {
396 struct device *dev = ndev->dev.parent;
397
398 strlcpy(info->driver, dev->driver->name, sizeof(info->driver));
399 strlcpy(info->bus_info, dev_name(dev), sizeof(info->bus_info));
400 ave_hw_read_version(ndev, info->fw_version, sizeof(info->fw_version));
401 }
402
403 static u32 ave_ethtool_get_msglevel(struct net_device *ndev)
404 {
405 struct ave_private *priv = netdev_priv(ndev);
406
407 return priv->msg_enable;
408 }
409
410 static void ave_ethtool_set_msglevel(struct net_device *ndev, u32 val)
411 {
412 struct ave_private *priv = netdev_priv(ndev);
413
414 priv->msg_enable = val;
415 }
416
417 static void ave_ethtool_get_wol(struct net_device *ndev,
418 struct ethtool_wolinfo *wol)
419 {
420 wol->supported = 0;
421 wol->wolopts = 0;
422
423 if (ndev->phydev)
424 phy_ethtool_get_wol(ndev->phydev, wol);
425 }
426
427 static int __ave_ethtool_set_wol(struct net_device *ndev,
428 struct ethtool_wolinfo *wol)
429 {
430 if (!ndev->phydev ||
431 (wol->wolopts & (WAKE_ARP | WAKE_MAGICSECURE)))
432 return -EOPNOTSUPP;
433
434 return phy_ethtool_set_wol(ndev->phydev, wol);
435 }
436
437 static int ave_ethtool_set_wol(struct net_device *ndev,
438 struct ethtool_wolinfo *wol)
439 {
440 int ret;
441
442 ret = __ave_ethtool_set_wol(ndev, wol);
443 if (!ret)
444 device_set_wakeup_enable(&ndev->dev, !!wol->wolopts);
445
446 return ret;
447 }
448
449 static void ave_ethtool_get_pauseparam(struct net_device *ndev,
450 struct ethtool_pauseparam *pause)
451 {
452 struct ave_private *priv = netdev_priv(ndev);
453
454 pause->autoneg = priv->pause_auto;
455 pause->rx_pause = priv->pause_rx;
456 pause->tx_pause = priv->pause_tx;
457 }
458
459 static int ave_ethtool_set_pauseparam(struct net_device *ndev,
460 struct ethtool_pauseparam *pause)
461 {
462 struct ave_private *priv = netdev_priv(ndev);
463 struct phy_device *phydev = ndev->phydev;
464
465 if (!phydev)
466 return -EINVAL;
467
468 priv->pause_auto = pause->autoneg;
469 priv->pause_rx = pause->rx_pause;
470 priv->pause_tx = pause->tx_pause;
471
472 phy_set_asym_pause(phydev, pause->rx_pause, pause->tx_pause);
473
474 return 0;
475 }
476
477 static const struct ethtool_ops ave_ethtool_ops = {
478 .get_link_ksettings = phy_ethtool_get_link_ksettings,
479 .set_link_ksettings = phy_ethtool_set_link_ksettings,
480 .get_drvinfo = ave_ethtool_get_drvinfo,
481 .nway_reset = phy_ethtool_nway_reset,
482 .get_link = ethtool_op_get_link,
483 .get_msglevel = ave_ethtool_get_msglevel,
484 .set_msglevel = ave_ethtool_set_msglevel,
485 .get_wol = ave_ethtool_get_wol,
486 .set_wol = ave_ethtool_set_wol,
487 .get_pauseparam = ave_ethtool_get_pauseparam,
488 .set_pauseparam = ave_ethtool_set_pauseparam,
489 };
490
491 static int ave_mdiobus_read(struct mii_bus *bus, int phyid, int regnum)
492 {
493 struct net_device *ndev = bus->priv;
494 struct ave_private *priv;
495 u32 mdioctl, mdiosr;
496 int ret;
497
498 priv = netdev_priv(ndev);
499
500
501 writel((phyid << 8) | regnum, priv->base + AVE_MDIOAR);
502
503
504 mdioctl = readl(priv->base + AVE_MDIOCTR);
505 writel((mdioctl | AVE_MDIOCTR_RREQ) & ~AVE_MDIOCTR_WREQ,
506 priv->base + AVE_MDIOCTR);
507
508 ret = readl_poll_timeout(priv->base + AVE_MDIOSR, mdiosr,
509 !(mdiosr & AVE_MDIOSR_STS), 20, 2000);
510 if (ret) {
511 netdev_err(ndev, "failed to read (phy:%d reg:%x)\n",
512 phyid, regnum);
513 return ret;
514 }
515
516 return readl(priv->base + AVE_MDIORDR) & GENMASK(15, 0);
517 }
518
519 static int ave_mdiobus_write(struct mii_bus *bus, int phyid, int regnum,
520 u16 val)
521 {
522 struct net_device *ndev = bus->priv;
523 struct ave_private *priv;
524 u32 mdioctl, mdiosr;
525 int ret;
526
527 priv = netdev_priv(ndev);
528
529
530 writel((phyid << 8) | regnum, priv->base + AVE_MDIOAR);
531
532
533 writel(val, priv->base + AVE_MDIOWDR);
534
535
536 mdioctl = readl(priv->base + AVE_MDIOCTR);
537 writel((mdioctl | AVE_MDIOCTR_WREQ) & ~AVE_MDIOCTR_RREQ,
538 priv->base + AVE_MDIOCTR);
539
540 ret = readl_poll_timeout(priv->base + AVE_MDIOSR, mdiosr,
541 !(mdiosr & AVE_MDIOSR_STS), 20, 2000);
542 if (ret)
543 netdev_err(ndev, "failed to write (phy:%d reg:%x)\n",
544 phyid, regnum);
545
546 return ret;
547 }
548
549 static int ave_dma_map(struct net_device *ndev, struct ave_desc *desc,
550 void *ptr, size_t len, enum dma_data_direction dir,
551 dma_addr_t *paddr)
552 {
553 dma_addr_t map_addr;
554
555 map_addr = dma_map_single(ndev->dev.parent, ptr, len, dir);
556 if (unlikely(dma_mapping_error(ndev->dev.parent, map_addr)))
557 return -ENOMEM;
558
559 desc->skbs_dma = map_addr;
560 desc->skbs_dmalen = len;
561 *paddr = map_addr;
562
563 return 0;
564 }
565
566 static void ave_dma_unmap(struct net_device *ndev, struct ave_desc *desc,
567 enum dma_data_direction dir)
568 {
569 if (!desc->skbs_dma)
570 return;
571
572 dma_unmap_single(ndev->dev.parent,
573 desc->skbs_dma, desc->skbs_dmalen, dir);
574 desc->skbs_dma = 0;
575 }
576
577
578 static int ave_rxdesc_prepare(struct net_device *ndev, int entry)
579 {
580 struct ave_private *priv = netdev_priv(ndev);
581 struct sk_buff *skb;
582 dma_addr_t paddr;
583 int ret;
584
585 skb = priv->rx.desc[entry].skbs;
586 if (!skb) {
587 skb = netdev_alloc_skb(ndev, AVE_MAX_ETHFRAME);
588 if (!skb) {
589 netdev_err(ndev, "can't allocate skb for Rx\n");
590 return -ENOMEM;
591 }
592 skb->data += AVE_FRAME_HEADROOM;
593 skb->tail += AVE_FRAME_HEADROOM;
594 }
595
596
597 ave_desc_write_cmdsts(ndev, AVE_DESCID_RX, entry,
598 AVE_STS_INTR | AVE_STS_OWN);
599
600
601
602
603
604
605
606
607
608
609 ret = ave_dma_map(ndev, &priv->rx.desc[entry],
610 skb->data - AVE_FRAME_HEADROOM,
611 AVE_MAX_ETHFRAME + AVE_FRAME_HEADROOM,
612 DMA_FROM_DEVICE, &paddr);
613 if (ret) {
614 netdev_err(ndev, "can't map skb for Rx\n");
615 dev_kfree_skb_any(skb);
616 return ret;
617 }
618 priv->rx.desc[entry].skbs = skb;
619
620
621 ave_desc_write_addr(ndev, AVE_DESCID_RX, entry, paddr);
622
623
624 ave_desc_write_cmdsts(ndev, AVE_DESCID_RX, entry,
625 AVE_STS_INTR | AVE_MAX_ETHFRAME);
626
627 return ret;
628 }
629
630
631 static int ave_desc_switch(struct net_device *ndev, enum desc_state state)
632 {
633 struct ave_private *priv = netdev_priv(ndev);
634 int ret = 0;
635 u32 val;
636
637 switch (state) {
638 case AVE_DESC_START:
639 writel(AVE_DESCC_TD | AVE_DESCC_RD0, priv->base + AVE_DESCC);
640 break;
641
642 case AVE_DESC_STOP:
643 writel(0, priv->base + AVE_DESCC);
644 if (readl_poll_timeout(priv->base + AVE_DESCC, val, !val,
645 150, 15000)) {
646 netdev_err(ndev, "can't stop descriptor\n");
647 ret = -EBUSY;
648 }
649 break;
650
651 case AVE_DESC_RX_SUSPEND:
652 val = readl(priv->base + AVE_DESCC);
653 val |= AVE_DESCC_RDSTP;
654 val &= ~AVE_DESCC_STATUS_MASK;
655 writel(val, priv->base + AVE_DESCC);
656 if (readl_poll_timeout(priv->base + AVE_DESCC, val,
657 val & (AVE_DESCC_RDSTP << 16),
658 150, 150000)) {
659 netdev_err(ndev, "can't suspend descriptor\n");
660 ret = -EBUSY;
661 }
662 break;
663
664 case AVE_DESC_RX_PERMIT:
665 val = readl(priv->base + AVE_DESCC);
666 val &= ~AVE_DESCC_RDSTP;
667 val &= ~AVE_DESCC_STATUS_MASK;
668 writel(val, priv->base + AVE_DESCC);
669 break;
670
671 default:
672 ret = -EINVAL;
673 break;
674 }
675
676 return ret;
677 }
678
679 static int ave_tx_complete(struct net_device *ndev)
680 {
681 struct ave_private *priv = netdev_priv(ndev);
682 u32 proc_idx, done_idx, ndesc, cmdsts;
683 unsigned int nr_freebuf = 0;
684 unsigned int tx_packets = 0;
685 unsigned int tx_bytes = 0;
686
687 proc_idx = priv->tx.proc_idx;
688 done_idx = priv->tx.done_idx;
689 ndesc = priv->tx.ndesc;
690
691
692 while (proc_idx != done_idx) {
693 cmdsts = ave_desc_read_cmdsts(ndev, AVE_DESCID_TX, done_idx);
694
695
696 if (cmdsts & AVE_STS_OWN)
697 break;
698
699
700 if (cmdsts & AVE_STS_OK) {
701 tx_bytes += cmdsts & AVE_STS_PKTLEN_TX_MASK;
702
703 if (cmdsts & AVE_STS_LAST)
704 tx_packets++;
705 } else {
706
707 if (cmdsts & AVE_STS_LAST) {
708 priv->stats_tx.errors++;
709 if (cmdsts & (AVE_STS_OWC | AVE_STS_EC))
710 priv->stats_tx.collisions++;
711 }
712 }
713
714
715 if (priv->tx.desc[done_idx].skbs) {
716 ave_dma_unmap(ndev, &priv->tx.desc[done_idx],
717 DMA_TO_DEVICE);
718 dev_consume_skb_any(priv->tx.desc[done_idx].skbs);
719 priv->tx.desc[done_idx].skbs = NULL;
720 nr_freebuf++;
721 }
722 done_idx = (done_idx + 1) % ndesc;
723 }
724
725 priv->tx.done_idx = done_idx;
726
727
728 u64_stats_update_begin(&priv->stats_tx.syncp);
729 priv->stats_tx.packets += tx_packets;
730 priv->stats_tx.bytes += tx_bytes;
731 u64_stats_update_end(&priv->stats_tx.syncp);
732
733
734 if (unlikely(netif_queue_stopped(ndev)) && nr_freebuf)
735 netif_wake_queue(ndev);
736
737 return nr_freebuf;
738 }
739
740 static int ave_rx_receive(struct net_device *ndev, int num)
741 {
742 struct ave_private *priv = netdev_priv(ndev);
743 unsigned int rx_packets = 0;
744 unsigned int rx_bytes = 0;
745 u32 proc_idx, done_idx;
746 struct sk_buff *skb;
747 unsigned int pktlen;
748 int restpkt, npkts;
749 u32 ndesc, cmdsts;
750
751 proc_idx = priv->rx.proc_idx;
752 done_idx = priv->rx.done_idx;
753 ndesc = priv->rx.ndesc;
754 restpkt = ((proc_idx + ndesc - 1) - done_idx) % ndesc;
755
756 for (npkts = 0; npkts < num; npkts++) {
757
758 if (--restpkt < 0)
759 break;
760
761 cmdsts = ave_desc_read_cmdsts(ndev, AVE_DESCID_RX, proc_idx);
762
763
764 if (!(cmdsts & AVE_STS_OWN))
765 break;
766
767 if (!(cmdsts & AVE_STS_OK)) {
768 priv->stats_rx.errors++;
769 proc_idx = (proc_idx + 1) % ndesc;
770 continue;
771 }
772
773 pktlen = cmdsts & AVE_STS_PKTLEN_RX_MASK;
774
775
776 skb = priv->rx.desc[proc_idx].skbs;
777 priv->rx.desc[proc_idx].skbs = NULL;
778
779 ave_dma_unmap(ndev, &priv->rx.desc[proc_idx], DMA_FROM_DEVICE);
780
781 skb->dev = ndev;
782 skb_put(skb, pktlen);
783 skb->protocol = eth_type_trans(skb, ndev);
784
785 if ((cmdsts & AVE_STS_CSSV) && (!(cmdsts & AVE_STS_CSER)))
786 skb->ip_summed = CHECKSUM_UNNECESSARY;
787
788 rx_packets++;
789 rx_bytes += pktlen;
790
791 netif_receive_skb(skb);
792
793 proc_idx = (proc_idx + 1) % ndesc;
794 }
795
796 priv->rx.proc_idx = proc_idx;
797
798
799 u64_stats_update_begin(&priv->stats_rx.syncp);
800 priv->stats_rx.packets += rx_packets;
801 priv->stats_rx.bytes += rx_bytes;
802 u64_stats_update_end(&priv->stats_rx.syncp);
803
804
805 while (proc_idx != done_idx) {
806 if (ave_rxdesc_prepare(ndev, done_idx))
807 break;
808 done_idx = (done_idx + 1) % ndesc;
809 }
810
811 priv->rx.done_idx = done_idx;
812
813 return npkts;
814 }
815
816 static int ave_napi_poll_rx(struct napi_struct *napi, int budget)
817 {
818 struct ave_private *priv;
819 struct net_device *ndev;
820 int num;
821
822 priv = container_of(napi, struct ave_private, napi_rx);
823 ndev = priv->ndev;
824
825 num = ave_rx_receive(ndev, budget);
826 if (num < budget) {
827 napi_complete_done(napi, num);
828
829
830 ave_irq_enable(ndev, AVE_GI_RXIINT);
831 }
832
833 return num;
834 }
835
836 static int ave_napi_poll_tx(struct napi_struct *napi, int budget)
837 {
838 struct ave_private *priv;
839 struct net_device *ndev;
840 int num;
841
842 priv = container_of(napi, struct ave_private, napi_tx);
843 ndev = priv->ndev;
844
845 num = ave_tx_complete(ndev);
846 napi_complete(napi);
847
848
849 ave_irq_enable(ndev, AVE_GI_TX);
850
851 return num;
852 }
853
854 static void ave_global_reset(struct net_device *ndev)
855 {
856 struct ave_private *priv = netdev_priv(ndev);
857 u32 val;
858
859
860 val = AVE_CFGR_FLE | AVE_CFGR_IPFCEN | AVE_CFGR_CHE;
861 if (!phy_interface_mode_is_rgmii(priv->phy_mode))
862 val |= AVE_CFGR_MII;
863 writel(val, priv->base + AVE_CFGR);
864
865
866 val = readl(priv->base + AVE_RSTCTRL);
867 val &= ~AVE_RSTCTRL_RMIIRST;
868 writel(val, priv->base + AVE_RSTCTRL);
869
870
871 writel(AVE_GRR_GRST | AVE_GRR_PHYRST, priv->base + AVE_GRR);
872 msleep(20);
873
874
875 writel(AVE_GRR_GRST, priv->base + AVE_GRR);
876 msleep(40);
877
878
879 writel(0, priv->base + AVE_GRR);
880 msleep(40);
881
882
883 val = readl(priv->base + AVE_RSTCTRL);
884 val |= AVE_RSTCTRL_RMIIRST;
885 writel(val, priv->base + AVE_RSTCTRL);
886
887 ave_irq_disable_all(ndev);
888 }
889
890 static void ave_rxfifo_reset(struct net_device *ndev)
891 {
892 struct ave_private *priv = netdev_priv(ndev);
893 u32 rxcr_org;
894
895
896 rxcr_org = readl(priv->base + AVE_RXCR);
897 writel(rxcr_org & (~AVE_RXCR_RXEN), priv->base + AVE_RXCR);
898
899
900 ave_desc_switch(ndev, AVE_DESC_RX_SUSPEND);
901
902
903 ave_rx_receive(ndev, priv->rx.ndesc);
904
905
906 writel(AVE_GRR_RXFFR, priv->base + AVE_GRR);
907 udelay(50);
908
909
910 writel(0, priv->base + AVE_GRR);
911 udelay(20);
912
913
914 writel(AVE_GI_RXOVF, priv->base + AVE_GISR);
915
916
917 ave_desc_switch(ndev, AVE_DESC_RX_PERMIT);
918
919
920 writel(rxcr_org, priv->base + AVE_RXCR);
921 }
922
923 static irqreturn_t ave_irq_handler(int irq, void *netdev)
924 {
925 struct net_device *ndev = (struct net_device *)netdev;
926 struct ave_private *priv = netdev_priv(ndev);
927 u32 gimr_val, gisr_val;
928
929 gimr_val = ave_irq_disable_all(ndev);
930
931
932 gisr_val = readl(priv->base + AVE_GISR);
933
934
935 if (gisr_val & AVE_GI_PHY)
936 writel(AVE_GI_PHY, priv->base + AVE_GISR);
937
938
939 if (gisr_val & AVE_GI_RXERR) {
940 writel(AVE_GI_RXERR, priv->base + AVE_GISR);
941 netdev_err(ndev, "receive a packet exceeding frame buffer\n");
942 }
943
944 gisr_val &= gimr_val;
945 if (!gisr_val)
946 goto exit_isr;
947
948
949 if (gisr_val & AVE_GI_RXOVF) {
950 priv->stats_rx.fifo_errors++;
951 ave_rxfifo_reset(ndev);
952 goto exit_isr;
953 }
954
955
956 if (gisr_val & AVE_GI_RXDROP) {
957 priv->stats_rx.dropped++;
958 writel(AVE_GI_RXDROP, priv->base + AVE_GISR);
959 }
960
961
962 if (gisr_val & AVE_GI_RXIINT) {
963 napi_schedule(&priv->napi_rx);
964
965 gimr_val &= ~AVE_GI_RXIINT;
966 }
967
968
969 if (gisr_val & AVE_GI_TX) {
970 napi_schedule(&priv->napi_tx);
971
972 gimr_val &= ~AVE_GI_TX;
973 }
974
975 exit_isr:
976 ave_irq_restore(ndev, gimr_val);
977
978 return IRQ_HANDLED;
979 }
980
981 static int ave_pfsel_start(struct net_device *ndev, unsigned int entry)
982 {
983 struct ave_private *priv = netdev_priv(ndev);
984 u32 val;
985
986 if (WARN_ON(entry > AVE_PF_SIZE))
987 return -EINVAL;
988
989 val = readl(priv->base + AVE_PFEN);
990 writel(val | BIT(entry), priv->base + AVE_PFEN);
991
992 return 0;
993 }
994
995 static int ave_pfsel_stop(struct net_device *ndev, unsigned int entry)
996 {
997 struct ave_private *priv = netdev_priv(ndev);
998 u32 val;
999
1000 if (WARN_ON(entry > AVE_PF_SIZE))
1001 return -EINVAL;
1002
1003 val = readl(priv->base + AVE_PFEN);
1004 writel(val & ~BIT(entry), priv->base + AVE_PFEN);
1005
1006 return 0;
1007 }
1008
1009 static int ave_pfsel_set_macaddr(struct net_device *ndev,
1010 unsigned int entry,
1011 const unsigned char *mac_addr,
1012 unsigned int set_size)
1013 {
1014 struct ave_private *priv = netdev_priv(ndev);
1015
1016 if (WARN_ON(entry > AVE_PF_SIZE))
1017 return -EINVAL;
1018 if (WARN_ON(set_size > 6))
1019 return -EINVAL;
1020
1021 ave_pfsel_stop(ndev, entry);
1022
1023
1024 ave_hw_write_macaddr(ndev, mac_addr,
1025 AVE_PKTF(entry), AVE_PKTF(entry) + 4);
1026
1027
1028 writel(GENMASK(31, set_size) & AVE_PFMBYTE_MASK0,
1029 priv->base + AVE_PFMBYTE(entry));
1030 writel(AVE_PFMBYTE_MASK1, priv->base + AVE_PFMBYTE(entry) + 4);
1031
1032
1033 writel(AVE_PFMBIT_MASK, priv->base + AVE_PFMBIT(entry));
1034
1035
1036 writel(0, priv->base + AVE_PFSEL(entry));
1037
1038
1039 ave_pfsel_start(ndev, entry);
1040
1041 return 0;
1042 }
1043
1044 static void ave_pfsel_set_promisc(struct net_device *ndev,
1045 unsigned int entry, u32 rxring)
1046 {
1047 struct ave_private *priv = netdev_priv(ndev);
1048
1049 if (WARN_ON(entry > AVE_PF_SIZE))
1050 return;
1051
1052 ave_pfsel_stop(ndev, entry);
1053
1054
1055 writel(AVE_PFMBYTE_MASK0, priv->base + AVE_PFMBYTE(entry));
1056 writel(AVE_PFMBYTE_MASK1, priv->base + AVE_PFMBYTE(entry) + 4);
1057
1058
1059 writel(AVE_PFMBIT_MASK, priv->base + AVE_PFMBIT(entry));
1060
1061
1062 writel(rxring, priv->base + AVE_PFSEL(entry));
1063
1064 ave_pfsel_start(ndev, entry);
1065 }
1066
1067 static void ave_pfsel_init(struct net_device *ndev)
1068 {
1069 unsigned char bcast_mac[ETH_ALEN];
1070 int i;
1071
1072 eth_broadcast_addr(bcast_mac);
1073
1074 for (i = 0; i < AVE_PF_SIZE; i++)
1075 ave_pfsel_stop(ndev, i);
1076
1077
1078 ave_pfsel_set_promisc(ndev, AVE_PFNUM_FILTER, 0);
1079
1080
1081 ave_pfsel_set_macaddr(ndev, AVE_PFNUM_UNICAST, ndev->dev_addr, 6);
1082
1083
1084 ave_pfsel_set_macaddr(ndev, AVE_PFNUM_BROADCAST, bcast_mac, 6);
1085 }
1086
1087 static void ave_phy_adjust_link(struct net_device *ndev)
1088 {
1089 struct ave_private *priv = netdev_priv(ndev);
1090 struct phy_device *phydev = ndev->phydev;
1091 u32 val, txcr, rxcr, rxcr_org;
1092 u16 rmt_adv = 0, lcl_adv = 0;
1093 u8 cap;
1094
1095
1096 val = readl(priv->base + AVE_TXCR);
1097 val &= ~(AVE_TXCR_TXSPD_100 | AVE_TXCR_TXSPD_1G);
1098
1099 if (phy_interface_is_rgmii(phydev) && phydev->speed == SPEED_1000)
1100 val |= AVE_TXCR_TXSPD_1G;
1101 else if (phydev->speed == SPEED_100)
1102 val |= AVE_TXCR_TXSPD_100;
1103
1104 writel(val, priv->base + AVE_TXCR);
1105
1106
1107 if (!phy_interface_is_rgmii(phydev)) {
1108 val = readl(priv->base + AVE_LINKSEL);
1109 if (phydev->speed == SPEED_10)
1110 val &= ~AVE_LINKSEL_100M;
1111 else
1112 val |= AVE_LINKSEL_100M;
1113 writel(val, priv->base + AVE_LINKSEL);
1114 }
1115
1116
1117 rxcr = readl(priv->base + AVE_RXCR);
1118 txcr = readl(priv->base + AVE_TXCR);
1119 rxcr_org = rxcr;
1120
1121 if (phydev->duplex) {
1122 rxcr |= AVE_RXCR_FDUPEN;
1123
1124 if (phydev->pause)
1125 rmt_adv |= LPA_PAUSE_CAP;
1126 if (phydev->asym_pause)
1127 rmt_adv |= LPA_PAUSE_ASYM;
1128
1129 lcl_adv = linkmode_adv_to_lcl_adv_t(phydev->advertising);
1130 cap = mii_resolve_flowctrl_fdx(lcl_adv, rmt_adv);
1131 if (cap & FLOW_CTRL_TX)
1132 txcr |= AVE_TXCR_FLOCTR;
1133 else
1134 txcr &= ~AVE_TXCR_FLOCTR;
1135 if (cap & FLOW_CTRL_RX)
1136 rxcr |= AVE_RXCR_FLOCTR;
1137 else
1138 rxcr &= ~AVE_RXCR_FLOCTR;
1139 } else {
1140 rxcr &= ~AVE_RXCR_FDUPEN;
1141 rxcr &= ~AVE_RXCR_FLOCTR;
1142 txcr &= ~AVE_TXCR_FLOCTR;
1143 }
1144
1145 if (rxcr_org != rxcr) {
1146
1147 writel(rxcr & ~AVE_RXCR_RXEN, priv->base + AVE_RXCR);
1148
1149 writel(txcr, priv->base + AVE_TXCR);
1150 writel(rxcr, priv->base + AVE_RXCR);
1151 }
1152
1153 phy_print_status(phydev);
1154 }
1155
1156 static void ave_macaddr_init(struct net_device *ndev)
1157 {
1158 ave_hw_write_macaddr(ndev, ndev->dev_addr, AVE_RXMAC1R, AVE_RXMAC2R);
1159
1160
1161 ave_pfsel_set_macaddr(ndev, AVE_PFNUM_UNICAST, ndev->dev_addr, 6);
1162 }
1163
1164 static int ave_init(struct net_device *ndev)
1165 {
1166 struct ethtool_wolinfo wol = { .cmd = ETHTOOL_GWOL };
1167 struct ave_private *priv = netdev_priv(ndev);
1168 struct device *dev = ndev->dev.parent;
1169 struct device_node *np = dev->of_node;
1170 struct device_node *mdio_np;
1171 struct phy_device *phydev;
1172 int nc, nr, ret;
1173
1174
1175 for (nc = 0; nc < priv->nclks; nc++) {
1176 ret = clk_prepare_enable(priv->clk[nc]);
1177 if (ret) {
1178 dev_err(dev, "can't enable clock\n");
1179 goto out_clk_disable;
1180 }
1181 }
1182
1183 for (nr = 0; nr < priv->nrsts; nr++) {
1184 ret = reset_control_deassert(priv->rst[nr]);
1185 if (ret) {
1186 dev_err(dev, "can't deassert reset\n");
1187 goto out_reset_assert;
1188 }
1189 }
1190
1191 ret = regmap_update_bits(priv->regmap, SG_ETPINMODE,
1192 priv->pinmode_mask, priv->pinmode_val);
1193 if (ret)
1194 return ret;
1195
1196 ave_global_reset(ndev);
1197
1198 mdio_np = of_get_child_by_name(np, "mdio");
1199 if (!mdio_np) {
1200 dev_err(dev, "mdio node not found\n");
1201 ret = -EINVAL;
1202 goto out_reset_assert;
1203 }
1204 ret = of_mdiobus_register(priv->mdio, mdio_np);
1205 of_node_put(mdio_np);
1206 if (ret) {
1207 dev_err(dev, "failed to register mdiobus\n");
1208 goto out_reset_assert;
1209 }
1210
1211 phydev = of_phy_get_and_connect(ndev, np, ave_phy_adjust_link);
1212 if (!phydev) {
1213 dev_err(dev, "could not attach to PHY\n");
1214 ret = -ENODEV;
1215 goto out_mdio_unregister;
1216 }
1217
1218 priv->phydev = phydev;
1219
1220 ave_ethtool_get_wol(ndev, &wol);
1221 device_set_wakeup_capable(&ndev->dev, !!wol.supported);
1222
1223
1224 wol.wolopts = 0;
1225 __ave_ethtool_set_wol(ndev, &wol);
1226
1227 if (!phy_interface_is_rgmii(phydev))
1228 phy_set_max_speed(phydev, SPEED_100);
1229
1230 phy_support_asym_pause(phydev);
1231
1232 phy_attached_info(phydev);
1233
1234 return 0;
1235
1236 out_mdio_unregister:
1237 mdiobus_unregister(priv->mdio);
1238 out_reset_assert:
1239 while (--nr >= 0)
1240 reset_control_assert(priv->rst[nr]);
1241 out_clk_disable:
1242 while (--nc >= 0)
1243 clk_disable_unprepare(priv->clk[nc]);
1244
1245 return ret;
1246 }
1247
1248 static void ave_uninit(struct net_device *ndev)
1249 {
1250 struct ave_private *priv = netdev_priv(ndev);
1251 int i;
1252
1253 phy_disconnect(priv->phydev);
1254 mdiobus_unregister(priv->mdio);
1255
1256
1257 for (i = 0; i < priv->nrsts; i++)
1258 reset_control_assert(priv->rst[i]);
1259 for (i = 0; i < priv->nclks; i++)
1260 clk_disable_unprepare(priv->clk[i]);
1261 }
1262
1263 static int ave_open(struct net_device *ndev)
1264 {
1265 struct ave_private *priv = netdev_priv(ndev);
1266 int entry;
1267 int ret;
1268 u32 val;
1269
1270 ret = request_irq(priv->irq, ave_irq_handler, IRQF_SHARED, ndev->name,
1271 ndev);
1272 if (ret)
1273 return ret;
1274
1275 priv->tx.desc = kcalloc(priv->tx.ndesc, sizeof(*priv->tx.desc),
1276 GFP_KERNEL);
1277 if (!priv->tx.desc) {
1278 ret = -ENOMEM;
1279 goto out_free_irq;
1280 }
1281
1282 priv->rx.desc = kcalloc(priv->rx.ndesc, sizeof(*priv->rx.desc),
1283 GFP_KERNEL);
1284 if (!priv->rx.desc) {
1285 kfree(priv->tx.desc);
1286 ret = -ENOMEM;
1287 goto out_free_irq;
1288 }
1289
1290
1291 priv->tx.proc_idx = 0;
1292 priv->tx.done_idx = 0;
1293 for (entry = 0; entry < priv->tx.ndesc; entry++) {
1294 ave_desc_write_cmdsts(ndev, AVE_DESCID_TX, entry, 0);
1295 ave_desc_write_addr(ndev, AVE_DESCID_TX, entry, 0);
1296 }
1297 writel(AVE_TXDC_ADDR_START |
1298 (((priv->tx.ndesc * priv->desc_size) << 16) & AVE_TXDC_SIZE),
1299 priv->base + AVE_TXDC);
1300
1301
1302 priv->rx.proc_idx = 0;
1303 priv->rx.done_idx = 0;
1304 for (entry = 0; entry < priv->rx.ndesc; entry++) {
1305 if (ave_rxdesc_prepare(ndev, entry))
1306 break;
1307 }
1308 writel(AVE_RXDC0_ADDR_START |
1309 (((priv->rx.ndesc * priv->desc_size) << 16) & AVE_RXDC0_SIZE),
1310 priv->base + AVE_RXDC0);
1311
1312 ave_desc_switch(ndev, AVE_DESC_START);
1313
1314 ave_pfsel_init(ndev);
1315 ave_macaddr_init(ndev);
1316
1317
1318
1319 val = AVE_RXCR_RXEN | AVE_RXCR_FDUPEN | AVE_RXCR_DRPEN |
1320 AVE_RXCR_FLOCTR | (AVE_MAX_ETHFRAME & AVE_RXCR_MPSIZ_MASK);
1321 writel(val, priv->base + AVE_RXCR);
1322
1323
1324
1325 writel(AVE_TXCR_FLOCTR, priv->base + AVE_TXCR);
1326
1327
1328 val = readl(priv->base + AVE_IIRQC) & AVE_IIRQC_BSCK;
1329 val |= AVE_IIRQC_EN0 | (AVE_INTM_COUNT << 16);
1330 writel(val, priv->base + AVE_IIRQC);
1331
1332 val = AVE_GI_RXIINT | AVE_GI_RXOVF | AVE_GI_TX | AVE_GI_RXDROP;
1333 ave_irq_restore(ndev, val);
1334
1335 napi_enable(&priv->napi_rx);
1336 napi_enable(&priv->napi_tx);
1337
1338 phy_start(ndev->phydev);
1339 phy_start_aneg(ndev->phydev);
1340 netif_start_queue(ndev);
1341
1342 return 0;
1343
1344 out_free_irq:
1345 disable_irq(priv->irq);
1346 free_irq(priv->irq, ndev);
1347
1348 return ret;
1349 }
1350
1351 static int ave_stop(struct net_device *ndev)
1352 {
1353 struct ave_private *priv = netdev_priv(ndev);
1354 int entry;
1355
1356 ave_irq_disable_all(ndev);
1357 disable_irq(priv->irq);
1358 free_irq(priv->irq, ndev);
1359
1360 netif_tx_disable(ndev);
1361 phy_stop(ndev->phydev);
1362 napi_disable(&priv->napi_tx);
1363 napi_disable(&priv->napi_rx);
1364
1365 ave_desc_switch(ndev, AVE_DESC_STOP);
1366
1367
1368 for (entry = 0; entry < priv->tx.ndesc; entry++) {
1369 if (!priv->tx.desc[entry].skbs)
1370 continue;
1371
1372 ave_dma_unmap(ndev, &priv->tx.desc[entry], DMA_TO_DEVICE);
1373 dev_kfree_skb_any(priv->tx.desc[entry].skbs);
1374 priv->tx.desc[entry].skbs = NULL;
1375 }
1376 priv->tx.proc_idx = 0;
1377 priv->tx.done_idx = 0;
1378
1379
1380 for (entry = 0; entry < priv->rx.ndesc; entry++) {
1381 if (!priv->rx.desc[entry].skbs)
1382 continue;
1383
1384 ave_dma_unmap(ndev, &priv->rx.desc[entry], DMA_FROM_DEVICE);
1385 dev_kfree_skb_any(priv->rx.desc[entry].skbs);
1386 priv->rx.desc[entry].skbs = NULL;
1387 }
1388 priv->rx.proc_idx = 0;
1389 priv->rx.done_idx = 0;
1390
1391 kfree(priv->tx.desc);
1392 kfree(priv->rx.desc);
1393
1394 return 0;
1395 }
1396
1397 static int ave_start_xmit(struct sk_buff *skb, struct net_device *ndev)
1398 {
1399 struct ave_private *priv = netdev_priv(ndev);
1400 u32 proc_idx, done_idx, ndesc, cmdsts;
1401 int ret, freepkt;
1402 dma_addr_t paddr;
1403
1404 proc_idx = priv->tx.proc_idx;
1405 done_idx = priv->tx.done_idx;
1406 ndesc = priv->tx.ndesc;
1407 freepkt = ((done_idx + ndesc - 1) - proc_idx) % ndesc;
1408
1409
1410 if (unlikely(freepkt < 1)) {
1411 netif_stop_queue(ndev);
1412 return NETDEV_TX_BUSY;
1413 }
1414
1415
1416 if (skb_put_padto(skb, ETH_ZLEN)) {
1417 priv->stats_tx.dropped++;
1418 return NETDEV_TX_OK;
1419 }
1420
1421
1422
1423
1424 ret = ave_dma_map(ndev, &priv->tx.desc[proc_idx],
1425 skb->data, skb->len, DMA_TO_DEVICE, &paddr);
1426 if (ret) {
1427 dev_kfree_skb_any(skb);
1428 priv->stats_tx.dropped++;
1429 return NETDEV_TX_OK;
1430 }
1431
1432 priv->tx.desc[proc_idx].skbs = skb;
1433
1434 ave_desc_write_addr(ndev, AVE_DESCID_TX, proc_idx, paddr);
1435
1436 cmdsts = AVE_STS_OWN | AVE_STS_1ST | AVE_STS_LAST |
1437 (skb->len & AVE_STS_PKTLEN_TX_MASK);
1438
1439
1440 if (!(proc_idx % AVE_FORCE_TXINTCNT) || netif_queue_stopped(ndev))
1441 cmdsts |= AVE_STS_INTR;
1442
1443
1444 if (skb->ip_summed == CHECKSUM_NONE ||
1445 skb->ip_summed == CHECKSUM_UNNECESSARY)
1446 cmdsts |= AVE_STS_NOCSUM;
1447
1448 ave_desc_write_cmdsts(ndev, AVE_DESCID_TX, proc_idx, cmdsts);
1449
1450 priv->tx.proc_idx = (proc_idx + 1) % ndesc;
1451
1452 return NETDEV_TX_OK;
1453 }
1454
1455 static int ave_ioctl(struct net_device *ndev, struct ifreq *ifr, int cmd)
1456 {
1457 return phy_mii_ioctl(ndev->phydev, ifr, cmd);
1458 }
1459
1460 static const u8 v4multi_macadr[] = { 0x01, 0x00, 0x00, 0x00, 0x00, 0x00 };
1461 static const u8 v6multi_macadr[] = { 0x33, 0x00, 0x00, 0x00, 0x00, 0x00 };
1462
1463 static void ave_set_rx_mode(struct net_device *ndev)
1464 {
1465 struct ave_private *priv = netdev_priv(ndev);
1466 struct netdev_hw_addr *hw_adr;
1467 int count, mc_cnt;
1468 u32 val;
1469
1470
1471 mc_cnt = netdev_mc_count(ndev);
1472 val = readl(priv->base + AVE_RXCR);
1473 if (ndev->flags & IFF_PROMISC || !mc_cnt)
1474 val &= ~AVE_RXCR_AFEN;
1475 else
1476 val |= AVE_RXCR_AFEN;
1477 writel(val, priv->base + AVE_RXCR);
1478
1479
1480 if ((ndev->flags & IFF_ALLMULTI) || mc_cnt > AVE_PF_MULTICAST_SIZE) {
1481 ave_pfsel_set_macaddr(ndev, AVE_PFNUM_MULTICAST,
1482 v4multi_macadr, 1);
1483 ave_pfsel_set_macaddr(ndev, AVE_PFNUM_MULTICAST + 1,
1484 v6multi_macadr, 1);
1485 } else {
1486
1487 for (count = 0; count < AVE_PF_MULTICAST_SIZE; count++)
1488 ave_pfsel_stop(ndev, AVE_PFNUM_MULTICAST + count);
1489
1490
1491 count = 0;
1492 netdev_for_each_mc_addr(hw_adr, ndev) {
1493 if (count == mc_cnt)
1494 break;
1495 ave_pfsel_set_macaddr(ndev, AVE_PFNUM_MULTICAST + count,
1496 hw_adr->addr, 6);
1497 count++;
1498 }
1499 }
1500 }
1501
1502 static void ave_get_stats64(struct net_device *ndev,
1503 struct rtnl_link_stats64 *stats)
1504 {
1505 struct ave_private *priv = netdev_priv(ndev);
1506 unsigned int start;
1507
1508 do {
1509 start = u64_stats_fetch_begin_irq(&priv->stats_rx.syncp);
1510 stats->rx_packets = priv->stats_rx.packets;
1511 stats->rx_bytes = priv->stats_rx.bytes;
1512 } while (u64_stats_fetch_retry_irq(&priv->stats_rx.syncp, start));
1513
1514 do {
1515 start = u64_stats_fetch_begin_irq(&priv->stats_tx.syncp);
1516 stats->tx_packets = priv->stats_tx.packets;
1517 stats->tx_bytes = priv->stats_tx.bytes;
1518 } while (u64_stats_fetch_retry_irq(&priv->stats_tx.syncp, start));
1519
1520 stats->rx_errors = priv->stats_rx.errors;
1521 stats->tx_errors = priv->stats_tx.errors;
1522 stats->rx_dropped = priv->stats_rx.dropped;
1523 stats->tx_dropped = priv->stats_tx.dropped;
1524 stats->rx_fifo_errors = priv->stats_rx.fifo_errors;
1525 stats->collisions = priv->stats_tx.collisions;
1526 }
1527
1528 static int ave_set_mac_address(struct net_device *ndev, void *p)
1529 {
1530 int ret = eth_mac_addr(ndev, p);
1531
1532 if (ret)
1533 return ret;
1534
1535 ave_macaddr_init(ndev);
1536
1537 return 0;
1538 }
1539
1540 static const struct net_device_ops ave_netdev_ops = {
1541 .ndo_init = ave_init,
1542 .ndo_uninit = ave_uninit,
1543 .ndo_open = ave_open,
1544 .ndo_stop = ave_stop,
1545 .ndo_start_xmit = ave_start_xmit,
1546 .ndo_do_ioctl = ave_ioctl,
1547 .ndo_set_rx_mode = ave_set_rx_mode,
1548 .ndo_get_stats64 = ave_get_stats64,
1549 .ndo_set_mac_address = ave_set_mac_address,
1550 };
1551
1552 static int ave_probe(struct platform_device *pdev)
1553 {
1554 const struct ave_soc_data *data;
1555 struct device *dev = &pdev->dev;
1556 char buf[ETHTOOL_FWVERS_LEN];
1557 struct of_phandle_args args;
1558 phy_interface_t phy_mode;
1559 struct ave_private *priv;
1560 struct net_device *ndev;
1561 struct device_node *np;
1562 const void *mac_addr;
1563 void __iomem *base;
1564 const char *name;
1565 int i, irq, ret;
1566 u64 dma_mask;
1567 u32 ave_id;
1568
1569 data = of_device_get_match_data(dev);
1570 if (WARN_ON(!data))
1571 return -EINVAL;
1572
1573 np = dev->of_node;
1574 phy_mode = of_get_phy_mode(np);
1575 if ((int)phy_mode < 0) {
1576 dev_err(dev, "phy-mode not found\n");
1577 return -EINVAL;
1578 }
1579
1580 irq = platform_get_irq(pdev, 0);
1581 if (irq < 0)
1582 return irq;
1583
1584 base = devm_platform_ioremap_resource(pdev, 0);
1585 if (IS_ERR(base))
1586 return PTR_ERR(base);
1587
1588 ndev = alloc_etherdev(sizeof(struct ave_private));
1589 if (!ndev) {
1590 dev_err(dev, "can't allocate ethernet device\n");
1591 return -ENOMEM;
1592 }
1593
1594 ndev->netdev_ops = &ave_netdev_ops;
1595 ndev->ethtool_ops = &ave_ethtool_ops;
1596 SET_NETDEV_DEV(ndev, dev);
1597
1598 ndev->features |= (NETIF_F_IP_CSUM | NETIF_F_RXCSUM);
1599 ndev->hw_features |= (NETIF_F_IP_CSUM | NETIF_F_RXCSUM);
1600
1601 ndev->max_mtu = AVE_MAX_ETHFRAME - (ETH_HLEN + ETH_FCS_LEN);
1602
1603 mac_addr = of_get_mac_address(np);
1604 if (!IS_ERR(mac_addr))
1605 ether_addr_copy(ndev->dev_addr, mac_addr);
1606
1607
1608 if (!is_valid_ether_addr(ndev->dev_addr)) {
1609 eth_hw_addr_random(ndev);
1610 dev_warn(dev, "Using random MAC address: %pM\n",
1611 ndev->dev_addr);
1612 }
1613
1614 priv = netdev_priv(ndev);
1615 priv->base = base;
1616 priv->irq = irq;
1617 priv->ndev = ndev;
1618 priv->msg_enable = netif_msg_init(-1, AVE_DEFAULT_MSG_ENABLE);
1619 priv->phy_mode = phy_mode;
1620 priv->data = data;
1621
1622 if (IS_DESC_64BIT(priv)) {
1623 priv->desc_size = AVE_DESC_SIZE_64;
1624 priv->tx.daddr = AVE_TXDM_64;
1625 priv->rx.daddr = AVE_RXDM_64;
1626 dma_mask = DMA_BIT_MASK(64);
1627 } else {
1628 priv->desc_size = AVE_DESC_SIZE_32;
1629 priv->tx.daddr = AVE_TXDM_32;
1630 priv->rx.daddr = AVE_RXDM_32;
1631 dma_mask = DMA_BIT_MASK(32);
1632 }
1633 ret = dma_set_mask(dev, dma_mask);
1634 if (ret)
1635 goto out_free_netdev;
1636
1637 priv->tx.ndesc = AVE_NR_TXDESC;
1638 priv->rx.ndesc = AVE_NR_RXDESC;
1639
1640 u64_stats_init(&priv->stats_tx.syncp);
1641 u64_stats_init(&priv->stats_rx.syncp);
1642
1643 for (i = 0; i < AVE_MAX_CLKS; i++) {
1644 name = priv->data->clock_names[i];
1645 if (!name)
1646 break;
1647 priv->clk[i] = devm_clk_get(dev, name);
1648 if (IS_ERR(priv->clk[i])) {
1649 ret = PTR_ERR(priv->clk[i]);
1650 goto out_free_netdev;
1651 }
1652 priv->nclks++;
1653 }
1654
1655 for (i = 0; i < AVE_MAX_RSTS; i++) {
1656 name = priv->data->reset_names[i];
1657 if (!name)
1658 break;
1659 priv->rst[i] = devm_reset_control_get_shared(dev, name);
1660 if (IS_ERR(priv->rst[i])) {
1661 ret = PTR_ERR(priv->rst[i]);
1662 goto out_free_netdev;
1663 }
1664 priv->nrsts++;
1665 }
1666
1667 ret = of_parse_phandle_with_fixed_args(np,
1668 "socionext,syscon-phy-mode",
1669 1, 0, &args);
1670 if (ret) {
1671 dev_err(dev, "can't get syscon-phy-mode property\n");
1672 goto out_free_netdev;
1673 }
1674 priv->regmap = syscon_node_to_regmap(args.np);
1675 of_node_put(args.np);
1676 if (IS_ERR(priv->regmap)) {
1677 dev_err(dev, "can't map syscon-phy-mode\n");
1678 ret = PTR_ERR(priv->regmap);
1679 goto out_free_netdev;
1680 }
1681 ret = priv->data->get_pinmode(priv, phy_mode, args.args[0]);
1682 if (ret) {
1683 dev_err(dev, "invalid phy-mode setting\n");
1684 goto out_free_netdev;
1685 }
1686
1687 priv->mdio = devm_mdiobus_alloc(dev);
1688 if (!priv->mdio) {
1689 ret = -ENOMEM;
1690 goto out_free_netdev;
1691 }
1692 priv->mdio->priv = ndev;
1693 priv->mdio->parent = dev;
1694 priv->mdio->read = ave_mdiobus_read;
1695 priv->mdio->write = ave_mdiobus_write;
1696 priv->mdio->name = "uniphier-mdio";
1697 snprintf(priv->mdio->id, MII_BUS_ID_SIZE, "%s-%x",
1698 pdev->name, pdev->id);
1699
1700
1701 netif_napi_add(ndev, &priv->napi_rx, ave_napi_poll_rx,
1702 NAPI_POLL_WEIGHT);
1703 netif_tx_napi_add(ndev, &priv->napi_tx, ave_napi_poll_tx,
1704 NAPI_POLL_WEIGHT);
1705
1706 platform_set_drvdata(pdev, ndev);
1707
1708 ret = register_netdev(ndev);
1709 if (ret) {
1710 dev_err(dev, "failed to register netdevice\n");
1711 goto out_del_napi;
1712 }
1713
1714
1715 ave_id = readl(priv->base + AVE_IDR);
1716 ave_hw_read_version(ndev, buf, sizeof(buf));
1717
1718 dev_info(dev, "Socionext %c%c%c%c Ethernet IP %s (irq=%d, phy=%s)\n",
1719 (ave_id >> 24) & 0xff, (ave_id >> 16) & 0xff,
1720 (ave_id >> 8) & 0xff, (ave_id >> 0) & 0xff,
1721 buf, priv->irq, phy_modes(phy_mode));
1722
1723 return 0;
1724
1725 out_del_napi:
1726 netif_napi_del(&priv->napi_rx);
1727 netif_napi_del(&priv->napi_tx);
1728 out_free_netdev:
1729 free_netdev(ndev);
1730
1731 return ret;
1732 }
1733
1734 static int ave_remove(struct platform_device *pdev)
1735 {
1736 struct net_device *ndev = platform_get_drvdata(pdev);
1737 struct ave_private *priv = netdev_priv(ndev);
1738
1739 unregister_netdev(ndev);
1740 netif_napi_del(&priv->napi_rx);
1741 netif_napi_del(&priv->napi_tx);
1742 free_netdev(ndev);
1743
1744 return 0;
1745 }
1746
1747 #ifdef CONFIG_PM_SLEEP
1748 static int ave_suspend(struct device *dev)
1749 {
1750 struct ethtool_wolinfo wol = { .cmd = ETHTOOL_GWOL };
1751 struct net_device *ndev = dev_get_drvdata(dev);
1752 struct ave_private *priv = netdev_priv(ndev);
1753 int ret = 0;
1754
1755 if (netif_running(ndev)) {
1756 ret = ave_stop(ndev);
1757 netif_device_detach(ndev);
1758 }
1759
1760 ave_ethtool_get_wol(ndev, &wol);
1761 priv->wolopts = wol.wolopts;
1762
1763 return ret;
1764 }
1765
1766 static int ave_resume(struct device *dev)
1767 {
1768 struct ethtool_wolinfo wol = { .cmd = ETHTOOL_GWOL };
1769 struct net_device *ndev = dev_get_drvdata(dev);
1770 struct ave_private *priv = netdev_priv(ndev);
1771 int ret = 0;
1772
1773 ave_global_reset(ndev);
1774
1775 ave_ethtool_get_wol(ndev, &wol);
1776 wol.wolopts = priv->wolopts;
1777 __ave_ethtool_set_wol(ndev, &wol);
1778
1779 if (ndev->phydev) {
1780 ret = phy_resume(ndev->phydev);
1781 if (ret)
1782 return ret;
1783 }
1784
1785 if (netif_running(ndev)) {
1786 ret = ave_open(ndev);
1787 netif_device_attach(ndev);
1788 }
1789
1790 return ret;
1791 }
1792
1793 static SIMPLE_DEV_PM_OPS(ave_pm_ops, ave_suspend, ave_resume);
1794 #define AVE_PM_OPS (&ave_pm_ops)
1795 #else
1796 #define AVE_PM_OPS NULL
1797 #endif
1798
1799 static int ave_pro4_get_pinmode(struct ave_private *priv,
1800 phy_interface_t phy_mode, u32 arg)
1801 {
1802 if (arg > 0)
1803 return -EINVAL;
1804
1805 priv->pinmode_mask = SG_ETPINMODE_RMII(0);
1806
1807 switch (phy_mode) {
1808 case PHY_INTERFACE_MODE_RMII:
1809 priv->pinmode_val = SG_ETPINMODE_RMII(0);
1810 break;
1811 case PHY_INTERFACE_MODE_MII:
1812 case PHY_INTERFACE_MODE_RGMII:
1813 priv->pinmode_val = 0;
1814 break;
1815 default:
1816 return -EINVAL;
1817 }
1818
1819 return 0;
1820 }
1821
1822 static int ave_ld11_get_pinmode(struct ave_private *priv,
1823 phy_interface_t phy_mode, u32 arg)
1824 {
1825 if (arg > 0)
1826 return -EINVAL;
1827
1828 priv->pinmode_mask = SG_ETPINMODE_EXTPHY | SG_ETPINMODE_RMII(0);
1829
1830 switch (phy_mode) {
1831 case PHY_INTERFACE_MODE_INTERNAL:
1832 priv->pinmode_val = 0;
1833 break;
1834 case PHY_INTERFACE_MODE_RMII:
1835 priv->pinmode_val = SG_ETPINMODE_EXTPHY | SG_ETPINMODE_RMII(0);
1836 break;
1837 default:
1838 return -EINVAL;
1839 }
1840
1841 return 0;
1842 }
1843
1844 static int ave_ld20_get_pinmode(struct ave_private *priv,
1845 phy_interface_t phy_mode, u32 arg)
1846 {
1847 if (arg > 0)
1848 return -EINVAL;
1849
1850 priv->pinmode_mask = SG_ETPINMODE_RMII(0);
1851
1852 switch (phy_mode) {
1853 case PHY_INTERFACE_MODE_RMII:
1854 priv->pinmode_val = SG_ETPINMODE_RMII(0);
1855 break;
1856 case PHY_INTERFACE_MODE_RGMII:
1857 priv->pinmode_val = 0;
1858 break;
1859 default:
1860 return -EINVAL;
1861 }
1862
1863 return 0;
1864 }
1865
1866 static int ave_pxs3_get_pinmode(struct ave_private *priv,
1867 phy_interface_t phy_mode, u32 arg)
1868 {
1869 if (arg > 1)
1870 return -EINVAL;
1871
1872 priv->pinmode_mask = SG_ETPINMODE_RMII(arg);
1873
1874 switch (phy_mode) {
1875 case PHY_INTERFACE_MODE_RMII:
1876 priv->pinmode_val = SG_ETPINMODE_RMII(arg);
1877 break;
1878 case PHY_INTERFACE_MODE_RGMII:
1879 priv->pinmode_val = 0;
1880 break;
1881 default:
1882 return -EINVAL;
1883 }
1884
1885 return 0;
1886 }
1887
1888 static const struct ave_soc_data ave_pro4_data = {
1889 .is_desc_64bit = false,
1890 .clock_names = {
1891 "gio", "ether", "ether-gb", "ether-phy",
1892 },
1893 .reset_names = {
1894 "gio", "ether",
1895 },
1896 .get_pinmode = ave_pro4_get_pinmode,
1897 };
1898
1899 static const struct ave_soc_data ave_pxs2_data = {
1900 .is_desc_64bit = false,
1901 .clock_names = {
1902 "ether",
1903 },
1904 .reset_names = {
1905 "ether",
1906 },
1907 .get_pinmode = ave_pro4_get_pinmode,
1908 };
1909
1910 static const struct ave_soc_data ave_ld11_data = {
1911 .is_desc_64bit = false,
1912 .clock_names = {
1913 "ether",
1914 },
1915 .reset_names = {
1916 "ether",
1917 },
1918 .get_pinmode = ave_ld11_get_pinmode,
1919 };
1920
1921 static const struct ave_soc_data ave_ld20_data = {
1922 .is_desc_64bit = true,
1923 .clock_names = {
1924 "ether",
1925 },
1926 .reset_names = {
1927 "ether",
1928 },
1929 .get_pinmode = ave_ld20_get_pinmode,
1930 };
1931
1932 static const struct ave_soc_data ave_pxs3_data = {
1933 .is_desc_64bit = false,
1934 .clock_names = {
1935 "ether",
1936 },
1937 .reset_names = {
1938 "ether",
1939 },
1940 .get_pinmode = ave_pxs3_get_pinmode,
1941 };
1942
1943 static const struct of_device_id of_ave_match[] = {
1944 {
1945 .compatible = "socionext,uniphier-pro4-ave4",
1946 .data = &ave_pro4_data,
1947 },
1948 {
1949 .compatible = "socionext,uniphier-pxs2-ave4",
1950 .data = &ave_pxs2_data,
1951 },
1952 {
1953 .compatible = "socionext,uniphier-ld11-ave4",
1954 .data = &ave_ld11_data,
1955 },
1956 {
1957 .compatible = "socionext,uniphier-ld20-ave4",
1958 .data = &ave_ld20_data,
1959 },
1960 {
1961 .compatible = "socionext,uniphier-pxs3-ave4",
1962 .data = &ave_pxs3_data,
1963 },
1964 { }
1965 };
1966 MODULE_DEVICE_TABLE(of, of_ave_match);
1967
1968 static struct platform_driver ave_driver = {
1969 .probe = ave_probe,
1970 .remove = ave_remove,
1971 .driver = {
1972 .name = "ave",
1973 .pm = AVE_PM_OPS,
1974 .of_match_table = of_ave_match,
1975 },
1976 };
1977 module_platform_driver(ave_driver);
1978
1979 MODULE_AUTHOR("Kunihiko Hayashi <hayashi.kunihiko@socionext.com>");
1980 MODULE_DESCRIPTION("Socionext UniPhier AVE ethernet driver");
1981 MODULE_LICENSE("GPL v2");