blob: 40622567159a7c1585cf8ad8f3ed9ad569b07e73 [file] [log] [blame]
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001/*
2 * Faraday FTGMAC100 Gigabit Ethernet
3 *
4 * (C) Copyright 2009-2011 Faraday Technology
5 * Po-Yu Chuang <ratbert@faraday-tech.com>
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
11 *
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
20 */
21
22#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
23
24#include <linux/dma-mapping.h>
25#include <linux/etherdevice.h>
26#include <linux/ethtool.h>
Thomas Faber17f1bbc2012-01-18 13:45:44 +000027#include <linux/interrupt.h>
Po-Yu Chuang69785b72011-06-08 23:32:48 +000028#include <linux/io.h>
29#include <linux/module.h>
30#include <linux/netdevice.h>
31#include <linux/phy.h>
32#include <linux/platform_device.h>
33#include <net/ip.h>
Gavin Shanbd466c32016-07-19 11:54:23 +100034#include <net/ncsi.h>
Po-Yu Chuang69785b72011-06-08 23:32:48 +000035
36#include "ftgmac100.h"
37
38#define DRV_NAME "ftgmac100"
39#define DRV_VERSION "0.7"
40
41#define RX_QUEUE_ENTRIES 256 /* must be power of 2 */
42#define TX_QUEUE_ENTRIES 512 /* must be power of 2 */
43
44#define MAX_PKT_SIZE 1518
45#define RX_BUF_SIZE PAGE_SIZE /* must be smaller than 0x3fff */
46
47/******************************************************************************
48 * private data
49 *****************************************************************************/
50struct ftgmac100_descs {
51 struct ftgmac100_rxdes rxdes[RX_QUEUE_ENTRIES];
52 struct ftgmac100_txdes txdes[TX_QUEUE_ENTRIES];
53};
54
55struct ftgmac100 {
56 struct resource *res;
57 void __iomem *base;
58 int irq;
59
60 struct ftgmac100_descs *descs;
61 dma_addr_t descs_dma_addr;
62
Andrew Jefferyada66b52016-09-22 08:34:58 +093063 struct page *rx_pages[RX_QUEUE_ENTRIES];
64
Po-Yu Chuang69785b72011-06-08 23:32:48 +000065 unsigned int rx_pointer;
66 unsigned int tx_clean_pointer;
67 unsigned int tx_pointer;
68 unsigned int tx_pending;
69
70 spinlock_t tx_lock;
71
72 struct net_device *netdev;
73 struct device *dev;
Gavin Shanbd466c32016-07-19 11:54:23 +100074 struct ncsi_dev *ndev;
Po-Yu Chuang69785b72011-06-08 23:32:48 +000075 struct napi_struct napi;
76
77 struct mii_bus *mii_bus;
Po-Yu Chuang69785b72011-06-08 23:32:48 +000078 int old_speed;
Gavin Shanfc6061c2016-07-19 11:54:25 +100079 int int_mask_all;
Gavin Shanbd466c32016-07-19 11:54:23 +100080 bool use_ncsi;
81 bool enabled;
Po-Yu Chuang69785b72011-06-08 23:32:48 +000082};
83
84static int ftgmac100_alloc_rx_page(struct ftgmac100 *priv,
85 struct ftgmac100_rxdes *rxdes, gfp_t gfp);
86
87/******************************************************************************
88 * internal functions (hardware register access)
89 *****************************************************************************/
Po-Yu Chuang69785b72011-06-08 23:32:48 +000090static void ftgmac100_set_rx_ring_base(struct ftgmac100 *priv, dma_addr_t addr)
91{
92 iowrite32(addr, priv->base + FTGMAC100_OFFSET_RXR_BADR);
93}
94
95static void ftgmac100_set_rx_buffer_size(struct ftgmac100 *priv,
96 unsigned int size)
97{
98 size = FTGMAC100_RBSR_SIZE(size);
99 iowrite32(size, priv->base + FTGMAC100_OFFSET_RBSR);
100}
101
102static void ftgmac100_set_normal_prio_tx_ring_base(struct ftgmac100 *priv,
103 dma_addr_t addr)
104{
105 iowrite32(addr, priv->base + FTGMAC100_OFFSET_NPTXR_BADR);
106}
107
108static void ftgmac100_txdma_normal_prio_start_polling(struct ftgmac100 *priv)
109{
110 iowrite32(1, priv->base + FTGMAC100_OFFSET_NPTXPD);
111}
112
113static int ftgmac100_reset_hw(struct ftgmac100 *priv)
114{
115 struct net_device *netdev = priv->netdev;
116 int i;
117
118 /* NOTE: reset clears all registers */
119 iowrite32(FTGMAC100_MACCR_SW_RST, priv->base + FTGMAC100_OFFSET_MACCR);
120 for (i = 0; i < 5; i++) {
121 unsigned int maccr;
122
123 maccr = ioread32(priv->base + FTGMAC100_OFFSET_MACCR);
124 if (!(maccr & FTGMAC100_MACCR_SW_RST))
125 return 0;
126
127 udelay(1000);
128 }
129
130 netdev_err(netdev, "software reset failed\n");
131 return -EIO;
132}
133
134static void ftgmac100_set_mac(struct ftgmac100 *priv, const unsigned char *mac)
135{
136 unsigned int maddr = mac[0] << 8 | mac[1];
137 unsigned int laddr = mac[2] << 24 | mac[3] << 16 | mac[4] << 8 | mac[5];
138
139 iowrite32(maddr, priv->base + FTGMAC100_OFFSET_MAC_MADR);
140 iowrite32(laddr, priv->base + FTGMAC100_OFFSET_MAC_LADR);
141}
142
Gavin Shan113ce102016-07-19 11:54:22 +1000143static void ftgmac100_setup_mac(struct ftgmac100 *priv)
144{
145 u8 mac[ETH_ALEN];
146 unsigned int m;
147 unsigned int l;
148 void *addr;
149
150 addr = device_get_mac_address(priv->dev, mac, ETH_ALEN);
151 if (addr) {
152 ether_addr_copy(priv->netdev->dev_addr, mac);
153 dev_info(priv->dev, "Read MAC address %pM from device tree\n",
154 mac);
155 return;
156 }
157
158 m = ioread32(priv->base + FTGMAC100_OFFSET_MAC_MADR);
159 l = ioread32(priv->base + FTGMAC100_OFFSET_MAC_LADR);
160
161 mac[0] = (m >> 8) & 0xff;
162 mac[1] = m & 0xff;
163 mac[2] = (l >> 24) & 0xff;
164 mac[3] = (l >> 16) & 0xff;
165 mac[4] = (l >> 8) & 0xff;
166 mac[5] = l & 0xff;
167
Gavin Shan113ce102016-07-19 11:54:22 +1000168 if (is_valid_ether_addr(mac)) {
169 ether_addr_copy(priv->netdev->dev_addr, mac);
170 dev_info(priv->dev, "Read MAC address %pM from chip\n", mac);
171 } else {
172 eth_hw_addr_random(priv->netdev);
173 dev_info(priv->dev, "Generated random MAC address %pM\n",
174 priv->netdev->dev_addr);
175 }
176}
177
178static int ftgmac100_set_mac_addr(struct net_device *dev, void *p)
179{
180 int ret;
181
182 ret = eth_prepare_mac_addr_change(dev, p);
183 if (ret < 0)
184 return ret;
185
186 eth_commit_mac_addr_change(dev, p);
187 ftgmac100_set_mac(netdev_priv(dev), dev->dev_addr);
188
189 return 0;
190}
191
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000192static void ftgmac100_init_hw(struct ftgmac100 *priv)
193{
194 /* setup ring buffer base registers */
195 ftgmac100_set_rx_ring_base(priv,
196 priv->descs_dma_addr +
197 offsetof(struct ftgmac100_descs, rxdes));
198 ftgmac100_set_normal_prio_tx_ring_base(priv,
199 priv->descs_dma_addr +
200 offsetof(struct ftgmac100_descs, txdes));
201
202 ftgmac100_set_rx_buffer_size(priv, RX_BUF_SIZE);
203
204 iowrite32(FTGMAC100_APTC_RXPOLL_CNT(1), priv->base + FTGMAC100_OFFSET_APTC);
205
206 ftgmac100_set_mac(priv, priv->netdev->dev_addr);
207}
208
209#define MACCR_ENABLE_ALL (FTGMAC100_MACCR_TXDMA_EN | \
210 FTGMAC100_MACCR_RXDMA_EN | \
211 FTGMAC100_MACCR_TXMAC_EN | \
212 FTGMAC100_MACCR_RXMAC_EN | \
213 FTGMAC100_MACCR_FULLDUP | \
214 FTGMAC100_MACCR_CRC_APD | \
215 FTGMAC100_MACCR_RX_RUNT | \
216 FTGMAC100_MACCR_RX_BROADPKT)
217
218static void ftgmac100_start_hw(struct ftgmac100 *priv, int speed)
219{
220 int maccr = MACCR_ENABLE_ALL;
221
222 switch (speed) {
223 default:
224 case 10:
225 break;
226
227 case 100:
228 maccr |= FTGMAC100_MACCR_FAST_MODE;
229 break;
230
231 case 1000:
232 maccr |= FTGMAC100_MACCR_GIGA_MODE;
233 break;
234 }
235
236 iowrite32(maccr, priv->base + FTGMAC100_OFFSET_MACCR);
237}
238
239static void ftgmac100_stop_hw(struct ftgmac100 *priv)
240{
241 iowrite32(0, priv->base + FTGMAC100_OFFSET_MACCR);
242}
243
244/******************************************************************************
245 * internal functions (receive descriptor)
246 *****************************************************************************/
247static bool ftgmac100_rxdes_first_segment(struct ftgmac100_rxdes *rxdes)
248{
249 return rxdes->rxdes0 & cpu_to_le32(FTGMAC100_RXDES0_FRS);
250}
251
252static bool ftgmac100_rxdes_last_segment(struct ftgmac100_rxdes *rxdes)
253{
254 return rxdes->rxdes0 & cpu_to_le32(FTGMAC100_RXDES0_LRS);
255}
256
257static bool ftgmac100_rxdes_packet_ready(struct ftgmac100_rxdes *rxdes)
258{
259 return rxdes->rxdes0 & cpu_to_le32(FTGMAC100_RXDES0_RXPKT_RDY);
260}
261
262static void ftgmac100_rxdes_set_dma_own(struct ftgmac100_rxdes *rxdes)
263{
264 /* clear status bits */
265 rxdes->rxdes0 &= cpu_to_le32(FTGMAC100_RXDES0_EDORR);
266}
267
268static bool ftgmac100_rxdes_rx_error(struct ftgmac100_rxdes *rxdes)
269{
270 return rxdes->rxdes0 & cpu_to_le32(FTGMAC100_RXDES0_RX_ERR);
271}
272
273static bool ftgmac100_rxdes_crc_error(struct ftgmac100_rxdes *rxdes)
274{
275 return rxdes->rxdes0 & cpu_to_le32(FTGMAC100_RXDES0_CRC_ERR);
276}
277
278static bool ftgmac100_rxdes_frame_too_long(struct ftgmac100_rxdes *rxdes)
279{
280 return rxdes->rxdes0 & cpu_to_le32(FTGMAC100_RXDES0_FTL);
281}
282
283static bool ftgmac100_rxdes_runt(struct ftgmac100_rxdes *rxdes)
284{
285 return rxdes->rxdes0 & cpu_to_le32(FTGMAC100_RXDES0_RUNT);
286}
287
288static bool ftgmac100_rxdes_odd_nibble(struct ftgmac100_rxdes *rxdes)
289{
290 return rxdes->rxdes0 & cpu_to_le32(FTGMAC100_RXDES0_RX_ODD_NB);
291}
292
293static unsigned int ftgmac100_rxdes_data_length(struct ftgmac100_rxdes *rxdes)
294{
295 return le32_to_cpu(rxdes->rxdes0) & FTGMAC100_RXDES0_VDBC;
296}
297
298static bool ftgmac100_rxdes_multicast(struct ftgmac100_rxdes *rxdes)
299{
300 return rxdes->rxdes0 & cpu_to_le32(FTGMAC100_RXDES0_MULTICAST);
301}
302
303static void ftgmac100_rxdes_set_end_of_ring(struct ftgmac100_rxdes *rxdes)
304{
305 rxdes->rxdes0 |= cpu_to_le32(FTGMAC100_RXDES0_EDORR);
306}
307
308static void ftgmac100_rxdes_set_dma_addr(struct ftgmac100_rxdes *rxdes,
309 dma_addr_t addr)
310{
311 rxdes->rxdes3 = cpu_to_le32(addr);
312}
313
314static dma_addr_t ftgmac100_rxdes_get_dma_addr(struct ftgmac100_rxdes *rxdes)
315{
316 return le32_to_cpu(rxdes->rxdes3);
317}
318
319static bool ftgmac100_rxdes_is_tcp(struct ftgmac100_rxdes *rxdes)
320{
321 return (rxdes->rxdes1 & cpu_to_le32(FTGMAC100_RXDES1_PROT_MASK)) ==
322 cpu_to_le32(FTGMAC100_RXDES1_PROT_TCPIP);
323}
324
325static bool ftgmac100_rxdes_is_udp(struct ftgmac100_rxdes *rxdes)
326{
327 return (rxdes->rxdes1 & cpu_to_le32(FTGMAC100_RXDES1_PROT_MASK)) ==
328 cpu_to_le32(FTGMAC100_RXDES1_PROT_UDPIP);
329}
330
331static bool ftgmac100_rxdes_tcpcs_err(struct ftgmac100_rxdes *rxdes)
332{
333 return rxdes->rxdes1 & cpu_to_le32(FTGMAC100_RXDES1_TCP_CHKSUM_ERR);
334}
335
336static bool ftgmac100_rxdes_udpcs_err(struct ftgmac100_rxdes *rxdes)
337{
338 return rxdes->rxdes1 & cpu_to_le32(FTGMAC100_RXDES1_UDP_CHKSUM_ERR);
339}
340
341static bool ftgmac100_rxdes_ipcs_err(struct ftgmac100_rxdes *rxdes)
342{
343 return rxdes->rxdes1 & cpu_to_le32(FTGMAC100_RXDES1_IP_CHKSUM_ERR);
344}
345
Andrew Jefferyada66b52016-09-22 08:34:58 +0930346static inline struct page **ftgmac100_rxdes_page_slot(struct ftgmac100 *priv,
347 struct ftgmac100_rxdes *rxdes)
348{
349 return &priv->rx_pages[rxdes - priv->descs->rxdes];
350}
351
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000352/*
353 * rxdes2 is not used by hardware. We use it to keep track of page.
354 * Since hardware does not touch it, we can skip cpu_to_le32()/le32_to_cpu().
355 */
Andrew Jefferyada66b52016-09-22 08:34:58 +0930356static void ftgmac100_rxdes_set_page(struct ftgmac100 *priv,
357 struct ftgmac100_rxdes *rxdes,
358 struct page *page)
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000359{
Andrew Jefferyada66b52016-09-22 08:34:58 +0930360 *ftgmac100_rxdes_page_slot(priv, rxdes) = page;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000361}
362
Andrew Jefferyada66b52016-09-22 08:34:58 +0930363static struct page *ftgmac100_rxdes_get_page(struct ftgmac100 *priv,
364 struct ftgmac100_rxdes *rxdes)
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000365{
Andrew Jefferyada66b52016-09-22 08:34:58 +0930366 return *ftgmac100_rxdes_page_slot(priv, rxdes);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000367}
368
369/******************************************************************************
370 * internal functions (receive)
371 *****************************************************************************/
372static int ftgmac100_next_rx_pointer(int pointer)
373{
374 return (pointer + 1) & (RX_QUEUE_ENTRIES - 1);
375}
376
377static void ftgmac100_rx_pointer_advance(struct ftgmac100 *priv)
378{
379 priv->rx_pointer = ftgmac100_next_rx_pointer(priv->rx_pointer);
380}
381
382static struct ftgmac100_rxdes *ftgmac100_current_rxdes(struct ftgmac100 *priv)
383{
384 return &priv->descs->rxdes[priv->rx_pointer];
385}
386
387static struct ftgmac100_rxdes *
388ftgmac100_rx_locate_first_segment(struct ftgmac100 *priv)
389{
390 struct ftgmac100_rxdes *rxdes = ftgmac100_current_rxdes(priv);
391
392 while (ftgmac100_rxdes_packet_ready(rxdes)) {
393 if (ftgmac100_rxdes_first_segment(rxdes))
394 return rxdes;
395
396 ftgmac100_rxdes_set_dma_own(rxdes);
397 ftgmac100_rx_pointer_advance(priv);
398 rxdes = ftgmac100_current_rxdes(priv);
399 }
400
401 return NULL;
402}
403
404static bool ftgmac100_rx_packet_error(struct ftgmac100 *priv,
405 struct ftgmac100_rxdes *rxdes)
406{
407 struct net_device *netdev = priv->netdev;
408 bool error = false;
409
410 if (unlikely(ftgmac100_rxdes_rx_error(rxdes))) {
411 if (net_ratelimit())
412 netdev_info(netdev, "rx err\n");
413
414 netdev->stats.rx_errors++;
415 error = true;
416 }
417
418 if (unlikely(ftgmac100_rxdes_crc_error(rxdes))) {
419 if (net_ratelimit())
420 netdev_info(netdev, "rx crc err\n");
421
422 netdev->stats.rx_crc_errors++;
423 error = true;
424 } else if (unlikely(ftgmac100_rxdes_ipcs_err(rxdes))) {
425 if (net_ratelimit())
426 netdev_info(netdev, "rx IP checksum err\n");
427
428 error = true;
429 }
430
431 if (unlikely(ftgmac100_rxdes_frame_too_long(rxdes))) {
432 if (net_ratelimit())
433 netdev_info(netdev, "rx frame too long\n");
434
435 netdev->stats.rx_length_errors++;
436 error = true;
437 } else if (unlikely(ftgmac100_rxdes_runt(rxdes))) {
438 if (net_ratelimit())
439 netdev_info(netdev, "rx runt\n");
440
441 netdev->stats.rx_length_errors++;
442 error = true;
443 } else if (unlikely(ftgmac100_rxdes_odd_nibble(rxdes))) {
444 if (net_ratelimit())
445 netdev_info(netdev, "rx odd nibble\n");
446
447 netdev->stats.rx_length_errors++;
448 error = true;
449 }
450
451 return error;
452}
453
454static void ftgmac100_rx_drop_packet(struct ftgmac100 *priv)
455{
456 struct net_device *netdev = priv->netdev;
457 struct ftgmac100_rxdes *rxdes = ftgmac100_current_rxdes(priv);
458 bool done = false;
459
460 if (net_ratelimit())
461 netdev_dbg(netdev, "drop packet %p\n", rxdes);
462
463 do {
464 if (ftgmac100_rxdes_last_segment(rxdes))
465 done = true;
466
467 ftgmac100_rxdes_set_dma_own(rxdes);
468 ftgmac100_rx_pointer_advance(priv);
469 rxdes = ftgmac100_current_rxdes(priv);
470 } while (!done && ftgmac100_rxdes_packet_ready(rxdes));
471
472 netdev->stats.rx_dropped++;
473}
474
475static bool ftgmac100_rx_packet(struct ftgmac100 *priv, int *processed)
476{
477 struct net_device *netdev = priv->netdev;
478 struct ftgmac100_rxdes *rxdes;
479 struct sk_buff *skb;
480 bool done = false;
481
482 rxdes = ftgmac100_rx_locate_first_segment(priv);
483 if (!rxdes)
484 return false;
485
486 if (unlikely(ftgmac100_rx_packet_error(priv, rxdes))) {
487 ftgmac100_rx_drop_packet(priv);
488 return true;
489 }
490
491 /* start processing */
492 skb = netdev_alloc_skb_ip_align(netdev, 128);
493 if (unlikely(!skb)) {
494 if (net_ratelimit())
495 netdev_err(netdev, "rx skb alloc failed\n");
496
497 ftgmac100_rx_drop_packet(priv);
498 return true;
499 }
500
501 if (unlikely(ftgmac100_rxdes_multicast(rxdes)))
502 netdev->stats.multicast++;
503
504 /*
505 * It seems that HW does checksum incorrectly with fragmented packets,
506 * so we are conservative here - if HW checksum error, let software do
507 * the checksum again.
508 */
509 if ((ftgmac100_rxdes_is_tcp(rxdes) && !ftgmac100_rxdes_tcpcs_err(rxdes)) ||
510 (ftgmac100_rxdes_is_udp(rxdes) && !ftgmac100_rxdes_udpcs_err(rxdes)))
511 skb->ip_summed = CHECKSUM_UNNECESSARY;
512
513 do {
514 dma_addr_t map = ftgmac100_rxdes_get_dma_addr(rxdes);
Andrew Jefferyada66b52016-09-22 08:34:58 +0930515 struct page *page = ftgmac100_rxdes_get_page(priv, rxdes);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000516 unsigned int size;
517
518 dma_unmap_page(priv->dev, map, RX_BUF_SIZE, DMA_FROM_DEVICE);
519
520 size = ftgmac100_rxdes_data_length(rxdes);
521 skb_fill_page_desc(skb, skb_shinfo(skb)->nr_frags, page, 0, size);
522
523 skb->len += size;
524 skb->data_len += size;
Eric Dumazet5935f812011-10-13 11:30:52 +0000525 skb->truesize += PAGE_SIZE;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000526
527 if (ftgmac100_rxdes_last_segment(rxdes))
528 done = true;
529
530 ftgmac100_alloc_rx_page(priv, rxdes, GFP_ATOMIC);
531
532 ftgmac100_rx_pointer_advance(priv);
533 rxdes = ftgmac100_current_rxdes(priv);
534 } while (!done);
535
Eric Dumazet6ecd09d2012-07-12 04:19:38 +0000536 /* Small frames are copied into linear part of skb to free one page */
537 if (skb->len <= 128) {
Eric Dumazet5935f812011-10-13 11:30:52 +0000538 skb->truesize -= PAGE_SIZE;
Eric Dumazet6ecd09d2012-07-12 04:19:38 +0000539 __pskb_pull_tail(skb, skb->len);
540 } else {
541 /* We pull the minimum amount into linear part */
542 __pskb_pull_tail(skb, ETH_HLEN);
543 }
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000544 skb->protocol = eth_type_trans(skb, netdev);
545
546 netdev->stats.rx_packets++;
547 netdev->stats.rx_bytes += skb->len;
548
549 /* push packet to protocol stack */
550 napi_gro_receive(&priv->napi, skb);
551
552 (*processed)++;
553 return true;
554}
555
556/******************************************************************************
557 * internal functions (transmit descriptor)
558 *****************************************************************************/
559static void ftgmac100_txdes_reset(struct ftgmac100_txdes *txdes)
560{
561 /* clear all except end of ring bit */
562 txdes->txdes0 &= cpu_to_le32(FTGMAC100_TXDES0_EDOTR);
563 txdes->txdes1 = 0;
564 txdes->txdes2 = 0;
565 txdes->txdes3 = 0;
566}
567
568static bool ftgmac100_txdes_owned_by_dma(struct ftgmac100_txdes *txdes)
569{
570 return txdes->txdes0 & cpu_to_le32(FTGMAC100_TXDES0_TXDMA_OWN);
571}
572
573static void ftgmac100_txdes_set_dma_own(struct ftgmac100_txdes *txdes)
574{
575 /*
576 * Make sure dma own bit will not be set before any other
577 * descriptor fields.
578 */
579 wmb();
580 txdes->txdes0 |= cpu_to_le32(FTGMAC100_TXDES0_TXDMA_OWN);
581}
582
583static void ftgmac100_txdes_set_end_of_ring(struct ftgmac100_txdes *txdes)
584{
585 txdes->txdes0 |= cpu_to_le32(FTGMAC100_TXDES0_EDOTR);
586}
587
588static void ftgmac100_txdes_set_first_segment(struct ftgmac100_txdes *txdes)
589{
590 txdes->txdes0 |= cpu_to_le32(FTGMAC100_TXDES0_FTS);
591}
592
593static void ftgmac100_txdes_set_last_segment(struct ftgmac100_txdes *txdes)
594{
595 txdes->txdes0 |= cpu_to_le32(FTGMAC100_TXDES0_LTS);
596}
597
598static void ftgmac100_txdes_set_buffer_size(struct ftgmac100_txdes *txdes,
599 unsigned int len)
600{
601 txdes->txdes0 |= cpu_to_le32(FTGMAC100_TXDES0_TXBUF_SIZE(len));
602}
603
604static void ftgmac100_txdes_set_txint(struct ftgmac100_txdes *txdes)
605{
606 txdes->txdes1 |= cpu_to_le32(FTGMAC100_TXDES1_TXIC);
607}
608
609static void ftgmac100_txdes_set_tcpcs(struct ftgmac100_txdes *txdes)
610{
611 txdes->txdes1 |= cpu_to_le32(FTGMAC100_TXDES1_TCP_CHKSUM);
612}
613
614static void ftgmac100_txdes_set_udpcs(struct ftgmac100_txdes *txdes)
615{
616 txdes->txdes1 |= cpu_to_le32(FTGMAC100_TXDES1_UDP_CHKSUM);
617}
618
619static void ftgmac100_txdes_set_ipcs(struct ftgmac100_txdes *txdes)
620{
621 txdes->txdes1 |= cpu_to_le32(FTGMAC100_TXDES1_IP_CHKSUM);
622}
623
624static void ftgmac100_txdes_set_dma_addr(struct ftgmac100_txdes *txdes,
625 dma_addr_t addr)
626{
627 txdes->txdes3 = cpu_to_le32(addr);
628}
629
630static dma_addr_t ftgmac100_txdes_get_dma_addr(struct ftgmac100_txdes *txdes)
631{
632 return le32_to_cpu(txdes->txdes3);
633}
634
635/*
636 * txdes2 is not used by hardware. We use it to keep track of socket buffer.
637 * Since hardware does not touch it, we can skip cpu_to_le32()/le32_to_cpu().
638 */
639static void ftgmac100_txdes_set_skb(struct ftgmac100_txdes *txdes,
640 struct sk_buff *skb)
641{
642 txdes->txdes2 = (unsigned int)skb;
643}
644
645static struct sk_buff *ftgmac100_txdes_get_skb(struct ftgmac100_txdes *txdes)
646{
647 return (struct sk_buff *)txdes->txdes2;
648}
649
650/******************************************************************************
651 * internal functions (transmit)
652 *****************************************************************************/
653static int ftgmac100_next_tx_pointer(int pointer)
654{
655 return (pointer + 1) & (TX_QUEUE_ENTRIES - 1);
656}
657
658static void ftgmac100_tx_pointer_advance(struct ftgmac100 *priv)
659{
660 priv->tx_pointer = ftgmac100_next_tx_pointer(priv->tx_pointer);
661}
662
663static void ftgmac100_tx_clean_pointer_advance(struct ftgmac100 *priv)
664{
665 priv->tx_clean_pointer = ftgmac100_next_tx_pointer(priv->tx_clean_pointer);
666}
667
668static struct ftgmac100_txdes *ftgmac100_current_txdes(struct ftgmac100 *priv)
669{
670 return &priv->descs->txdes[priv->tx_pointer];
671}
672
673static struct ftgmac100_txdes *
674ftgmac100_current_clean_txdes(struct ftgmac100 *priv)
675{
676 return &priv->descs->txdes[priv->tx_clean_pointer];
677}
678
679static bool ftgmac100_tx_complete_packet(struct ftgmac100 *priv)
680{
681 struct net_device *netdev = priv->netdev;
682 struct ftgmac100_txdes *txdes;
683 struct sk_buff *skb;
684 dma_addr_t map;
685
686 if (priv->tx_pending == 0)
687 return false;
688
689 txdes = ftgmac100_current_clean_txdes(priv);
690
691 if (ftgmac100_txdes_owned_by_dma(txdes))
692 return false;
693
694 skb = ftgmac100_txdes_get_skb(txdes);
695 map = ftgmac100_txdes_get_dma_addr(txdes);
696
697 netdev->stats.tx_packets++;
698 netdev->stats.tx_bytes += skb->len;
699
700 dma_unmap_single(priv->dev, map, skb_headlen(skb), DMA_TO_DEVICE);
701
702 dev_kfree_skb(skb);
703
704 ftgmac100_txdes_reset(txdes);
705
706 ftgmac100_tx_clean_pointer_advance(priv);
707
708 spin_lock(&priv->tx_lock);
709 priv->tx_pending--;
710 spin_unlock(&priv->tx_lock);
711 netif_wake_queue(netdev);
712
713 return true;
714}
715
716static void ftgmac100_tx_complete(struct ftgmac100 *priv)
717{
718 while (ftgmac100_tx_complete_packet(priv))
719 ;
720}
721
722static int ftgmac100_xmit(struct ftgmac100 *priv, struct sk_buff *skb,
723 dma_addr_t map)
724{
725 struct net_device *netdev = priv->netdev;
726 struct ftgmac100_txdes *txdes;
727 unsigned int len = (skb->len < ETH_ZLEN) ? ETH_ZLEN : skb->len;
728
729 txdes = ftgmac100_current_txdes(priv);
730 ftgmac100_tx_pointer_advance(priv);
731
732 /* setup TX descriptor */
733 ftgmac100_txdes_set_skb(txdes, skb);
734 ftgmac100_txdes_set_dma_addr(txdes, map);
735 ftgmac100_txdes_set_buffer_size(txdes, len);
736
737 ftgmac100_txdes_set_first_segment(txdes);
738 ftgmac100_txdes_set_last_segment(txdes);
739 ftgmac100_txdes_set_txint(txdes);
740 if (skb->ip_summed == CHECKSUM_PARTIAL) {
741 __be16 protocol = skb->protocol;
742
743 if (protocol == cpu_to_be16(ETH_P_IP)) {
744 u8 ip_proto = ip_hdr(skb)->protocol;
745
746 ftgmac100_txdes_set_ipcs(txdes);
747 if (ip_proto == IPPROTO_TCP)
748 ftgmac100_txdes_set_tcpcs(txdes);
749 else if (ip_proto == IPPROTO_UDP)
750 ftgmac100_txdes_set_udpcs(txdes);
751 }
752 }
753
754 spin_lock(&priv->tx_lock);
755 priv->tx_pending++;
756 if (priv->tx_pending == TX_QUEUE_ENTRIES)
757 netif_stop_queue(netdev);
758
759 /* start transmit */
760 ftgmac100_txdes_set_dma_own(txdes);
761 spin_unlock(&priv->tx_lock);
762
763 ftgmac100_txdma_normal_prio_start_polling(priv);
764
765 return NETDEV_TX_OK;
766}
767
768/******************************************************************************
769 * internal functions (buffer)
770 *****************************************************************************/
771static int ftgmac100_alloc_rx_page(struct ftgmac100 *priv,
772 struct ftgmac100_rxdes *rxdes, gfp_t gfp)
773{
774 struct net_device *netdev = priv->netdev;
775 struct page *page;
776 dma_addr_t map;
777
778 page = alloc_page(gfp);
779 if (!page) {
780 if (net_ratelimit())
781 netdev_err(netdev, "failed to allocate rx page\n");
782 return -ENOMEM;
783 }
784
785 map = dma_map_page(priv->dev, page, 0, RX_BUF_SIZE, DMA_FROM_DEVICE);
786 if (unlikely(dma_mapping_error(priv->dev, map))) {
787 if (net_ratelimit())
788 netdev_err(netdev, "failed to map rx page\n");
789 __free_page(page);
790 return -ENOMEM;
791 }
792
Andrew Jefferyada66b52016-09-22 08:34:58 +0930793 ftgmac100_rxdes_set_page(priv, rxdes, page);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000794 ftgmac100_rxdes_set_dma_addr(rxdes, map);
795 ftgmac100_rxdes_set_dma_own(rxdes);
796 return 0;
797}
798
799static void ftgmac100_free_buffers(struct ftgmac100 *priv)
800{
801 int i;
802
803 for (i = 0; i < RX_QUEUE_ENTRIES; i++) {
804 struct ftgmac100_rxdes *rxdes = &priv->descs->rxdes[i];
Andrew Jefferyada66b52016-09-22 08:34:58 +0930805 struct page *page = ftgmac100_rxdes_get_page(priv, rxdes);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000806 dma_addr_t map = ftgmac100_rxdes_get_dma_addr(rxdes);
807
808 if (!page)
809 continue;
810
811 dma_unmap_page(priv->dev, map, RX_BUF_SIZE, DMA_FROM_DEVICE);
812 __free_page(page);
813 }
814
815 for (i = 0; i < TX_QUEUE_ENTRIES; i++) {
816 struct ftgmac100_txdes *txdes = &priv->descs->txdes[i];
817 struct sk_buff *skb = ftgmac100_txdes_get_skb(txdes);
818 dma_addr_t map = ftgmac100_txdes_get_dma_addr(txdes);
819
820 if (!skb)
821 continue;
822
823 dma_unmap_single(priv->dev, map, skb_headlen(skb), DMA_TO_DEVICE);
Eric Dumazet0113e342014-01-16 23:38:24 -0800824 kfree_skb(skb);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000825 }
826
827 dma_free_coherent(priv->dev, sizeof(struct ftgmac100_descs),
828 priv->descs, priv->descs_dma_addr);
829}
830
831static int ftgmac100_alloc_buffers(struct ftgmac100 *priv)
832{
833 int i;
834
Joe Perchesede23fa2013-08-26 22:45:23 -0700835 priv->descs = dma_zalloc_coherent(priv->dev,
836 sizeof(struct ftgmac100_descs),
837 &priv->descs_dma_addr, GFP_KERNEL);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000838 if (!priv->descs)
839 return -ENOMEM;
840
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000841 /* initialize RX ring */
842 ftgmac100_rxdes_set_end_of_ring(&priv->descs->rxdes[RX_QUEUE_ENTRIES - 1]);
843
844 for (i = 0; i < RX_QUEUE_ENTRIES; i++) {
845 struct ftgmac100_rxdes *rxdes = &priv->descs->rxdes[i];
846
847 if (ftgmac100_alloc_rx_page(priv, rxdes, GFP_KERNEL))
848 goto err;
849 }
850
851 /* initialize TX ring */
852 ftgmac100_txdes_set_end_of_ring(&priv->descs->txdes[TX_QUEUE_ENTRIES - 1]);
853 return 0;
854
855err:
856 ftgmac100_free_buffers(priv);
857 return -ENOMEM;
858}
859
860/******************************************************************************
861 * internal functions (mdio)
862 *****************************************************************************/
863static void ftgmac100_adjust_link(struct net_device *netdev)
864{
865 struct ftgmac100 *priv = netdev_priv(netdev);
Philippe Reynesb3c40ad2016-05-16 01:35:13 +0200866 struct phy_device *phydev = netdev->phydev;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000867 int ier;
868
869 if (phydev->speed == priv->old_speed)
870 return;
871
872 priv->old_speed = phydev->speed;
873
874 ier = ioread32(priv->base + FTGMAC100_OFFSET_IER);
875
876 /* disable all interrupts */
877 iowrite32(0, priv->base + FTGMAC100_OFFSET_IER);
878
879 netif_stop_queue(netdev);
880 ftgmac100_stop_hw(priv);
881
882 netif_start_queue(netdev);
883 ftgmac100_init_hw(priv);
884 ftgmac100_start_hw(priv, phydev->speed);
885
886 /* re-enable interrupts */
887 iowrite32(ier, priv->base + FTGMAC100_OFFSET_IER);
888}
889
890static int ftgmac100_mii_probe(struct ftgmac100 *priv)
891{
892 struct net_device *netdev = priv->netdev;
Guenter Roecke574f392016-01-10 12:04:32 -0800893 struct phy_device *phydev;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000894
Guenter Roecke574f392016-01-10 12:04:32 -0800895 phydev = phy_find_first(priv->mii_bus);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000896 if (!phydev) {
897 netdev_info(netdev, "%s: no PHY found\n", netdev->name);
898 return -ENODEV;
899 }
900
Andrew Lunn84eff6d2016-01-06 20:11:10 +0100901 phydev = phy_connect(netdev, phydev_name(phydev),
Florian Fainellif9a8f832013-01-14 00:52:52 +0000902 &ftgmac100_adjust_link, PHY_INTERFACE_MODE_GMII);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000903
904 if (IS_ERR(phydev)) {
905 netdev_err(netdev, "%s: Could not attach to PHY\n", netdev->name);
906 return PTR_ERR(phydev);
907 }
908
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000909 return 0;
910}
911
912/******************************************************************************
913 * struct mii_bus functions
914 *****************************************************************************/
915static int ftgmac100_mdiobus_read(struct mii_bus *bus, int phy_addr, int regnum)
916{
917 struct net_device *netdev = bus->priv;
918 struct ftgmac100 *priv = netdev_priv(netdev);
919 unsigned int phycr;
920 int i;
921
922 phycr = ioread32(priv->base + FTGMAC100_OFFSET_PHYCR);
923
924 /* preserve MDC cycle threshold */
925 phycr &= FTGMAC100_PHYCR_MDC_CYCTHR_MASK;
926
927 phycr |= FTGMAC100_PHYCR_PHYAD(phy_addr) |
928 FTGMAC100_PHYCR_REGAD(regnum) |
929 FTGMAC100_PHYCR_MIIRD;
930
931 iowrite32(phycr, priv->base + FTGMAC100_OFFSET_PHYCR);
932
933 for (i = 0; i < 10; i++) {
934 phycr = ioread32(priv->base + FTGMAC100_OFFSET_PHYCR);
935
936 if ((phycr & FTGMAC100_PHYCR_MIIRD) == 0) {
937 int data;
938
939 data = ioread32(priv->base + FTGMAC100_OFFSET_PHYDATA);
940 return FTGMAC100_PHYDATA_MIIRDATA(data);
941 }
942
943 udelay(100);
944 }
945
946 netdev_err(netdev, "mdio read timed out\n");
947 return -EIO;
948}
949
950static int ftgmac100_mdiobus_write(struct mii_bus *bus, int phy_addr,
951 int regnum, u16 value)
952{
953 struct net_device *netdev = bus->priv;
954 struct ftgmac100 *priv = netdev_priv(netdev);
955 unsigned int phycr;
956 int data;
957 int i;
958
959 phycr = ioread32(priv->base + FTGMAC100_OFFSET_PHYCR);
960
961 /* preserve MDC cycle threshold */
962 phycr &= FTGMAC100_PHYCR_MDC_CYCTHR_MASK;
963
964 phycr |= FTGMAC100_PHYCR_PHYAD(phy_addr) |
965 FTGMAC100_PHYCR_REGAD(regnum) |
966 FTGMAC100_PHYCR_MIIWR;
967
968 data = FTGMAC100_PHYDATA_MIIWDATA(value);
969
970 iowrite32(data, priv->base + FTGMAC100_OFFSET_PHYDATA);
971 iowrite32(phycr, priv->base + FTGMAC100_OFFSET_PHYCR);
972
973 for (i = 0; i < 10; i++) {
974 phycr = ioread32(priv->base + FTGMAC100_OFFSET_PHYCR);
975
976 if ((phycr & FTGMAC100_PHYCR_MIIWR) == 0)
977 return 0;
978
979 udelay(100);
980 }
981
982 netdev_err(netdev, "mdio write timed out\n");
983 return -EIO;
984}
985
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000986/******************************************************************************
987 * struct ethtool_ops functions
988 *****************************************************************************/
989static void ftgmac100_get_drvinfo(struct net_device *netdev,
990 struct ethtool_drvinfo *info)
991{
Jiri Pirko7826d432013-01-06 00:44:26 +0000992 strlcpy(info->driver, DRV_NAME, sizeof(info->driver));
993 strlcpy(info->version, DRV_VERSION, sizeof(info->version));
994 strlcpy(info->bus_info, dev_name(&netdev->dev), sizeof(info->bus_info));
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000995}
996
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000997static const struct ethtool_ops ftgmac100_ethtool_ops = {
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000998 .get_drvinfo = ftgmac100_get_drvinfo,
999 .get_link = ethtool_op_get_link,
Philippe Reynesfd24d722016-05-16 01:35:14 +02001000 .get_link_ksettings = phy_ethtool_get_link_ksettings,
1001 .set_link_ksettings = phy_ethtool_set_link_ksettings,
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001002};
1003
1004/******************************************************************************
1005 * interrupt handler
1006 *****************************************************************************/
1007static irqreturn_t ftgmac100_interrupt(int irq, void *dev_id)
1008{
1009 struct net_device *netdev = dev_id;
1010 struct ftgmac100 *priv = netdev_priv(netdev);
1011
Gavin Shanbd466c32016-07-19 11:54:23 +10001012 /* When running in NCSI mode, the interface should be ready for
1013 * receiving or transmitting NCSI packets before it's opened.
1014 */
1015 if (likely(priv->use_ncsi || netif_running(netdev))) {
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001016 /* Disable interrupts for polling */
1017 iowrite32(0, priv->base + FTGMAC100_OFFSET_IER);
1018 napi_schedule(&priv->napi);
1019 }
1020
1021 return IRQ_HANDLED;
1022}
1023
1024/******************************************************************************
1025 * struct napi_struct functions
1026 *****************************************************************************/
1027static int ftgmac100_poll(struct napi_struct *napi, int budget)
1028{
1029 struct ftgmac100 *priv = container_of(napi, struct ftgmac100, napi);
1030 struct net_device *netdev = priv->netdev;
1031 unsigned int status;
1032 bool completed = true;
1033 int rx = 0;
1034
1035 status = ioread32(priv->base + FTGMAC100_OFFSET_ISR);
1036 iowrite32(status, priv->base + FTGMAC100_OFFSET_ISR);
1037
1038 if (status & (FTGMAC100_INT_RPKT_BUF | FTGMAC100_INT_NO_RXBUF)) {
1039 /*
1040 * FTGMAC100_INT_RPKT_BUF:
1041 * RX DMA has received packets into RX buffer successfully
1042 *
1043 * FTGMAC100_INT_NO_RXBUF:
1044 * RX buffer unavailable
1045 */
1046 bool retry;
1047
1048 do {
1049 retry = ftgmac100_rx_packet(priv, &rx);
1050 } while (retry && rx < budget);
1051
1052 if (retry && rx == budget)
1053 completed = false;
1054 }
1055
1056 if (status & (FTGMAC100_INT_XPKT_ETH | FTGMAC100_INT_XPKT_LOST)) {
1057 /*
1058 * FTGMAC100_INT_XPKT_ETH:
1059 * packet transmitted to ethernet successfully
1060 *
1061 * FTGMAC100_INT_XPKT_LOST:
1062 * packet transmitted to ethernet lost due to late
1063 * collision or excessive collision
1064 */
1065 ftgmac100_tx_complete(priv);
1066 }
1067
Gavin Shanfc6061c2016-07-19 11:54:25 +10001068 if (status & priv->int_mask_all & (FTGMAC100_INT_NO_RXBUF |
1069 FTGMAC100_INT_RPKT_LOST | FTGMAC100_INT_AHB_ERR |
1070 FTGMAC100_INT_PHYSTS_CHG)) {
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001071 if (net_ratelimit())
1072 netdev_info(netdev, "[ISR] = 0x%x: %s%s%s%s\n", status,
1073 status & FTGMAC100_INT_NO_RXBUF ? "NO_RXBUF " : "",
1074 status & FTGMAC100_INT_RPKT_LOST ? "RPKT_LOST " : "",
1075 status & FTGMAC100_INT_AHB_ERR ? "AHB_ERR " : "",
1076 status & FTGMAC100_INT_PHYSTS_CHG ? "PHYSTS_CHG" : "");
1077
1078 if (status & FTGMAC100_INT_NO_RXBUF) {
1079 /* RX buffer unavailable */
1080 netdev->stats.rx_over_errors++;
1081 }
1082
1083 if (status & FTGMAC100_INT_RPKT_LOST) {
1084 /* received packet lost due to RX FIFO full */
1085 netdev->stats.rx_fifo_errors++;
1086 }
1087 }
1088
1089 if (completed) {
1090 napi_complete(napi);
1091
1092 /* enable all interrupts */
Gavin Shanfc6061c2016-07-19 11:54:25 +10001093 iowrite32(priv->int_mask_all,
1094 priv->base + FTGMAC100_OFFSET_IER);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001095 }
1096
1097 return rx;
1098}
1099
1100/******************************************************************************
1101 * struct net_device_ops functions
1102 *****************************************************************************/
1103static int ftgmac100_open(struct net_device *netdev)
1104{
1105 struct ftgmac100 *priv = netdev_priv(netdev);
1106 int err;
1107
1108 err = ftgmac100_alloc_buffers(priv);
1109 if (err) {
1110 netdev_err(netdev, "failed to allocate buffers\n");
1111 goto err_alloc;
1112 }
1113
1114 err = request_irq(priv->irq, ftgmac100_interrupt, 0, netdev->name, netdev);
1115 if (err) {
1116 netdev_err(netdev, "failed to request irq %d\n", priv->irq);
1117 goto err_irq;
1118 }
1119
1120 priv->rx_pointer = 0;
1121 priv->tx_clean_pointer = 0;
1122 priv->tx_pointer = 0;
1123 priv->tx_pending = 0;
1124
1125 err = ftgmac100_reset_hw(priv);
1126 if (err)
1127 goto err_hw;
1128
1129 ftgmac100_init_hw(priv);
Gavin Shanbd466c32016-07-19 11:54:23 +10001130 ftgmac100_start_hw(priv, priv->use_ncsi ? 100 : 10);
1131 if (netdev->phydev)
1132 phy_start(netdev->phydev);
1133 else if (priv->use_ncsi)
1134 netif_carrier_on(netdev);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001135
1136 napi_enable(&priv->napi);
1137 netif_start_queue(netdev);
1138
1139 /* enable all interrupts */
Gavin Shanfc6061c2016-07-19 11:54:25 +10001140 iowrite32(priv->int_mask_all, priv->base + FTGMAC100_OFFSET_IER);
Gavin Shanbd466c32016-07-19 11:54:23 +10001141
1142 /* Start the NCSI device */
1143 if (priv->use_ncsi) {
1144 err = ncsi_start_dev(priv->ndev);
1145 if (err)
1146 goto err_ncsi;
1147 }
1148
1149 priv->enabled = true;
1150
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001151 return 0;
1152
Gavin Shanbd466c32016-07-19 11:54:23 +10001153err_ncsi:
1154 napi_disable(&priv->napi);
1155 netif_stop_queue(netdev);
1156 iowrite32(0, priv->base + FTGMAC100_OFFSET_IER);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001157err_hw:
1158 free_irq(priv->irq, netdev);
1159err_irq:
1160 ftgmac100_free_buffers(priv);
1161err_alloc:
1162 return err;
1163}
1164
1165static int ftgmac100_stop(struct net_device *netdev)
1166{
1167 struct ftgmac100 *priv = netdev_priv(netdev);
1168
Gavin Shanbd466c32016-07-19 11:54:23 +10001169 if (!priv->enabled)
1170 return 0;
1171
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001172 /* disable all interrupts */
Gavin Shanbd466c32016-07-19 11:54:23 +10001173 priv->enabled = false;
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001174 iowrite32(0, priv->base + FTGMAC100_OFFSET_IER);
1175
1176 netif_stop_queue(netdev);
1177 napi_disable(&priv->napi);
Gavin Shanbd466c32016-07-19 11:54:23 +10001178 if (netdev->phydev)
1179 phy_stop(netdev->phydev);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001180
1181 ftgmac100_stop_hw(priv);
1182 free_irq(priv->irq, netdev);
1183 ftgmac100_free_buffers(priv);
1184
1185 return 0;
1186}
1187
1188static int ftgmac100_hard_start_xmit(struct sk_buff *skb,
1189 struct net_device *netdev)
1190{
1191 struct ftgmac100 *priv = netdev_priv(netdev);
1192 dma_addr_t map;
1193
1194 if (unlikely(skb->len > MAX_PKT_SIZE)) {
1195 if (net_ratelimit())
1196 netdev_dbg(netdev, "tx packet too big\n");
1197
1198 netdev->stats.tx_dropped++;
Eric Dumazet0113e342014-01-16 23:38:24 -08001199 kfree_skb(skb);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001200 return NETDEV_TX_OK;
1201 }
1202
1203 map = dma_map_single(priv->dev, skb->data, skb_headlen(skb), DMA_TO_DEVICE);
1204 if (unlikely(dma_mapping_error(priv->dev, map))) {
1205 /* drop packet */
1206 if (net_ratelimit())
1207 netdev_err(netdev, "map socket buffer failed\n");
1208
1209 netdev->stats.tx_dropped++;
Eric Dumazet0113e342014-01-16 23:38:24 -08001210 kfree_skb(skb);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001211 return NETDEV_TX_OK;
1212 }
1213
1214 return ftgmac100_xmit(priv, skb, map);
1215}
1216
1217/* optional */
1218static int ftgmac100_do_ioctl(struct net_device *netdev, struct ifreq *ifr, int cmd)
1219{
Gavin Shanbd466c32016-07-19 11:54:23 +10001220 if (!netdev->phydev)
1221 return -ENXIO;
1222
Philippe Reynesb3c40ad2016-05-16 01:35:13 +02001223 return phy_mii_ioctl(netdev->phydev, ifr, cmd);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001224}
1225
1226static const struct net_device_ops ftgmac100_netdev_ops = {
1227 .ndo_open = ftgmac100_open,
1228 .ndo_stop = ftgmac100_stop,
1229 .ndo_start_xmit = ftgmac100_hard_start_xmit,
Gavin Shan113ce102016-07-19 11:54:22 +10001230 .ndo_set_mac_address = ftgmac100_set_mac_addr,
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001231 .ndo_validate_addr = eth_validate_addr,
1232 .ndo_do_ioctl = ftgmac100_do_ioctl,
1233};
1234
Gavin Shaneb418182016-07-19 11:54:21 +10001235static int ftgmac100_setup_mdio(struct net_device *netdev)
1236{
1237 struct ftgmac100 *priv = netdev_priv(netdev);
1238 struct platform_device *pdev = to_platform_device(priv->dev);
1239 int i, err = 0;
1240
1241 /* initialize mdio bus */
1242 priv->mii_bus = mdiobus_alloc();
1243 if (!priv->mii_bus)
1244 return -EIO;
1245
1246 priv->mii_bus->name = "ftgmac100_mdio";
1247 snprintf(priv->mii_bus->id, MII_BUS_ID_SIZE, "%s-%d",
1248 pdev->name, pdev->id);
1249 priv->mii_bus->priv = priv->netdev;
1250 priv->mii_bus->read = ftgmac100_mdiobus_read;
1251 priv->mii_bus->write = ftgmac100_mdiobus_write;
1252
1253 for (i = 0; i < PHY_MAX_ADDR; i++)
1254 priv->mii_bus->irq[i] = PHY_POLL;
1255
1256 err = mdiobus_register(priv->mii_bus);
1257 if (err) {
1258 dev_err(priv->dev, "Cannot register MDIO bus!\n");
1259 goto err_register_mdiobus;
1260 }
1261
1262 err = ftgmac100_mii_probe(priv);
1263 if (err) {
1264 dev_err(priv->dev, "MII Probe failed!\n");
1265 goto err_mii_probe;
1266 }
1267
1268 return 0;
1269
1270err_mii_probe:
1271 mdiobus_unregister(priv->mii_bus);
1272err_register_mdiobus:
1273 mdiobus_free(priv->mii_bus);
1274 return err;
1275}
1276
1277static void ftgmac100_destroy_mdio(struct net_device *netdev)
1278{
1279 struct ftgmac100 *priv = netdev_priv(netdev);
1280
1281 if (!netdev->phydev)
1282 return;
1283
1284 phy_disconnect(netdev->phydev);
1285 mdiobus_unregister(priv->mii_bus);
1286 mdiobus_free(priv->mii_bus);
1287}
1288
Gavin Shanbd466c32016-07-19 11:54:23 +10001289static void ftgmac100_ncsi_handler(struct ncsi_dev *nd)
1290{
1291 if (unlikely(nd->state != ncsi_dev_state_functional))
1292 return;
1293
1294 netdev_info(nd->dev, "NCSI interface %s\n",
1295 nd->link_up ? "up" : "down");
1296}
1297
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001298/******************************************************************************
1299 * struct platform_driver functions
1300 *****************************************************************************/
1301static int ftgmac100_probe(struct platform_device *pdev)
1302{
1303 struct resource *res;
1304 int irq;
1305 struct net_device *netdev;
1306 struct ftgmac100 *priv;
Gavin Shanbd466c32016-07-19 11:54:23 +10001307 int err = 0;
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001308
1309 if (!pdev)
1310 return -ENODEV;
1311
1312 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1313 if (!res)
1314 return -ENXIO;
1315
1316 irq = platform_get_irq(pdev, 0);
1317 if (irq < 0)
1318 return irq;
1319
1320 /* setup net_device */
1321 netdev = alloc_etherdev(sizeof(*priv));
1322 if (!netdev) {
1323 err = -ENOMEM;
1324 goto err_alloc_etherdev;
1325 }
1326
1327 SET_NETDEV_DEV(netdev, &pdev->dev);
1328
Wilfried Klaebe7ad24ea2014-05-11 00:12:32 +00001329 netdev->ethtool_ops = &ftgmac100_ethtool_ops;
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001330 netdev->netdev_ops = &ftgmac100_netdev_ops;
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001331
1332 platform_set_drvdata(pdev, netdev);
1333
1334 /* setup private data */
1335 priv = netdev_priv(netdev);
1336 priv->netdev = netdev;
1337 priv->dev = &pdev->dev;
1338
1339 spin_lock_init(&priv->tx_lock);
1340
1341 /* initialize NAPI */
1342 netif_napi_add(netdev, &priv->napi, ftgmac100_poll, 64);
1343
1344 /* map io memory */
1345 priv->res = request_mem_region(res->start, resource_size(res),
1346 dev_name(&pdev->dev));
1347 if (!priv->res) {
1348 dev_err(&pdev->dev, "Could not reserve memory region\n");
1349 err = -ENOMEM;
1350 goto err_req_mem;
1351 }
1352
1353 priv->base = ioremap(res->start, resource_size(res));
1354 if (!priv->base) {
1355 dev_err(&pdev->dev, "Failed to ioremap ethernet registers\n");
1356 err = -EIO;
1357 goto err_ioremap;
1358 }
1359
1360 priv->irq = irq;
1361
Gavin Shan113ce102016-07-19 11:54:22 +10001362 /* MAC address from chip or random one */
1363 ftgmac100_setup_mac(priv);
1364
Gavin Shanfc6061c2016-07-19 11:54:25 +10001365 priv->int_mask_all = (FTGMAC100_INT_RPKT_LOST |
1366 FTGMAC100_INT_XPKT_ETH |
1367 FTGMAC100_INT_XPKT_LOST |
1368 FTGMAC100_INT_AHB_ERR |
1369 FTGMAC100_INT_PHYSTS_CHG |
1370 FTGMAC100_INT_RPKT_BUF |
1371 FTGMAC100_INT_NO_RXBUF);
Gavin Shanbd466c32016-07-19 11:54:23 +10001372 if (pdev->dev.of_node &&
1373 of_get_property(pdev->dev.of_node, "use-ncsi", NULL)) {
1374 if (!IS_ENABLED(CONFIG_NET_NCSI)) {
1375 dev_err(&pdev->dev, "NCSI stack not enabled\n");
1376 goto err_ncsi_dev;
1377 }
1378
1379 dev_info(&pdev->dev, "Using NCSI interface\n");
1380 priv->use_ncsi = true;
Gavin Shanfc6061c2016-07-19 11:54:25 +10001381 priv->int_mask_all &= ~FTGMAC100_INT_PHYSTS_CHG;
Gavin Shanbd466c32016-07-19 11:54:23 +10001382 priv->ndev = ncsi_register_dev(netdev, ftgmac100_ncsi_handler);
1383 if (!priv->ndev)
1384 goto err_ncsi_dev;
1385 } else {
1386 priv->use_ncsi = false;
1387 err = ftgmac100_setup_mdio(netdev);
1388 if (err)
1389 goto err_setup_mdio;
1390 }
1391
1392 /* We have to disable on-chip IP checksum functionality
1393 * when NCSI is enabled on the interface. It doesn't work
1394 * in that case.
1395 */
1396 netdev->features = NETIF_F_IP_CSUM | NETIF_F_GRO;
1397 if (priv->use_ncsi &&
1398 of_get_property(pdev->dev.of_node, "no-hw-checksum", NULL))
1399 netdev->features &= ~NETIF_F_IP_CSUM;
1400
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001401
1402 /* register network device */
1403 err = register_netdev(netdev);
1404 if (err) {
1405 dev_err(&pdev->dev, "Failed to register netdev\n");
1406 goto err_register_netdev;
1407 }
1408
1409 netdev_info(netdev, "irq %d, mapped at %p\n", priv->irq, priv->base);
1410
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001411 return 0;
1412
Gavin Shanbd466c32016-07-19 11:54:23 +10001413err_ncsi_dev:
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001414err_register_netdev:
Gavin Shaneb418182016-07-19 11:54:21 +10001415 ftgmac100_destroy_mdio(netdev);
1416err_setup_mdio:
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001417 iounmap(priv->base);
1418err_ioremap:
1419 release_resource(priv->res);
1420err_req_mem:
1421 netif_napi_del(&priv->napi);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001422 free_netdev(netdev);
1423err_alloc_etherdev:
1424 return err;
1425}
1426
1427static int __exit ftgmac100_remove(struct platform_device *pdev)
1428{
1429 struct net_device *netdev;
1430 struct ftgmac100 *priv;
1431
1432 netdev = platform_get_drvdata(pdev);
1433 priv = netdev_priv(netdev);
1434
1435 unregister_netdev(netdev);
Gavin Shaneb418182016-07-19 11:54:21 +10001436 ftgmac100_destroy_mdio(netdev);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001437
1438 iounmap(priv->base);
1439 release_resource(priv->res);
1440
1441 netif_napi_del(&priv->napi);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001442 free_netdev(netdev);
1443 return 0;
1444}
1445
Gavin Shanbb168e22016-07-19 11:54:24 +10001446static const struct of_device_id ftgmac100_of_match[] = {
1447 { .compatible = "faraday,ftgmac100" },
1448 { }
1449};
1450MODULE_DEVICE_TABLE(of, ftgmac100_of_match);
1451
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001452static struct platform_driver ftgmac100_driver = {
Gavin Shanbb168e22016-07-19 11:54:24 +10001453 .probe = ftgmac100_probe,
1454 .remove = __exit_p(ftgmac100_remove),
1455 .driver = {
1456 .name = DRV_NAME,
1457 .of_match_table = ftgmac100_of_match,
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001458 },
1459};
Sachin Kamat14f645d2013-03-18 01:50:48 +00001460module_platform_driver(ftgmac100_driver);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001461
1462MODULE_AUTHOR("Po-Yu Chuang <ratbert@faraday-tech.com>");
1463MODULE_DESCRIPTION("FTGMAC100 driver");
1464MODULE_LICENSE("GPL");