blob: b4d84e753187e71b298376cc1e319e6a9333f8d6 [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>
Mark Brown3af887c2017-03-30 17:00:12 +010031#include <linux/of.h>
Po-Yu Chuang69785b72011-06-08 23:32:48 +000032#include <linux/phy.h>
33#include <linux/platform_device.h>
Mark Brown3af887c2017-03-30 17:00:12 +010034#include <linux/property.h>
Po-Yu Chuang69785b72011-06-08 23:32:48 +000035#include <net/ip.h>
Gavin Shanbd466c32016-07-19 11:54:23 +100036#include <net/ncsi.h>
Po-Yu Chuang69785b72011-06-08 23:32:48 +000037
38#include "ftgmac100.h"
39
40#define DRV_NAME "ftgmac100"
41#define DRV_VERSION "0.7"
42
43#define RX_QUEUE_ENTRIES 256 /* must be power of 2 */
44#define TX_QUEUE_ENTRIES 512 /* must be power of 2 */
45
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +100046#define MAX_PKT_SIZE 1536
47#define RX_BUF_SIZE MAX_PKT_SIZE /* must be smaller than 0x3fff */
Po-Yu Chuang69785b72011-06-08 23:32:48 +000048
Po-Yu Chuang69785b72011-06-08 23:32:48 +000049struct ftgmac100_descs {
50 struct ftgmac100_rxdes rxdes[RX_QUEUE_ENTRIES];
51 struct ftgmac100_txdes txdes[TX_QUEUE_ENTRIES];
52};
53
54struct ftgmac100 {
Benjamin Herrenschmidt831fb332017-04-05 12:28:43 +100055 /* Registers */
Po-Yu Chuang69785b72011-06-08 23:32:48 +000056 struct resource *res;
57 void __iomem *base;
Po-Yu Chuang69785b72011-06-08 23:32:48 +000058
59 struct ftgmac100_descs *descs;
60 dma_addr_t descs_dma_addr;
61
Benjamin Herrenschmidt831fb332017-04-05 12:28:43 +100062 /* Rx ring */
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +100063 struct sk_buff *rx_skbs[RX_QUEUE_ENTRIES];
Po-Yu Chuang69785b72011-06-08 23:32:48 +000064 unsigned int rx_pointer;
Benjamin Herrenschmidt831fb332017-04-05 12:28:43 +100065 u32 rxdes0_edorr_mask;
66
67 /* Tx ring */
Benjamin Herrenschmidt83617312017-04-10 11:15:20 +100068 struct sk_buff *tx_skbs[TX_QUEUE_ENTRIES];
Po-Yu Chuang69785b72011-06-08 23:32:48 +000069 unsigned int tx_clean_pointer;
70 unsigned int tx_pointer;
71 unsigned int tx_pending;
Benjamin Herrenschmidt831fb332017-04-05 12:28:43 +100072 u32 txdes0_edotr_mask;
Po-Yu Chuang69785b72011-06-08 23:32:48 +000073 spinlock_t tx_lock;
74
Benjamin Herrenschmidtd72e01a2017-04-06 11:02:45 +100075 /* Scratch page to use when rx skb alloc fails */
76 void *rx_scratch;
77 dma_addr_t rx_scratch_dma;
78
Benjamin Herrenschmidt831fb332017-04-05 12:28:43 +100079 /* Component structures */
Po-Yu Chuang69785b72011-06-08 23:32:48 +000080 struct net_device *netdev;
81 struct device *dev;
Gavin Shanbd466c32016-07-19 11:54:23 +100082 struct ncsi_dev *ndev;
Po-Yu Chuang69785b72011-06-08 23:32:48 +000083 struct napi_struct napi;
Benjamin Herrenschmidt855944c2017-04-05 12:28:50 +100084 struct work_struct reset_task;
Po-Yu Chuang69785b72011-06-08 23:32:48 +000085 struct mii_bus *mii_bus;
Andrew Jeffery7906a4d2016-09-22 08:34:59 +093086
Benjamin Herrenschmidt831fb332017-04-05 12:28:43 +100087 /* Link management */
Benjamin Herrenschmidt51764772017-04-05 12:28:45 +100088 int cur_speed;
89 int cur_duplex;
Benjamin Herrenschmidt831fb332017-04-05 12:28:43 +100090 bool use_ncsi;
91
92 /* Misc */
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +100093 bool need_mac_restart;
Po-Yu Chuang69785b72011-06-08 23:32:48 +000094};
95
Po-Yu Chuang69785b72011-06-08 23:32:48 +000096static void ftgmac100_set_rx_ring_base(struct ftgmac100 *priv, dma_addr_t addr)
97{
98 iowrite32(addr, priv->base + FTGMAC100_OFFSET_RXR_BADR);
99}
100
101static void ftgmac100_set_rx_buffer_size(struct ftgmac100 *priv,
102 unsigned int size)
103{
104 size = FTGMAC100_RBSR_SIZE(size);
105 iowrite32(size, priv->base + FTGMAC100_OFFSET_RBSR);
106}
107
108static void ftgmac100_set_normal_prio_tx_ring_base(struct ftgmac100 *priv,
109 dma_addr_t addr)
110{
111 iowrite32(addr, priv->base + FTGMAC100_OFFSET_NPTXR_BADR);
112}
113
114static void ftgmac100_txdma_normal_prio_start_polling(struct ftgmac100 *priv)
115{
116 iowrite32(1, priv->base + FTGMAC100_OFFSET_NPTXPD);
117}
118
Benjamin Herrenschmidt874b55b2017-04-05 12:28:51 +1000119static int ftgmac100_reset_mac(struct ftgmac100 *priv, u32 maccr)
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000120{
121 struct net_device *netdev = priv->netdev;
122 int i;
123
124 /* NOTE: reset clears all registers */
Benjamin Herrenschmidt874b55b2017-04-05 12:28:51 +1000125 iowrite32(maccr, priv->base + FTGMAC100_OFFSET_MACCR);
126 iowrite32(maccr | FTGMAC100_MACCR_SW_RST,
127 priv->base + FTGMAC100_OFFSET_MACCR);
128 for (i = 0; i < 50; i++) {
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000129 unsigned int maccr;
130
131 maccr = ioread32(priv->base + FTGMAC100_OFFSET_MACCR);
132 if (!(maccr & FTGMAC100_MACCR_SW_RST))
133 return 0;
134
Benjamin Herrenschmidt874b55b2017-04-05 12:28:51 +1000135 udelay(1);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000136 }
137
Benjamin Herrenschmidt874b55b2017-04-05 12:28:51 +1000138 netdev_err(netdev, "Hardware reset failed\n");
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000139 return -EIO;
140}
141
Benjamin Herrenschmidt874b55b2017-04-05 12:28:51 +1000142static int ftgmac100_reset_and_config_mac(struct ftgmac100 *priv)
143{
144 u32 maccr = 0;
145
146 switch (priv->cur_speed) {
147 case SPEED_10:
148 case 0: /* no link */
149 break;
150
151 case SPEED_100:
152 maccr |= FTGMAC100_MACCR_FAST_MODE;
153 break;
154
155 case SPEED_1000:
156 maccr |= FTGMAC100_MACCR_GIGA_MODE;
157 break;
158 default:
159 netdev_err(priv->netdev, "Unknown speed %d !\n",
160 priv->cur_speed);
161 break;
162 }
163
164 /* (Re)initialize the queue pointers */
165 priv->rx_pointer = 0;
166 priv->tx_clean_pointer = 0;
167 priv->tx_pointer = 0;
168 priv->tx_pending = 0;
169
170 /* The doc says reset twice with 10us interval */
171 if (ftgmac100_reset_mac(priv, maccr))
172 return -EIO;
173 usleep_range(10, 1000);
174 return ftgmac100_reset_mac(priv, maccr);
175}
176
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000177static void ftgmac100_set_mac(struct ftgmac100 *priv, const unsigned char *mac)
178{
179 unsigned int maddr = mac[0] << 8 | mac[1];
180 unsigned int laddr = mac[2] << 24 | mac[3] << 16 | mac[4] << 8 | mac[5];
181
182 iowrite32(maddr, priv->base + FTGMAC100_OFFSET_MAC_MADR);
183 iowrite32(laddr, priv->base + FTGMAC100_OFFSET_MAC_LADR);
184}
185
Gavin Shan113ce102016-07-19 11:54:22 +1000186static void ftgmac100_setup_mac(struct ftgmac100 *priv)
187{
188 u8 mac[ETH_ALEN];
189 unsigned int m;
190 unsigned int l;
191 void *addr;
192
193 addr = device_get_mac_address(priv->dev, mac, ETH_ALEN);
194 if (addr) {
195 ether_addr_copy(priv->netdev->dev_addr, mac);
196 dev_info(priv->dev, "Read MAC address %pM from device tree\n",
197 mac);
198 return;
199 }
200
201 m = ioread32(priv->base + FTGMAC100_OFFSET_MAC_MADR);
202 l = ioread32(priv->base + FTGMAC100_OFFSET_MAC_LADR);
203
204 mac[0] = (m >> 8) & 0xff;
205 mac[1] = m & 0xff;
206 mac[2] = (l >> 24) & 0xff;
207 mac[3] = (l >> 16) & 0xff;
208 mac[4] = (l >> 8) & 0xff;
209 mac[5] = l & 0xff;
210
Gavin Shan113ce102016-07-19 11:54:22 +1000211 if (is_valid_ether_addr(mac)) {
212 ether_addr_copy(priv->netdev->dev_addr, mac);
213 dev_info(priv->dev, "Read MAC address %pM from chip\n", mac);
214 } else {
215 eth_hw_addr_random(priv->netdev);
216 dev_info(priv->dev, "Generated random MAC address %pM\n",
217 priv->netdev->dev_addr);
218 }
219}
220
221static int ftgmac100_set_mac_addr(struct net_device *dev, void *p)
222{
223 int ret;
224
225 ret = eth_prepare_mac_addr_change(dev, p);
226 if (ret < 0)
227 return ret;
228
229 eth_commit_mac_addr_change(dev, p);
230 ftgmac100_set_mac(netdev_priv(dev), dev->dev_addr);
231
232 return 0;
233}
234
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000235static void ftgmac100_init_hw(struct ftgmac100 *priv)
236{
237 /* setup ring buffer base registers */
238 ftgmac100_set_rx_ring_base(priv,
239 priv->descs_dma_addr +
240 offsetof(struct ftgmac100_descs, rxdes));
241 ftgmac100_set_normal_prio_tx_ring_base(priv,
242 priv->descs_dma_addr +
243 offsetof(struct ftgmac100_descs, txdes));
244
245 ftgmac100_set_rx_buffer_size(priv, RX_BUF_SIZE);
246
247 iowrite32(FTGMAC100_APTC_RXPOLL_CNT(1), priv->base + FTGMAC100_OFFSET_APTC);
248
249 ftgmac100_set_mac(priv, priv->netdev->dev_addr);
250}
251
Benjamin Herrenschmidt51764772017-04-05 12:28:45 +1000252static void ftgmac100_start_hw(struct ftgmac100 *priv)
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000253{
Benjamin Herrenschmidt874b55b2017-04-05 12:28:51 +1000254 u32 maccr = ioread32(priv->base + FTGMAC100_OFFSET_MACCR);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000255
Benjamin Herrenschmidt874b55b2017-04-05 12:28:51 +1000256 /* Keep the original GMAC and FAST bits */
257 maccr &= (FTGMAC100_MACCR_FAST_MODE | FTGMAC100_MACCR_GIGA_MODE);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000258
Benjamin Herrenschmidt874b55b2017-04-05 12:28:51 +1000259 /* Add all the main enable bits */
260 maccr |= FTGMAC100_MACCR_TXDMA_EN |
261 FTGMAC100_MACCR_RXDMA_EN |
262 FTGMAC100_MACCR_TXMAC_EN |
263 FTGMAC100_MACCR_RXMAC_EN |
264 FTGMAC100_MACCR_CRC_APD |
265 FTGMAC100_MACCR_PHY_LINK_LEVEL |
266 FTGMAC100_MACCR_RX_RUNT |
267 FTGMAC100_MACCR_RX_BROADPKT;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000268
Benjamin Herrenschmidt874b55b2017-04-05 12:28:51 +1000269 /* Add other bits as needed */
Benjamin Herrenschmidt51764772017-04-05 12:28:45 +1000270 if (priv->cur_duplex == DUPLEX_FULL)
271 maccr |= FTGMAC100_MACCR_FULLDUP;
272
Benjamin Herrenschmidt874b55b2017-04-05 12:28:51 +1000273 /* Hit the HW */
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000274 iowrite32(maccr, priv->base + FTGMAC100_OFFSET_MACCR);
275}
276
277static void ftgmac100_stop_hw(struct ftgmac100 *priv)
278{
279 iowrite32(0, priv->base + FTGMAC100_OFFSET_MACCR);
280}
281
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000282static int ftgmac100_alloc_rx_buf(struct ftgmac100 *priv, unsigned int entry,
283 struct ftgmac100_rxdes *rxdes, gfp_t gfp)
Benjamin Herrenschmidtc06f73f2017-04-06 11:02:43 +1000284{
285 struct net_device *netdev = priv->netdev;
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000286 struct sk_buff *skb;
Benjamin Herrenschmidtc06f73f2017-04-06 11:02:43 +1000287 dma_addr_t map;
Benjamin Herrenschmidtd72e01a2017-04-06 11:02:45 +1000288 int err;
Benjamin Herrenschmidtc06f73f2017-04-06 11:02:43 +1000289
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000290 skb = netdev_alloc_skb_ip_align(netdev, RX_BUF_SIZE);
291 if (unlikely(!skb)) {
Benjamin Herrenschmidtc06f73f2017-04-06 11:02:43 +1000292 if (net_ratelimit())
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000293 netdev_warn(netdev, "failed to allocate rx skb\n");
Benjamin Herrenschmidtd72e01a2017-04-06 11:02:45 +1000294 err = -ENOMEM;
295 map = priv->rx_scratch_dma;
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000296 } else {
297 map = dma_map_single(priv->dev, skb->data, RX_BUF_SIZE,
298 DMA_FROM_DEVICE);
299 if (unlikely(dma_mapping_error(priv->dev, map))) {
300 if (net_ratelimit())
301 netdev_err(netdev, "failed to map rx page\n");
302 dev_kfree_skb_any(skb);
303 map = priv->rx_scratch_dma;
304 skb = NULL;
305 err = -ENOMEM;
306 }
Benjamin Herrenschmidtc06f73f2017-04-06 11:02:43 +1000307 }
308
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000309 /* Store skb */
310 priv->rx_skbs[entry] = skb;
Benjamin Herrenschmidtc06f73f2017-04-06 11:02:43 +1000311
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000312 /* Store DMA address into RX desc */
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000313 rxdes->rxdes3 = cpu_to_le32(map);
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000314
315 /* Ensure the above is ordered vs clearing the OWN bit */
316 dma_wmb();
317
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000318 /* Clean status (which resets own bit) */
319 if (entry == (RX_QUEUE_ENTRIES - 1))
320 rxdes->rxdes0 = cpu_to_le32(priv->rxdes0_edorr_mask);
321 else
322 rxdes->rxdes0 = 0;
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000323
Benjamin Herrenschmidtc06f73f2017-04-06 11:02:43 +1000324 return 0;
325}
326
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000327static int ftgmac100_next_rx_pointer(int pointer)
328{
329 return (pointer + 1) & (RX_QUEUE_ENTRIES - 1);
330}
331
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000332static void ftgmac100_rx_packet_error(struct ftgmac100 *priv, u32 status)
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000333{
334 struct net_device *netdev = priv->netdev;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000335
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000336 if (status & FTGMAC100_RXDES0_RX_ERR)
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000337 netdev->stats.rx_errors++;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000338
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000339 if (status & FTGMAC100_RXDES0_CRC_ERR)
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000340 netdev->stats.rx_crc_errors++;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000341
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000342 if (status & (FTGMAC100_RXDES0_FTL |
343 FTGMAC100_RXDES0_RUNT |
344 FTGMAC100_RXDES0_RX_ODD_NB))
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000345 netdev->stats.rx_length_errors++;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000346}
347
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000348static bool ftgmac100_rx_packet(struct ftgmac100 *priv, int *processed)
349{
350 struct net_device *netdev = priv->netdev;
351 struct ftgmac100_rxdes *rxdes;
352 struct sk_buff *skb;
Benjamin Herrenschmidt01dd70b2017-04-06 11:02:48 +1000353 unsigned int pointer, size;
Benjamin Herrenschmidtd9306552017-04-06 11:02:52 +1000354 u32 status, csum_vlan;
Benjamin Herrenschmidtb1977bf2017-04-06 11:02:44 +1000355 dma_addr_t map;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000356
Benjamin Herrenschmidt01dd70b2017-04-06 11:02:48 +1000357 /* Grab next RX descriptor */
358 pointer = priv->rx_pointer;
359 rxdes = &priv->descs->rxdes[pointer];
360
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000361 /* Grab descriptor status */
362 status = le32_to_cpu(rxdes->rxdes0);
363
Benjamin Herrenschmidt01dd70b2017-04-06 11:02:48 +1000364 /* Do we have a packet ? */
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000365 if (!(status & FTGMAC100_RXDES0_RXPKT_RDY))
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000366 return false;
367
Benjamin Herrenschmidt027f4262017-04-06 11:02:50 +1000368 /* Order subsequent reads with the test for the ready bit */
369 dma_rmb();
370
Benjamin Herrenschmidt01dd70b2017-04-06 11:02:48 +1000371 /* We don't cope with fragmented RX packets */
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000372 if (unlikely(!(status & FTGMAC100_RXDES0_FRS) ||
373 !(status & FTGMAC100_RXDES0_LRS)))
Benjamin Herrenschmidt01dd70b2017-04-06 11:02:48 +1000374 goto drop;
375
Benjamin Herrenschmidtd9306552017-04-06 11:02:52 +1000376 /* Grab received size and csum vlan field in the descriptor */
377 size = status & FTGMAC100_RXDES0_VDBC;
378 csum_vlan = le32_to_cpu(rxdes->rxdes1);
379
Benjamin Herrenschmidt01dd70b2017-04-06 11:02:48 +1000380 /* Any error (other than csum offload) flagged ? */
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000381 if (unlikely(status & RXDES0_ANY_ERROR)) {
Benjamin Herrenschmidtd9306552017-04-06 11:02:52 +1000382 /* Correct for incorrect flagging of runt packets
383 * with vlan tags... Just accept a runt packet that
384 * has been flagged as vlan and whose size is at
385 * least 60 bytes.
386 */
387 if ((status & FTGMAC100_RXDES0_RUNT) &&
388 (csum_vlan & FTGMAC100_RXDES1_VLANTAG_AVAIL) &&
389 (size >= 60))
390 status &= ~FTGMAC100_RXDES0_RUNT;
391
392 /* Any error still in there ? */
393 if (status & RXDES0_ANY_ERROR) {
394 ftgmac100_rx_packet_error(priv, status);
395 goto drop;
396 }
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000397 }
398
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000399 /* If the packet had no skb (failed to allocate earlier)
Benjamin Herrenschmidtd72e01a2017-04-06 11:02:45 +1000400 * then try to allocate one and skip
401 */
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000402 skb = priv->rx_skbs[pointer];
403 if (!unlikely(skb)) {
404 ftgmac100_alloc_rx_buf(priv, pointer, rxdes, GFP_ATOMIC);
Benjamin Herrenschmidt01dd70b2017-04-06 11:02:48 +1000405 goto drop;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000406 }
407
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000408 if (unlikely(status & FTGMAC100_RXDES0_MULTICAST))
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000409 netdev->stats.multicast++;
410
Benjamin Herrenschmidt67202192017-04-06 11:02:46 +1000411 /* If the HW found checksum errors, bounce it to software.
412 *
413 * If we didn't, we need to see if the packet was recognized
414 * by HW as one of the supported checksummed protocols before
415 * we accept the HW test results.
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000416 */
Benjamin Herrenschmidt67202192017-04-06 11:02:46 +1000417 if (netdev->features & NETIF_F_RXCSUM) {
Benjamin Herrenschmidtd9306552017-04-06 11:02:52 +1000418 u32 err_bits = FTGMAC100_RXDES1_TCP_CHKSUM_ERR |
419 FTGMAC100_RXDES1_UDP_CHKSUM_ERR |
420 FTGMAC100_RXDES1_IP_CHKSUM_ERR;
Benjamin Herrenschmidt67202192017-04-06 11:02:46 +1000421 if ((csum_vlan & err_bits) ||
Benjamin Herrenschmidtd9306552017-04-06 11:02:52 +1000422 !(csum_vlan & FTGMAC100_RXDES1_PROT_MASK))
Benjamin Herrenschmidt67202192017-04-06 11:02:46 +1000423 skb->ip_summed = CHECKSUM_NONE;
424 else
425 skb->ip_summed = CHECKSUM_UNNECESSARY;
426 }
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000427
Benjamin Herrenschmidtd9306552017-04-06 11:02:52 +1000428 /* Transfer received size to skb */
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000429 skb_put(skb, size);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000430
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000431 /* Tear down DMA mapping, do necessary cache management */
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000432 map = le32_to_cpu(rxdes->rxdes3);
433
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000434#if defined(CONFIG_ARM) && !defined(CONFIG_ARM_DMA_USE_IOMMU)
435 /* When we don't have an iommu, we can save cycles by not
436 * invalidating the cache for the part of the packet that
437 * wasn't received.
438 */
439 dma_unmap_single(priv->dev, map, size, DMA_FROM_DEVICE);
440#else
441 dma_unmap_single(priv->dev, map, RX_BUF_SIZE, DMA_FROM_DEVICE);
442#endif
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000443
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000444
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000445 /* Resplenish rx ring */
446 ftgmac100_alloc_rx_buf(priv, pointer, rxdes, GFP_ATOMIC);
Benjamin Herrenschmidt01dd70b2017-04-06 11:02:48 +1000447 priv->rx_pointer = ftgmac100_next_rx_pointer(pointer);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000448
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000449 skb->protocol = eth_type_trans(skb, netdev);
450
451 netdev->stats.rx_packets++;
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000452 netdev->stats.rx_bytes += size;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000453
454 /* push packet to protocol stack */
Benjamin Herrenschmidt67202192017-04-06 11:02:46 +1000455 if (skb->ip_summed == CHECKSUM_NONE)
456 netif_receive_skb(skb);
457 else
458 napi_gro_receive(&priv->napi, skb);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000459
460 (*processed)++;
461 return true;
Benjamin Herrenschmidt01dd70b2017-04-06 11:02:48 +1000462
463 drop:
464 /* Clean rxdes0 (which resets own bit) */
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000465 rxdes->rxdes0 = cpu_to_le32(status & priv->rxdes0_edorr_mask);
Benjamin Herrenschmidt01dd70b2017-04-06 11:02:48 +1000466 priv->rx_pointer = ftgmac100_next_rx_pointer(pointer);
467 netdev->stats.rx_dropped++;
468 return true;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000469}
470
Andrew Jeffery7906a4d2016-09-22 08:34:59 +0930471static void ftgmac100_txdes_reset(const struct ftgmac100 *priv,
472 struct ftgmac100_txdes *txdes)
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000473{
474 /* clear all except end of ring bit */
Andrew Jeffery7906a4d2016-09-22 08:34:59 +0930475 txdes->txdes0 &= cpu_to_le32(priv->txdes0_edotr_mask);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000476 txdes->txdes1 = 0;
477 txdes->txdes2 = 0;
478 txdes->txdes3 = 0;
479}
480
481static bool ftgmac100_txdes_owned_by_dma(struct ftgmac100_txdes *txdes)
482{
483 return txdes->txdes0 & cpu_to_le32(FTGMAC100_TXDES0_TXDMA_OWN);
484}
485
486static void ftgmac100_txdes_set_dma_own(struct ftgmac100_txdes *txdes)
487{
488 /*
489 * Make sure dma own bit will not be set before any other
490 * descriptor fields.
491 */
492 wmb();
493 txdes->txdes0 |= cpu_to_le32(FTGMAC100_TXDES0_TXDMA_OWN);
494}
495
Andrew Jeffery7906a4d2016-09-22 08:34:59 +0930496static void ftgmac100_txdes_set_end_of_ring(const struct ftgmac100 *priv,
497 struct ftgmac100_txdes *txdes)
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000498{
Andrew Jeffery7906a4d2016-09-22 08:34:59 +0930499 txdes->txdes0 |= cpu_to_le32(priv->txdes0_edotr_mask);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000500}
501
502static void ftgmac100_txdes_set_first_segment(struct ftgmac100_txdes *txdes)
503{
504 txdes->txdes0 |= cpu_to_le32(FTGMAC100_TXDES0_FTS);
505}
506
507static void ftgmac100_txdes_set_last_segment(struct ftgmac100_txdes *txdes)
508{
509 txdes->txdes0 |= cpu_to_le32(FTGMAC100_TXDES0_LTS);
510}
511
512static void ftgmac100_txdes_set_buffer_size(struct ftgmac100_txdes *txdes,
513 unsigned int len)
514{
515 txdes->txdes0 |= cpu_to_le32(FTGMAC100_TXDES0_TXBUF_SIZE(len));
516}
517
518static void ftgmac100_txdes_set_txint(struct ftgmac100_txdes *txdes)
519{
520 txdes->txdes1 |= cpu_to_le32(FTGMAC100_TXDES1_TXIC);
521}
522
523static void ftgmac100_txdes_set_tcpcs(struct ftgmac100_txdes *txdes)
524{
525 txdes->txdes1 |= cpu_to_le32(FTGMAC100_TXDES1_TCP_CHKSUM);
526}
527
528static void ftgmac100_txdes_set_udpcs(struct ftgmac100_txdes *txdes)
529{
530 txdes->txdes1 |= cpu_to_le32(FTGMAC100_TXDES1_UDP_CHKSUM);
531}
532
533static void ftgmac100_txdes_set_ipcs(struct ftgmac100_txdes *txdes)
534{
535 txdes->txdes1 |= cpu_to_le32(FTGMAC100_TXDES1_IP_CHKSUM);
536}
537
538static void ftgmac100_txdes_set_dma_addr(struct ftgmac100_txdes *txdes,
539 dma_addr_t addr)
540{
541 txdes->txdes3 = cpu_to_le32(addr);
542}
543
544static dma_addr_t ftgmac100_txdes_get_dma_addr(struct ftgmac100_txdes *txdes)
545{
546 return le32_to_cpu(txdes->txdes3);
547}
548
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000549static int ftgmac100_next_tx_pointer(int pointer)
550{
551 return (pointer + 1) & (TX_QUEUE_ENTRIES - 1);
552}
553
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000554static bool ftgmac100_tx_complete_packet(struct ftgmac100 *priv)
555{
556 struct net_device *netdev = priv->netdev;
557 struct ftgmac100_txdes *txdes;
Benjamin Herrenschmidt83617312017-04-10 11:15:20 +1000558 unsigned int pointer;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000559 struct sk_buff *skb;
560 dma_addr_t map;
561
562 if (priv->tx_pending == 0)
563 return false;
564
Benjamin Herrenschmidt83617312017-04-10 11:15:20 +1000565 pointer = priv->tx_clean_pointer;
566 txdes = &priv->descs->txdes[pointer];
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000567
568 if (ftgmac100_txdes_owned_by_dma(txdes))
569 return false;
570
Benjamin Herrenschmidt83617312017-04-10 11:15:20 +1000571 skb = priv->tx_skbs[pointer];
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000572 map = ftgmac100_txdes_get_dma_addr(txdes);
573
574 netdev->stats.tx_packets++;
575 netdev->stats.tx_bytes += skb->len;
576
577 dma_unmap_single(priv->dev, map, skb_headlen(skb), DMA_TO_DEVICE);
578
579 dev_kfree_skb(skb);
Benjamin Herrenschmidt83617312017-04-10 11:15:20 +1000580 priv->tx_skbs[pointer] = NULL;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000581
Andrew Jeffery7906a4d2016-09-22 08:34:59 +0930582 ftgmac100_txdes_reset(priv, txdes);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000583
Benjamin Herrenschmidt83617312017-04-10 11:15:20 +1000584 priv->tx_clean_pointer = ftgmac100_next_tx_pointer(pointer);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000585
586 spin_lock(&priv->tx_lock);
587 priv->tx_pending--;
588 spin_unlock(&priv->tx_lock);
589 netif_wake_queue(netdev);
590
591 return true;
592}
593
594static void ftgmac100_tx_complete(struct ftgmac100 *priv)
595{
596 while (ftgmac100_tx_complete_packet(priv))
597 ;
598}
599
Benjamin Herrenschmidt43b25ee2017-04-10 11:15:17 +1000600static int ftgmac100_hard_start_xmit(struct sk_buff *skb,
601 struct net_device *netdev)
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000602{
Benjamin Herrenschmidt43b25ee2017-04-10 11:15:17 +1000603 struct ftgmac100 *priv = netdev_priv(netdev);
604 struct ftgmac100_txdes *txdes;
Benjamin Herrenschmidt83617312017-04-10 11:15:20 +1000605 unsigned int pointer;
Benjamin Herrenschmidt43b25ee2017-04-10 11:15:17 +1000606 dma_addr_t map;
607
Benjamin Herrenschmidt9b0f7712017-04-10 11:15:19 +1000608 /* The HW doesn't pad small frames */
609 if (eth_skb_pad(skb)) {
610 netdev->stats.tx_dropped++;
611 return NETDEV_TX_OK;
612 }
613
614 /* Reject oversize packets */
Benjamin Herrenschmidt43b25ee2017-04-10 11:15:17 +1000615 if (unlikely(skb->len > MAX_PKT_SIZE)) {
616 if (net_ratelimit())
617 netdev_dbg(netdev, "tx packet too big\n");
Benjamin Herrenschmidt3e427a32017-04-10 11:15:18 +1000618 goto drop;
Benjamin Herrenschmidt43b25ee2017-04-10 11:15:17 +1000619 }
620
621 map = dma_map_single(priv->dev, skb->data, skb_headlen(skb), DMA_TO_DEVICE);
622 if (unlikely(dma_mapping_error(priv->dev, map))) {
623 /* drop packet */
624 if (net_ratelimit())
625 netdev_err(netdev, "map socket buffer failed\n");
Benjamin Herrenschmidt3e427a32017-04-10 11:15:18 +1000626 goto drop;
Benjamin Herrenschmidt43b25ee2017-04-10 11:15:17 +1000627 }
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000628
Benjamin Herrenschmidt83617312017-04-10 11:15:20 +1000629 /* Grab the next free tx descriptor */
630 pointer = priv->tx_pointer;
631 txdes = &priv->descs->txdes[pointer];
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000632
633 /* setup TX descriptor */
Benjamin Herrenschmidt83617312017-04-10 11:15:20 +1000634 priv->tx_skbs[pointer] = skb;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000635 ftgmac100_txdes_set_dma_addr(txdes, map);
Benjamin Herrenschmidt9b0f7712017-04-10 11:15:19 +1000636 ftgmac100_txdes_set_buffer_size(txdes, skb->len);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000637
638 ftgmac100_txdes_set_first_segment(txdes);
639 ftgmac100_txdes_set_last_segment(txdes);
640 ftgmac100_txdes_set_txint(txdes);
641 if (skb->ip_summed == CHECKSUM_PARTIAL) {
642 __be16 protocol = skb->protocol;
643
644 if (protocol == cpu_to_be16(ETH_P_IP)) {
645 u8 ip_proto = ip_hdr(skb)->protocol;
646
647 ftgmac100_txdes_set_ipcs(txdes);
648 if (ip_proto == IPPROTO_TCP)
649 ftgmac100_txdes_set_tcpcs(txdes);
650 else if (ip_proto == IPPROTO_UDP)
651 ftgmac100_txdes_set_udpcs(txdes);
652 }
653 }
654
Benjamin Herrenschmidt83617312017-04-10 11:15:20 +1000655 /* Update next TX pointer */
656 priv->tx_pointer = ftgmac100_next_tx_pointer(pointer);
657
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000658 spin_lock(&priv->tx_lock);
659 priv->tx_pending++;
660 if (priv->tx_pending == TX_QUEUE_ENTRIES)
661 netif_stop_queue(netdev);
662
663 /* start transmit */
664 ftgmac100_txdes_set_dma_own(txdes);
665 spin_unlock(&priv->tx_lock);
666
667 ftgmac100_txdma_normal_prio_start_polling(priv);
668
669 return NETDEV_TX_OK;
Benjamin Herrenschmidt3e427a32017-04-10 11:15:18 +1000670
671 drop:
672 /* Drop the packet */
673 dev_kfree_skb_any(skb);
674 netdev->stats.tx_dropped++;
675
676 return NETDEV_TX_OK;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000677}
678
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000679static void ftgmac100_free_buffers(struct ftgmac100 *priv)
680{
681 int i;
682
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +1000683 /* Free all RX buffers */
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000684 for (i = 0; i < RX_QUEUE_ENTRIES; i++) {
685 struct ftgmac100_rxdes *rxdes = &priv->descs->rxdes[i];
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000686 struct sk_buff *skb = priv->rx_skbs[i];
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000687 dma_addr_t map = le32_to_cpu(rxdes->rxdes3);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000688
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000689 if (!skb)
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000690 continue;
691
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000692 priv->rx_skbs[i] = NULL;
693 dma_unmap_single(priv->dev, map, RX_BUF_SIZE, DMA_FROM_DEVICE);
694 dev_kfree_skb_any(skb);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000695 }
696
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +1000697 /* Free all TX buffers */
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000698 for (i = 0; i < TX_QUEUE_ENTRIES; i++) {
699 struct ftgmac100_txdes *txdes = &priv->descs->txdes[i];
Benjamin Herrenschmidt83617312017-04-10 11:15:20 +1000700 struct sk_buff *skb = priv->tx_skbs[i];
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000701 dma_addr_t map = ftgmac100_txdes_get_dma_addr(txdes);
702
703 if (!skb)
704 continue;
705
706 dma_unmap_single(priv->dev, map, skb_headlen(skb), DMA_TO_DEVICE);
Eric Dumazet0113e342014-01-16 23:38:24 -0800707 kfree_skb(skb);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000708 }
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000709}
710
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +1000711static void ftgmac100_free_rings(struct ftgmac100 *priv)
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000712{
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +1000713 /* Free descriptors */
714 if (priv->descs)
715 dma_free_coherent(priv->dev, sizeof(struct ftgmac100_descs),
716 priv->descs, priv->descs_dma_addr);
Benjamin Herrenschmidtd72e01a2017-04-06 11:02:45 +1000717
718 /* Free scratch packet buffer */
719 if (priv->rx_scratch)
720 dma_free_coherent(priv->dev, RX_BUF_SIZE,
721 priv->rx_scratch, priv->rx_scratch_dma);
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +1000722}
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000723
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +1000724static int ftgmac100_alloc_rings(struct ftgmac100 *priv)
725{
726 /* Allocate descriptors */
Joe Perchesede23fa82013-08-26 22:45:23 -0700727 priv->descs = dma_zalloc_coherent(priv->dev,
728 sizeof(struct ftgmac100_descs),
729 &priv->descs_dma_addr, GFP_KERNEL);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000730 if (!priv->descs)
731 return -ENOMEM;
732
Benjamin Herrenschmidtd72e01a2017-04-06 11:02:45 +1000733 /* Allocate scratch packet buffer */
734 priv->rx_scratch = dma_alloc_coherent(priv->dev,
735 RX_BUF_SIZE,
736 &priv->rx_scratch_dma,
737 GFP_KERNEL);
738 if (!priv->rx_scratch)
739 return -ENOMEM;
740
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +1000741 return 0;
742}
743
744static void ftgmac100_init_rings(struct ftgmac100 *priv)
745{
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000746 struct ftgmac100_rxdes *rxdes;
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +1000747 int i;
748
749 /* Initialize RX ring */
Benjamin Herrenschmidtd72e01a2017-04-06 11:02:45 +1000750 for (i = 0; i < RX_QUEUE_ENTRIES; i++) {
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000751 rxdes = &priv->descs->rxdes[i];
Benjamin Herrenschmidtd72e01a2017-04-06 11:02:45 +1000752 rxdes->rxdes0 = 0;
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000753 rxdes->rxdes3 = cpu_to_le32(priv->rx_scratch_dma);
Benjamin Herrenschmidtd72e01a2017-04-06 11:02:45 +1000754 }
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000755 /* Mark the end of the ring */
756 rxdes->rxdes0 |= cpu_to_le32(priv->rxdes0_edorr_mask);
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +1000757
758 /* Initialize TX ring */
759 for (i = 0; i < TX_QUEUE_ENTRIES; i++)
760 priv->descs->txdes[i].txdes0 = 0;
761 ftgmac100_txdes_set_end_of_ring(priv, &priv->descs->txdes[i -1]);
762}
763
764static int ftgmac100_alloc_rx_buffers(struct ftgmac100 *priv)
765{
766 int i;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000767
768 for (i = 0; i < RX_QUEUE_ENTRIES; i++) {
769 struct ftgmac100_rxdes *rxdes = &priv->descs->rxdes[i];
770
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000771 if (ftgmac100_alloc_rx_buf(priv, i, rxdes, GFP_KERNEL))
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +1000772 return -ENOMEM;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000773 }
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000774 return 0;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000775}
776
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000777static void ftgmac100_adjust_link(struct net_device *netdev)
778{
779 struct ftgmac100 *priv = netdev_priv(netdev);
Philippe Reynesb3c40ad2016-05-16 01:35:13 +0200780 struct phy_device *phydev = netdev->phydev;
Benjamin Herrenschmidt51764772017-04-05 12:28:45 +1000781 int new_speed;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000782
Benjamin Herrenschmidt51764772017-04-05 12:28:45 +1000783 /* We store "no link" as speed 0 */
784 if (!phydev->link)
785 new_speed = 0;
786 else
787 new_speed = phydev->speed;
788
789 if (phydev->speed == priv->cur_speed &&
790 phydev->duplex == priv->cur_duplex)
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000791 return;
792
Benjamin Herrenschmidt51764772017-04-05 12:28:45 +1000793 /* Print status if we have a link or we had one and just lost it,
794 * don't print otherwise.
795 */
796 if (new_speed || priv->cur_speed)
797 phy_print_status(phydev);
798
799 priv->cur_speed = new_speed;
800 priv->cur_duplex = phydev->duplex;
801
802 /* Link is down, do nothing else */
803 if (!new_speed)
804 return;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000805
Benjamin Herrenschmidt855944c2017-04-05 12:28:50 +1000806 /* Disable all interrupts */
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000807 iowrite32(0, priv->base + FTGMAC100_OFFSET_IER);
808
Benjamin Herrenschmidt855944c2017-04-05 12:28:50 +1000809 /* Reset the adapter asynchronously */
810 schedule_work(&priv->reset_task);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000811}
812
813static int ftgmac100_mii_probe(struct ftgmac100 *priv)
814{
815 struct net_device *netdev = priv->netdev;
Guenter Roecke574f392016-01-10 12:04:32 -0800816 struct phy_device *phydev;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000817
Guenter Roecke574f392016-01-10 12:04:32 -0800818 phydev = phy_find_first(priv->mii_bus);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000819 if (!phydev) {
820 netdev_info(netdev, "%s: no PHY found\n", netdev->name);
821 return -ENODEV;
822 }
823
Andrew Lunn84eff6d2016-01-06 20:11:10 +0100824 phydev = phy_connect(netdev, phydev_name(phydev),
Florian Fainellif9a8f832013-01-14 00:52:52 +0000825 &ftgmac100_adjust_link, PHY_INTERFACE_MODE_GMII);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000826
827 if (IS_ERR(phydev)) {
828 netdev_err(netdev, "%s: Could not attach to PHY\n", netdev->name);
829 return PTR_ERR(phydev);
830 }
831
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000832 return 0;
833}
834
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000835static int ftgmac100_mdiobus_read(struct mii_bus *bus, int phy_addr, int regnum)
836{
837 struct net_device *netdev = bus->priv;
838 struct ftgmac100 *priv = netdev_priv(netdev);
839 unsigned int phycr;
840 int i;
841
842 phycr = ioread32(priv->base + FTGMAC100_OFFSET_PHYCR);
843
844 /* preserve MDC cycle threshold */
845 phycr &= FTGMAC100_PHYCR_MDC_CYCTHR_MASK;
846
847 phycr |= FTGMAC100_PHYCR_PHYAD(phy_addr) |
848 FTGMAC100_PHYCR_REGAD(regnum) |
849 FTGMAC100_PHYCR_MIIRD;
850
851 iowrite32(phycr, priv->base + FTGMAC100_OFFSET_PHYCR);
852
853 for (i = 0; i < 10; i++) {
854 phycr = ioread32(priv->base + FTGMAC100_OFFSET_PHYCR);
855
856 if ((phycr & FTGMAC100_PHYCR_MIIRD) == 0) {
857 int data;
858
859 data = ioread32(priv->base + FTGMAC100_OFFSET_PHYDATA);
860 return FTGMAC100_PHYDATA_MIIRDATA(data);
861 }
862
863 udelay(100);
864 }
865
866 netdev_err(netdev, "mdio read timed out\n");
867 return -EIO;
868}
869
870static int ftgmac100_mdiobus_write(struct mii_bus *bus, int phy_addr,
871 int regnum, u16 value)
872{
873 struct net_device *netdev = bus->priv;
874 struct ftgmac100 *priv = netdev_priv(netdev);
875 unsigned int phycr;
876 int data;
877 int i;
878
879 phycr = ioread32(priv->base + FTGMAC100_OFFSET_PHYCR);
880
881 /* preserve MDC cycle threshold */
882 phycr &= FTGMAC100_PHYCR_MDC_CYCTHR_MASK;
883
884 phycr |= FTGMAC100_PHYCR_PHYAD(phy_addr) |
885 FTGMAC100_PHYCR_REGAD(regnum) |
886 FTGMAC100_PHYCR_MIIWR;
887
888 data = FTGMAC100_PHYDATA_MIIWDATA(value);
889
890 iowrite32(data, priv->base + FTGMAC100_OFFSET_PHYDATA);
891 iowrite32(phycr, priv->base + FTGMAC100_OFFSET_PHYCR);
892
893 for (i = 0; i < 10; i++) {
894 phycr = ioread32(priv->base + FTGMAC100_OFFSET_PHYCR);
895
896 if ((phycr & FTGMAC100_PHYCR_MIIWR) == 0)
897 return 0;
898
899 udelay(100);
900 }
901
902 netdev_err(netdev, "mdio write timed out\n");
903 return -EIO;
904}
905
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000906static void ftgmac100_get_drvinfo(struct net_device *netdev,
907 struct ethtool_drvinfo *info)
908{
Jiri Pirko7826d432013-01-06 00:44:26 +0000909 strlcpy(info->driver, DRV_NAME, sizeof(info->driver));
910 strlcpy(info->version, DRV_VERSION, sizeof(info->version));
911 strlcpy(info->bus_info, dev_name(&netdev->dev), sizeof(info->bus_info));
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000912}
913
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000914static const struct ethtool_ops ftgmac100_ethtool_ops = {
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000915 .get_drvinfo = ftgmac100_get_drvinfo,
916 .get_link = ethtool_op_get_link,
Philippe Reynesfd24d722016-05-16 01:35:14 +0200917 .get_link_ksettings = phy_ethtool_get_link_ksettings,
918 .set_link_ksettings = phy_ethtool_set_link_ksettings,
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000919};
920
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000921static irqreturn_t ftgmac100_interrupt(int irq, void *dev_id)
922{
923 struct net_device *netdev = dev_id;
924 struct ftgmac100 *priv = netdev_priv(netdev);
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +1000925 unsigned int status, new_mask = FTGMAC100_INT_BAD;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000926
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +1000927 /* Fetch and clear interrupt bits, process abnormal ones */
928 status = ioread32(priv->base + FTGMAC100_OFFSET_ISR);
929 iowrite32(status, priv->base + FTGMAC100_OFFSET_ISR);
930 if (unlikely(status & FTGMAC100_INT_BAD)) {
931
932 /* RX buffer unavailable */
933 if (status & FTGMAC100_INT_NO_RXBUF)
934 netdev->stats.rx_over_errors++;
935
936 /* received packet lost due to RX FIFO full */
937 if (status & FTGMAC100_INT_RPKT_LOST)
938 netdev->stats.rx_fifo_errors++;
939
940 /* sent packet lost due to excessive TX collision */
941 if (status & FTGMAC100_INT_XPKT_LOST)
942 netdev->stats.tx_fifo_errors++;
943
944 /* AHB error -> Reset the chip */
945 if (status & FTGMAC100_INT_AHB_ERR) {
946 if (net_ratelimit())
947 netdev_warn(netdev,
948 "AHB bus error ! Resetting chip.\n");
949 iowrite32(0, priv->base + FTGMAC100_OFFSET_IER);
950 schedule_work(&priv->reset_task);
951 return IRQ_HANDLED;
952 }
953
954 /* We may need to restart the MAC after such errors, delay
955 * this until after we have freed some Rx buffers though
956 */
957 priv->need_mac_restart = true;
958
959 /* Disable those errors until we restart */
960 new_mask &= ~status;
961 }
962
963 /* Only enable "bad" interrupts while NAPI is on */
964 iowrite32(new_mask, priv->base + FTGMAC100_OFFSET_IER);
965
966 /* Schedule NAPI bh */
967 napi_schedule_irqoff(&priv->napi);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000968
969 return IRQ_HANDLED;
970}
971
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000972static bool ftgmac100_check_rx(struct ftgmac100 *priv)
973{
974 struct ftgmac100_rxdes *rxdes = &priv->descs->rxdes[priv->rx_pointer];
975
976 /* Do we have a packet ? */
977 return !!(rxdes->rxdes0 & cpu_to_le32(FTGMAC100_RXDES0_RXPKT_RDY));
978}
979
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000980static int ftgmac100_poll(struct napi_struct *napi, int budget)
981{
982 struct ftgmac100 *priv = container_of(napi, struct ftgmac100, napi);
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +1000983 bool more, completed = true;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000984 int rx = 0;
985
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +1000986 ftgmac100_tx_complete(priv);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000987
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +1000988 do {
989 more = ftgmac100_rx_packet(priv, &rx);
990 } while (more && rx < budget);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000991
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +1000992 if (more && rx == budget)
993 completed = false;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000994
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +1000995
996 /* The interrupt is telling us to kick the MAC back to life
997 * after an RX overflow
998 */
999 if (unlikely(priv->need_mac_restart)) {
1000 ftgmac100_start_hw(priv);
1001
1002 /* Re-enable "bad" interrupts */
1003 iowrite32(FTGMAC100_INT_BAD,
1004 priv->base + FTGMAC100_OFFSET_IER);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001005 }
1006
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +10001007 /* Keep NAPI going if we have still packets to reclaim */
1008 if (priv->tx_pending)
1009 return budget;
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001010
1011 if (completed) {
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +10001012 /* We are about to re-enable all interrupts. However
1013 * the HW has been latching RX/TX packet interrupts while
1014 * they were masked. So we clear them first, then we need
1015 * to re-check if there's something to process
1016 */
1017 iowrite32(FTGMAC100_INT_RXTX,
1018 priv->base + FTGMAC100_OFFSET_ISR);
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +10001019 if (ftgmac100_check_rx(priv) || priv->tx_pending)
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +10001020 return budget;
1021
1022 /* deschedule NAPI */
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001023 napi_complete(napi);
1024
1025 /* enable all interrupts */
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +10001026 iowrite32(FTGMAC100_INT_ALL,
Gavin Shanfc6061c2016-07-19 11:54:25 +10001027 priv->base + FTGMAC100_OFFSET_IER);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001028 }
1029
1030 return rx;
1031}
1032
Benjamin Herrenschmidtda40d9d2017-04-05 12:28:49 +10001033static int ftgmac100_init_all(struct ftgmac100 *priv, bool ignore_alloc_err)
1034{
1035 int err = 0;
1036
1037 /* Re-init descriptors (adjust queue sizes) */
1038 ftgmac100_init_rings(priv);
1039
1040 /* Realloc rx descriptors */
1041 err = ftgmac100_alloc_rx_buffers(priv);
1042 if (err && !ignore_alloc_err)
1043 return err;
1044
1045 /* Reinit and restart HW */
1046 ftgmac100_init_hw(priv);
1047 ftgmac100_start_hw(priv);
1048
1049 /* Re-enable the device */
1050 napi_enable(&priv->napi);
1051 netif_start_queue(priv->netdev);
1052
1053 /* Enable all interrupts */
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +10001054 iowrite32(FTGMAC100_INT_ALL, priv->base + FTGMAC100_OFFSET_IER);
Benjamin Herrenschmidtda40d9d2017-04-05 12:28:49 +10001055
1056 return err;
1057}
1058
Benjamin Herrenschmidt855944c2017-04-05 12:28:50 +10001059static void ftgmac100_reset_task(struct work_struct *work)
1060{
1061 struct ftgmac100 *priv = container_of(work, struct ftgmac100,
1062 reset_task);
1063 struct net_device *netdev = priv->netdev;
1064 int err;
1065
1066 netdev_dbg(netdev, "Resetting NIC...\n");
1067
1068 /* Lock the world */
1069 rtnl_lock();
1070 if (netdev->phydev)
1071 mutex_lock(&netdev->phydev->lock);
1072 if (priv->mii_bus)
1073 mutex_lock(&priv->mii_bus->mdio_lock);
1074
1075
1076 /* Check if the interface is still up */
1077 if (!netif_running(netdev))
1078 goto bail;
1079
1080 /* Stop the network stack */
1081 netif_trans_update(netdev);
1082 napi_disable(&priv->napi);
1083 netif_tx_disable(netdev);
1084
1085 /* Stop and reset the MAC */
1086 ftgmac100_stop_hw(priv);
Benjamin Herrenschmidt874b55b2017-04-05 12:28:51 +10001087 err = ftgmac100_reset_and_config_mac(priv);
Benjamin Herrenschmidt855944c2017-04-05 12:28:50 +10001088 if (err) {
1089 /* Not much we can do ... it might come back... */
1090 netdev_err(netdev, "attempting to continue...\n");
1091 }
1092
1093 /* Free all rx and tx buffers */
1094 ftgmac100_free_buffers(priv);
1095
Benjamin Herrenschmidt855944c2017-04-05 12:28:50 +10001096 /* Setup everything again and restart chip */
1097 ftgmac100_init_all(priv, true);
1098
1099 netdev_dbg(netdev, "Reset done !\n");
1100 bail:
1101 if (priv->mii_bus)
1102 mutex_unlock(&priv->mii_bus->mdio_lock);
1103 if (netdev->phydev)
1104 mutex_unlock(&netdev->phydev->lock);
1105 rtnl_unlock();
1106}
1107
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001108static int ftgmac100_open(struct net_device *netdev)
1109{
1110 struct ftgmac100 *priv = netdev_priv(netdev);
1111 int err;
1112
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +10001113 /* Allocate ring buffers */
1114 err = ftgmac100_alloc_rings(priv);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001115 if (err) {
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +10001116 netdev_err(netdev, "Failed to allocate descriptors\n");
1117 return err;
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001118 }
1119
Benjamin Herrenschmidt51764772017-04-05 12:28:45 +10001120 /* When using NC-SI we force the speed to 100Mbit/s full duplex,
1121 *
1122 * Otherwise we leave it set to 0 (no link), the link
1123 * message from the PHY layer will handle setting it up to
1124 * something else if needed.
1125 */
1126 if (priv->use_ncsi) {
1127 priv->cur_duplex = DUPLEX_FULL;
1128 priv->cur_speed = SPEED_100;
1129 } else {
1130 priv->cur_duplex = 0;
1131 priv->cur_speed = 0;
1132 }
1133
Benjamin Herrenschmidt874b55b2017-04-05 12:28:51 +10001134 /* Reset the hardware */
1135 err = ftgmac100_reset_and_config_mac(priv);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001136 if (err)
1137 goto err_hw;
1138
Benjamin Herrenschmidtb8dbecf2017-04-05 12:28:47 +10001139 /* Initialize NAPI */
1140 netif_napi_add(netdev, &priv->napi, ftgmac100_poll, 64);
1141
Benjamin Herrenschmidt81f1eca2017-04-05 12:28:48 +10001142 /* Grab our interrupt */
1143 err = request_irq(netdev->irq, ftgmac100_interrupt, 0, netdev->name, netdev);
1144 if (err) {
1145 netdev_err(netdev, "failed to request irq %d\n", netdev->irq);
1146 goto err_irq;
1147 }
1148
Benjamin Herrenschmidtda40d9d2017-04-05 12:28:49 +10001149 /* Start things up */
1150 err = ftgmac100_init_all(priv, false);
1151 if (err) {
1152 netdev_err(netdev, "Failed to allocate packet buffers\n");
1153 goto err_alloc;
1154 }
Gavin Shan08c9c122016-09-22 08:35:01 +09301155
Benjamin Herrenschmidtda40d9d2017-04-05 12:28:49 +10001156 if (netdev->phydev) {
1157 /* If we have a PHY, start polling */
Gavin Shanbd466c32016-07-19 11:54:23 +10001158 phy_start(netdev->phydev);
Benjamin Herrenschmidtda40d9d2017-04-05 12:28:49 +10001159 } else if (priv->use_ncsi) {
1160 /* If using NC-SI, set our carrier on and start the stack */
Gavin Shanbd466c32016-07-19 11:54:23 +10001161 netif_carrier_on(netdev);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001162
Benjamin Herrenschmidtda40d9d2017-04-05 12:28:49 +10001163 /* Start the NCSI device */
Gavin Shanbd466c32016-07-19 11:54:23 +10001164 err = ncsi_start_dev(priv->ndev);
1165 if (err)
1166 goto err_ncsi;
1167 }
1168
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001169 return 0;
1170
Benjamin Herrenschmidtda40d9d2017-04-05 12:28:49 +10001171 err_ncsi:
Gavin Shanbd466c32016-07-19 11:54:23 +10001172 napi_disable(&priv->napi);
1173 netif_stop_queue(netdev);
Benjamin Herrenschmidtda40d9d2017-04-05 12:28:49 +10001174 err_alloc:
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +10001175 ftgmac100_free_buffers(priv);
Benjamin Herrenschmidtda40d9d2017-04-05 12:28:49 +10001176 free_irq(netdev->irq, netdev);
1177 err_irq:
1178 netif_napi_del(&priv->napi);
1179 err_hw:
1180 iowrite32(0, priv->base + FTGMAC100_OFFSET_IER);
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +10001181 ftgmac100_free_rings(priv);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001182 return err;
1183}
1184
1185static int ftgmac100_stop(struct net_device *netdev)
1186{
1187 struct ftgmac100 *priv = netdev_priv(netdev);
1188
Benjamin Herrenschmidt855944c2017-04-05 12:28:50 +10001189 /* Note about the reset task: We are called with the rtnl lock
1190 * held, so we are synchronized against the core of the reset
1191 * task. We must not try to synchronously cancel it otherwise
1192 * we can deadlock. But since it will test for netif_running()
1193 * which has already been cleared by the net core, we don't
1194 * anything special to do.
1195 */
1196
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001197 /* disable all interrupts */
1198 iowrite32(0, priv->base + FTGMAC100_OFFSET_IER);
1199
1200 netif_stop_queue(netdev);
1201 napi_disable(&priv->napi);
Benjamin Herrenschmidtb8dbecf2017-04-05 12:28:47 +10001202 netif_napi_del(&priv->napi);
Gavin Shanbd466c32016-07-19 11:54:23 +10001203 if (netdev->phydev)
1204 phy_stop(netdev->phydev);
Gavin Shan2c15f252016-10-04 11:25:54 +11001205 else if (priv->use_ncsi)
1206 ncsi_stop_dev(priv->ndev);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001207
1208 ftgmac100_stop_hw(priv);
Benjamin Herrenschmidt60b28a12017-04-05 12:28:41 +10001209 free_irq(netdev->irq, netdev);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001210 ftgmac100_free_buffers(priv);
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +10001211 ftgmac100_free_rings(priv);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001212
1213 return 0;
1214}
1215
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001216/* optional */
1217static int ftgmac100_do_ioctl(struct net_device *netdev, struct ifreq *ifr, int cmd)
1218{
Gavin Shanbd466c32016-07-19 11:54:23 +10001219 if (!netdev->phydev)
1220 return -ENXIO;
1221
Philippe Reynesb3c40ad2016-05-16 01:35:13 +02001222 return phy_mii_ioctl(netdev->phydev, ifr, cmd);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001223}
1224
Benjamin Herrenschmidtd3ca8fb2017-04-10 11:15:15 +10001225static void ftgmac100_tx_timeout(struct net_device *netdev)
1226{
1227 struct ftgmac100 *priv = netdev_priv(netdev);
1228
1229 /* Disable all interrupts */
1230 iowrite32(0, priv->base + FTGMAC100_OFFSET_IER);
1231
1232 /* Do the reset outside of interrupt context */
1233 schedule_work(&priv->reset_task);
1234}
1235
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001236static const struct net_device_ops ftgmac100_netdev_ops = {
1237 .ndo_open = ftgmac100_open,
1238 .ndo_stop = ftgmac100_stop,
1239 .ndo_start_xmit = ftgmac100_hard_start_xmit,
Gavin Shan113ce102016-07-19 11:54:22 +10001240 .ndo_set_mac_address = ftgmac100_set_mac_addr,
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001241 .ndo_validate_addr = eth_validate_addr,
1242 .ndo_do_ioctl = ftgmac100_do_ioctl,
Benjamin Herrenschmidtd3ca8fb2017-04-10 11:15:15 +10001243 .ndo_tx_timeout = ftgmac100_tx_timeout,
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001244};
1245
Gavin Shaneb418182016-07-19 11:54:21 +10001246static int ftgmac100_setup_mdio(struct net_device *netdev)
1247{
1248 struct ftgmac100 *priv = netdev_priv(netdev);
1249 struct platform_device *pdev = to_platform_device(priv->dev);
1250 int i, err = 0;
Joel Stanleye07dc632016-09-22 08:35:02 +09301251 u32 reg;
Gavin Shaneb418182016-07-19 11:54:21 +10001252
1253 /* initialize mdio bus */
1254 priv->mii_bus = mdiobus_alloc();
1255 if (!priv->mii_bus)
1256 return -EIO;
1257
Joel Stanleye07dc632016-09-22 08:35:02 +09301258 if (of_machine_is_compatible("aspeed,ast2400") ||
1259 of_machine_is_compatible("aspeed,ast2500")) {
1260 /* This driver supports the old MDIO interface */
1261 reg = ioread32(priv->base + FTGMAC100_OFFSET_REVR);
1262 reg &= ~FTGMAC100_REVR_NEW_MDIO_INTERFACE;
1263 iowrite32(reg, priv->base + FTGMAC100_OFFSET_REVR);
1264 };
1265
Gavin Shaneb418182016-07-19 11:54:21 +10001266 priv->mii_bus->name = "ftgmac100_mdio";
1267 snprintf(priv->mii_bus->id, MII_BUS_ID_SIZE, "%s-%d",
1268 pdev->name, pdev->id);
1269 priv->mii_bus->priv = priv->netdev;
1270 priv->mii_bus->read = ftgmac100_mdiobus_read;
1271 priv->mii_bus->write = ftgmac100_mdiobus_write;
1272
1273 for (i = 0; i < PHY_MAX_ADDR; i++)
1274 priv->mii_bus->irq[i] = PHY_POLL;
1275
1276 err = mdiobus_register(priv->mii_bus);
1277 if (err) {
1278 dev_err(priv->dev, "Cannot register MDIO bus!\n");
1279 goto err_register_mdiobus;
1280 }
1281
1282 err = ftgmac100_mii_probe(priv);
1283 if (err) {
1284 dev_err(priv->dev, "MII Probe failed!\n");
1285 goto err_mii_probe;
1286 }
1287
1288 return 0;
1289
1290err_mii_probe:
1291 mdiobus_unregister(priv->mii_bus);
1292err_register_mdiobus:
1293 mdiobus_free(priv->mii_bus);
1294 return err;
1295}
1296
1297static void ftgmac100_destroy_mdio(struct net_device *netdev)
1298{
1299 struct ftgmac100 *priv = netdev_priv(netdev);
1300
1301 if (!netdev->phydev)
1302 return;
1303
1304 phy_disconnect(netdev->phydev);
1305 mdiobus_unregister(priv->mii_bus);
1306 mdiobus_free(priv->mii_bus);
1307}
1308
Gavin Shanbd466c32016-07-19 11:54:23 +10001309static void ftgmac100_ncsi_handler(struct ncsi_dev *nd)
1310{
1311 if (unlikely(nd->state != ncsi_dev_state_functional))
1312 return;
1313
1314 netdev_info(nd->dev, "NCSI interface %s\n",
1315 nd->link_up ? "up" : "down");
1316}
1317
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001318static int ftgmac100_probe(struct platform_device *pdev)
1319{
1320 struct resource *res;
1321 int irq;
1322 struct net_device *netdev;
1323 struct ftgmac100 *priv;
Gavin Shanbd466c32016-07-19 11:54:23 +10001324 int err = 0;
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001325
1326 if (!pdev)
1327 return -ENODEV;
1328
1329 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1330 if (!res)
1331 return -ENXIO;
1332
1333 irq = platform_get_irq(pdev, 0);
1334 if (irq < 0)
1335 return irq;
1336
1337 /* setup net_device */
1338 netdev = alloc_etherdev(sizeof(*priv));
1339 if (!netdev) {
1340 err = -ENOMEM;
1341 goto err_alloc_etherdev;
1342 }
1343
1344 SET_NETDEV_DEV(netdev, &pdev->dev);
1345
Wilfried Klaebe7ad24ea2014-05-11 00:12:32 +00001346 netdev->ethtool_ops = &ftgmac100_ethtool_ops;
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001347 netdev->netdev_ops = &ftgmac100_netdev_ops;
Benjamin Herrenschmidtd3ca8fb2017-04-10 11:15:15 +10001348 netdev->watchdog_timeo = 5 * HZ;
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001349
1350 platform_set_drvdata(pdev, netdev);
1351
1352 /* setup private data */
1353 priv = netdev_priv(netdev);
1354 priv->netdev = netdev;
1355 priv->dev = &pdev->dev;
Benjamin Herrenschmidt855944c2017-04-05 12:28:50 +10001356 INIT_WORK(&priv->reset_task, ftgmac100_reset_task);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001357
1358 spin_lock_init(&priv->tx_lock);
1359
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001360 /* map io memory */
1361 priv->res = request_mem_region(res->start, resource_size(res),
1362 dev_name(&pdev->dev));
1363 if (!priv->res) {
1364 dev_err(&pdev->dev, "Could not reserve memory region\n");
1365 err = -ENOMEM;
1366 goto err_req_mem;
1367 }
1368
1369 priv->base = ioremap(res->start, resource_size(res));
1370 if (!priv->base) {
1371 dev_err(&pdev->dev, "Failed to ioremap ethernet registers\n");
1372 err = -EIO;
1373 goto err_ioremap;
1374 }
1375
Benjamin Herrenschmidt60b28a12017-04-05 12:28:41 +10001376 netdev->irq = irq;
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001377
Gavin Shan113ce102016-07-19 11:54:22 +10001378 /* MAC address from chip or random one */
1379 ftgmac100_setup_mac(priv);
1380
Joel Stanley2a0ab8eb2016-09-22 08:35:00 +09301381 if (of_machine_is_compatible("aspeed,ast2400") ||
1382 of_machine_is_compatible("aspeed,ast2500")) {
1383 priv->rxdes0_edorr_mask = BIT(30);
1384 priv->txdes0_edotr_mask = BIT(30);
1385 } else {
1386 priv->rxdes0_edorr_mask = BIT(15);
1387 priv->txdes0_edotr_mask = BIT(15);
1388 }
1389
Gavin Shanbd466c32016-07-19 11:54:23 +10001390 if (pdev->dev.of_node &&
1391 of_get_property(pdev->dev.of_node, "use-ncsi", NULL)) {
1392 if (!IS_ENABLED(CONFIG_NET_NCSI)) {
1393 dev_err(&pdev->dev, "NCSI stack not enabled\n");
1394 goto err_ncsi_dev;
1395 }
1396
1397 dev_info(&pdev->dev, "Using NCSI interface\n");
1398 priv->use_ncsi = true;
1399 priv->ndev = ncsi_register_dev(netdev, ftgmac100_ncsi_handler);
1400 if (!priv->ndev)
1401 goto err_ncsi_dev;
1402 } else {
1403 priv->use_ncsi = false;
1404 err = ftgmac100_setup_mdio(netdev);
1405 if (err)
1406 goto err_setup_mdio;
1407 }
1408
1409 /* We have to disable on-chip IP checksum functionality
1410 * when NCSI is enabled on the interface. It doesn't work
1411 * in that case.
1412 */
Benjamin Herrenschmidt67202192017-04-06 11:02:46 +10001413 netdev->features = NETIF_F_RXCSUM | NETIF_F_IP_CSUM | NETIF_F_GRO;
Gavin Shanbd466c32016-07-19 11:54:23 +10001414 if (priv->use_ncsi &&
1415 of_get_property(pdev->dev.of_node, "no-hw-checksum", NULL))
1416 netdev->features &= ~NETIF_F_IP_CSUM;
1417
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001418
1419 /* register network device */
1420 err = register_netdev(netdev);
1421 if (err) {
1422 dev_err(&pdev->dev, "Failed to register netdev\n");
1423 goto err_register_netdev;
1424 }
1425
Benjamin Herrenschmidt60b28a12017-04-05 12:28:41 +10001426 netdev_info(netdev, "irq %d, mapped at %p\n", netdev->irq, priv->base);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001427
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001428 return 0;
1429
Gavin Shanbd466c32016-07-19 11:54:23 +10001430err_ncsi_dev:
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001431err_register_netdev:
Gavin Shaneb418182016-07-19 11:54:21 +10001432 ftgmac100_destroy_mdio(netdev);
1433err_setup_mdio:
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001434 iounmap(priv->base);
1435err_ioremap:
1436 release_resource(priv->res);
1437err_req_mem:
1438 netif_napi_del(&priv->napi);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001439 free_netdev(netdev);
1440err_alloc_etherdev:
1441 return err;
1442}
1443
Dmitry Torokhovbe125022017-03-01 17:24:47 -08001444static int ftgmac100_remove(struct platform_device *pdev)
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001445{
1446 struct net_device *netdev;
1447 struct ftgmac100 *priv;
1448
1449 netdev = platform_get_drvdata(pdev);
1450 priv = netdev_priv(netdev);
1451
1452 unregister_netdev(netdev);
Benjamin Herrenschmidt855944c2017-04-05 12:28:50 +10001453
1454 /* There's a small chance the reset task will have been re-queued,
1455 * during stop, make sure it's gone before we free the structure.
1456 */
1457 cancel_work_sync(&priv->reset_task);
1458
Gavin Shaneb418182016-07-19 11:54:21 +10001459 ftgmac100_destroy_mdio(netdev);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001460
1461 iounmap(priv->base);
1462 release_resource(priv->res);
1463
1464 netif_napi_del(&priv->napi);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001465 free_netdev(netdev);
1466 return 0;
1467}
1468
Gavin Shanbb168e22016-07-19 11:54:24 +10001469static const struct of_device_id ftgmac100_of_match[] = {
1470 { .compatible = "faraday,ftgmac100" },
1471 { }
1472};
1473MODULE_DEVICE_TABLE(of, ftgmac100_of_match);
1474
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001475static struct platform_driver ftgmac100_driver = {
Gavin Shanbb168e22016-07-19 11:54:24 +10001476 .probe = ftgmac100_probe,
Dmitry Torokhovbe125022017-03-01 17:24:47 -08001477 .remove = ftgmac100_remove,
Gavin Shanbb168e22016-07-19 11:54:24 +10001478 .driver = {
1479 .name = DRV_NAME,
1480 .of_match_table = ftgmac100_of_match,
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001481 },
1482};
Sachin Kamat14f645d2013-03-18 01:50:48 +00001483module_platform_driver(ftgmac100_driver);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001484
1485MODULE_AUTHOR("Po-Yu Chuang <ratbert@faraday-tech.com>");
1486MODULE_DESCRIPTION("FTGMAC100 driver");
1487MODULE_LICENSE("GPL");