blob: 41e8467f272a104192f657c37ba7f9674e256c64 [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 */
Po-Yu Chuang69785b72011-06-08 23:32:48 +000068 unsigned int tx_clean_pointer;
69 unsigned int tx_pointer;
70 unsigned int tx_pending;
Benjamin Herrenschmidt831fb332017-04-05 12:28:43 +100071 u32 txdes0_edotr_mask;
Po-Yu Chuang69785b72011-06-08 23:32:48 +000072 spinlock_t tx_lock;
73
Benjamin Herrenschmidtd72e01a2017-04-06 11:02:45 +100074 /* Scratch page to use when rx skb alloc fails */
75 void *rx_scratch;
76 dma_addr_t rx_scratch_dma;
77
Benjamin Herrenschmidt831fb332017-04-05 12:28:43 +100078 /* Component structures */
Po-Yu Chuang69785b72011-06-08 23:32:48 +000079 struct net_device *netdev;
80 struct device *dev;
Gavin Shanbd466c32016-07-19 11:54:23 +100081 struct ncsi_dev *ndev;
Po-Yu Chuang69785b72011-06-08 23:32:48 +000082 struct napi_struct napi;
Benjamin Herrenschmidt855944c2017-04-05 12:28:50 +100083 struct work_struct reset_task;
Po-Yu Chuang69785b72011-06-08 23:32:48 +000084 struct mii_bus *mii_bus;
Andrew Jeffery7906a4d2016-09-22 08:34:59 +093085
Benjamin Herrenschmidt831fb332017-04-05 12:28:43 +100086 /* Link management */
Benjamin Herrenschmidt51764772017-04-05 12:28:45 +100087 int cur_speed;
88 int cur_duplex;
Benjamin Herrenschmidt831fb332017-04-05 12:28:43 +100089 bool use_ncsi;
90
91 /* Misc */
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +100092 bool need_mac_restart;
Po-Yu Chuang69785b72011-06-08 23:32:48 +000093};
94
Po-Yu Chuang69785b72011-06-08 23:32:48 +000095static void ftgmac100_set_rx_ring_base(struct ftgmac100 *priv, dma_addr_t addr)
96{
97 iowrite32(addr, priv->base + FTGMAC100_OFFSET_RXR_BADR);
98}
99
100static void ftgmac100_set_rx_buffer_size(struct ftgmac100 *priv,
101 unsigned int size)
102{
103 size = FTGMAC100_RBSR_SIZE(size);
104 iowrite32(size, priv->base + FTGMAC100_OFFSET_RBSR);
105}
106
107static void ftgmac100_set_normal_prio_tx_ring_base(struct ftgmac100 *priv,
108 dma_addr_t addr)
109{
110 iowrite32(addr, priv->base + FTGMAC100_OFFSET_NPTXR_BADR);
111}
112
113static void ftgmac100_txdma_normal_prio_start_polling(struct ftgmac100 *priv)
114{
115 iowrite32(1, priv->base + FTGMAC100_OFFSET_NPTXPD);
116}
117
Benjamin Herrenschmidt874b55b2017-04-05 12:28:51 +1000118static int ftgmac100_reset_mac(struct ftgmac100 *priv, u32 maccr)
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000119{
120 struct net_device *netdev = priv->netdev;
121 int i;
122
123 /* NOTE: reset clears all registers */
Benjamin Herrenschmidt874b55b2017-04-05 12:28:51 +1000124 iowrite32(maccr, priv->base + FTGMAC100_OFFSET_MACCR);
125 iowrite32(maccr | FTGMAC100_MACCR_SW_RST,
126 priv->base + FTGMAC100_OFFSET_MACCR);
127 for (i = 0; i < 50; i++) {
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000128 unsigned int maccr;
129
130 maccr = ioread32(priv->base + FTGMAC100_OFFSET_MACCR);
131 if (!(maccr & FTGMAC100_MACCR_SW_RST))
132 return 0;
133
Benjamin Herrenschmidt874b55b2017-04-05 12:28:51 +1000134 udelay(1);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000135 }
136
Benjamin Herrenschmidt874b55b2017-04-05 12:28:51 +1000137 netdev_err(netdev, "Hardware reset failed\n");
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000138 return -EIO;
139}
140
Benjamin Herrenschmidt874b55b2017-04-05 12:28:51 +1000141static int ftgmac100_reset_and_config_mac(struct ftgmac100 *priv)
142{
143 u32 maccr = 0;
144
145 switch (priv->cur_speed) {
146 case SPEED_10:
147 case 0: /* no link */
148 break;
149
150 case SPEED_100:
151 maccr |= FTGMAC100_MACCR_FAST_MODE;
152 break;
153
154 case SPEED_1000:
155 maccr |= FTGMAC100_MACCR_GIGA_MODE;
156 break;
157 default:
158 netdev_err(priv->netdev, "Unknown speed %d !\n",
159 priv->cur_speed);
160 break;
161 }
162
163 /* (Re)initialize the queue pointers */
164 priv->rx_pointer = 0;
165 priv->tx_clean_pointer = 0;
166 priv->tx_pointer = 0;
167 priv->tx_pending = 0;
168
169 /* The doc says reset twice with 10us interval */
170 if (ftgmac100_reset_mac(priv, maccr))
171 return -EIO;
172 usleep_range(10, 1000);
173 return ftgmac100_reset_mac(priv, maccr);
174}
175
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000176static void ftgmac100_set_mac(struct ftgmac100 *priv, const unsigned char *mac)
177{
178 unsigned int maddr = mac[0] << 8 | mac[1];
179 unsigned int laddr = mac[2] << 24 | mac[3] << 16 | mac[4] << 8 | mac[5];
180
181 iowrite32(maddr, priv->base + FTGMAC100_OFFSET_MAC_MADR);
182 iowrite32(laddr, priv->base + FTGMAC100_OFFSET_MAC_LADR);
183}
184
Gavin Shan113ce102016-07-19 11:54:22 +1000185static void ftgmac100_setup_mac(struct ftgmac100 *priv)
186{
187 u8 mac[ETH_ALEN];
188 unsigned int m;
189 unsigned int l;
190 void *addr;
191
192 addr = device_get_mac_address(priv->dev, mac, ETH_ALEN);
193 if (addr) {
194 ether_addr_copy(priv->netdev->dev_addr, mac);
195 dev_info(priv->dev, "Read MAC address %pM from device tree\n",
196 mac);
197 return;
198 }
199
200 m = ioread32(priv->base + FTGMAC100_OFFSET_MAC_MADR);
201 l = ioread32(priv->base + FTGMAC100_OFFSET_MAC_LADR);
202
203 mac[0] = (m >> 8) & 0xff;
204 mac[1] = m & 0xff;
205 mac[2] = (l >> 24) & 0xff;
206 mac[3] = (l >> 16) & 0xff;
207 mac[4] = (l >> 8) & 0xff;
208 mac[5] = l & 0xff;
209
Gavin Shan113ce102016-07-19 11:54:22 +1000210 if (is_valid_ether_addr(mac)) {
211 ether_addr_copy(priv->netdev->dev_addr, mac);
212 dev_info(priv->dev, "Read MAC address %pM from chip\n", mac);
213 } else {
214 eth_hw_addr_random(priv->netdev);
215 dev_info(priv->dev, "Generated random MAC address %pM\n",
216 priv->netdev->dev_addr);
217 }
218}
219
220static int ftgmac100_set_mac_addr(struct net_device *dev, void *p)
221{
222 int ret;
223
224 ret = eth_prepare_mac_addr_change(dev, p);
225 if (ret < 0)
226 return ret;
227
228 eth_commit_mac_addr_change(dev, p);
229 ftgmac100_set_mac(netdev_priv(dev), dev->dev_addr);
230
231 return 0;
232}
233
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000234static void ftgmac100_init_hw(struct ftgmac100 *priv)
235{
236 /* setup ring buffer base registers */
237 ftgmac100_set_rx_ring_base(priv,
238 priv->descs_dma_addr +
239 offsetof(struct ftgmac100_descs, rxdes));
240 ftgmac100_set_normal_prio_tx_ring_base(priv,
241 priv->descs_dma_addr +
242 offsetof(struct ftgmac100_descs, txdes));
243
244 ftgmac100_set_rx_buffer_size(priv, RX_BUF_SIZE);
245
246 iowrite32(FTGMAC100_APTC_RXPOLL_CNT(1), priv->base + FTGMAC100_OFFSET_APTC);
247
248 ftgmac100_set_mac(priv, priv->netdev->dev_addr);
249}
250
Benjamin Herrenschmidt51764772017-04-05 12:28:45 +1000251static void ftgmac100_start_hw(struct ftgmac100 *priv)
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000252{
Benjamin Herrenschmidt874b55b2017-04-05 12:28:51 +1000253 u32 maccr = ioread32(priv->base + FTGMAC100_OFFSET_MACCR);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000254
Benjamin Herrenschmidt874b55b2017-04-05 12:28:51 +1000255 /* Keep the original GMAC and FAST bits */
256 maccr &= (FTGMAC100_MACCR_FAST_MODE | FTGMAC100_MACCR_GIGA_MODE);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000257
Benjamin Herrenschmidt874b55b2017-04-05 12:28:51 +1000258 /* Add all the main enable bits */
259 maccr |= FTGMAC100_MACCR_TXDMA_EN |
260 FTGMAC100_MACCR_RXDMA_EN |
261 FTGMAC100_MACCR_TXMAC_EN |
262 FTGMAC100_MACCR_RXMAC_EN |
263 FTGMAC100_MACCR_CRC_APD |
264 FTGMAC100_MACCR_PHY_LINK_LEVEL |
265 FTGMAC100_MACCR_RX_RUNT |
266 FTGMAC100_MACCR_RX_BROADPKT;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000267
Benjamin Herrenschmidt874b55b2017-04-05 12:28:51 +1000268 /* Add other bits as needed */
Benjamin Herrenschmidt51764772017-04-05 12:28:45 +1000269 if (priv->cur_duplex == DUPLEX_FULL)
270 maccr |= FTGMAC100_MACCR_FULLDUP;
271
Benjamin Herrenschmidt874b55b2017-04-05 12:28:51 +1000272 /* Hit the HW */
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000273 iowrite32(maccr, priv->base + FTGMAC100_OFFSET_MACCR);
274}
275
276static void ftgmac100_stop_hw(struct ftgmac100 *priv)
277{
278 iowrite32(0, priv->base + FTGMAC100_OFFSET_MACCR);
279}
280
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000281static int ftgmac100_alloc_rx_buf(struct ftgmac100 *priv, unsigned int entry,
282 struct ftgmac100_rxdes *rxdes, gfp_t gfp)
Benjamin Herrenschmidtc06f73f2017-04-06 11:02:43 +1000283{
284 struct net_device *netdev = priv->netdev;
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000285 struct sk_buff *skb;
Benjamin Herrenschmidtc06f73f2017-04-06 11:02:43 +1000286 dma_addr_t map;
Benjamin Herrenschmidtd72e01a2017-04-06 11:02:45 +1000287 int err;
Benjamin Herrenschmidtc06f73f2017-04-06 11:02:43 +1000288
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000289 skb = netdev_alloc_skb_ip_align(netdev, RX_BUF_SIZE);
290 if (unlikely(!skb)) {
Benjamin Herrenschmidtc06f73f2017-04-06 11:02:43 +1000291 if (net_ratelimit())
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000292 netdev_warn(netdev, "failed to allocate rx skb\n");
Benjamin Herrenschmidtd72e01a2017-04-06 11:02:45 +1000293 err = -ENOMEM;
294 map = priv->rx_scratch_dma;
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000295 } else {
296 map = dma_map_single(priv->dev, skb->data, RX_BUF_SIZE,
297 DMA_FROM_DEVICE);
298 if (unlikely(dma_mapping_error(priv->dev, map))) {
299 if (net_ratelimit())
300 netdev_err(netdev, "failed to map rx page\n");
301 dev_kfree_skb_any(skb);
302 map = priv->rx_scratch_dma;
303 skb = NULL;
304 err = -ENOMEM;
305 }
Benjamin Herrenschmidtc06f73f2017-04-06 11:02:43 +1000306 }
307
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000308 /* Store skb */
309 priv->rx_skbs[entry] = skb;
Benjamin Herrenschmidtc06f73f2017-04-06 11:02:43 +1000310
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000311 /* Store DMA address into RX desc */
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000312 rxdes->rxdes3 = cpu_to_le32(map);
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000313
314 /* Ensure the above is ordered vs clearing the OWN bit */
315 dma_wmb();
316
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000317 /* Clean status (which resets own bit) */
318 if (entry == (RX_QUEUE_ENTRIES - 1))
319 rxdes->rxdes0 = cpu_to_le32(priv->rxdes0_edorr_mask);
320 else
321 rxdes->rxdes0 = 0;
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000322
Benjamin Herrenschmidtc06f73f2017-04-06 11:02:43 +1000323 return 0;
324}
325
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000326static int ftgmac100_next_rx_pointer(int pointer)
327{
328 return (pointer + 1) & (RX_QUEUE_ENTRIES - 1);
329}
330
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000331static void ftgmac100_rx_packet_error(struct ftgmac100 *priv, u32 status)
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000332{
333 struct net_device *netdev = priv->netdev;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000334
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000335 if (status & FTGMAC100_RXDES0_RX_ERR)
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000336 netdev->stats.rx_errors++;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000337
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000338 if (status & FTGMAC100_RXDES0_CRC_ERR)
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000339 netdev->stats.rx_crc_errors++;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000340
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000341 if (status & (FTGMAC100_RXDES0_FTL |
342 FTGMAC100_RXDES0_RUNT |
343 FTGMAC100_RXDES0_RX_ODD_NB))
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000344 netdev->stats.rx_length_errors++;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000345}
346
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000347static bool ftgmac100_rx_packet(struct ftgmac100 *priv, int *processed)
348{
349 struct net_device *netdev = priv->netdev;
350 struct ftgmac100_rxdes *rxdes;
351 struct sk_buff *skb;
Benjamin Herrenschmidt01dd70b2017-04-06 11:02:48 +1000352 unsigned int pointer, size;
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000353 u32 status;
Benjamin Herrenschmidtb1977bf2017-04-06 11:02:44 +1000354 dma_addr_t map;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000355
Benjamin Herrenschmidt01dd70b2017-04-06 11:02:48 +1000356 /* Grab next RX descriptor */
357 pointer = priv->rx_pointer;
358 rxdes = &priv->descs->rxdes[pointer];
359
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000360 /* Grab descriptor status */
361 status = le32_to_cpu(rxdes->rxdes0);
362
Benjamin Herrenschmidt01dd70b2017-04-06 11:02:48 +1000363 /* Do we have a packet ? */
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000364 if (!(status & FTGMAC100_RXDES0_RXPKT_RDY))
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000365 return false;
366
Benjamin Herrenschmidt027f4262017-04-06 11:02:50 +1000367 /* Order subsequent reads with the test for the ready bit */
368 dma_rmb();
369
Benjamin Herrenschmidt01dd70b2017-04-06 11:02:48 +1000370 /* We don't cope with fragmented RX packets */
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000371 if (unlikely(!(status & FTGMAC100_RXDES0_FRS) ||
372 !(status & FTGMAC100_RXDES0_LRS)))
Benjamin Herrenschmidt01dd70b2017-04-06 11:02:48 +1000373 goto drop;
374
375 /* Any error (other than csum offload) flagged ? */
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000376 if (unlikely(status & RXDES0_ANY_ERROR)) {
377 ftgmac100_rx_packet_error(priv, status);
Benjamin Herrenschmidt01dd70b2017-04-06 11:02:48 +1000378 goto drop;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000379 }
380
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000381 /* If the packet had no skb (failed to allocate earlier)
Benjamin Herrenschmidtd72e01a2017-04-06 11:02:45 +1000382 * then try to allocate one and skip
383 */
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000384 skb = priv->rx_skbs[pointer];
385 if (!unlikely(skb)) {
386 ftgmac100_alloc_rx_buf(priv, pointer, rxdes, GFP_ATOMIC);
Benjamin Herrenschmidt01dd70b2017-04-06 11:02:48 +1000387 goto drop;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000388 }
389
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000390 if (unlikely(status & FTGMAC100_RXDES0_MULTICAST))
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000391 netdev->stats.multicast++;
392
Benjamin Herrenschmidt67202192017-04-06 11:02:46 +1000393 /* If the HW found checksum errors, bounce it to software.
394 *
395 * If we didn't, we need to see if the packet was recognized
396 * by HW as one of the supported checksummed protocols before
397 * we accept the HW test results.
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000398 */
Benjamin Herrenschmidt67202192017-04-06 11:02:46 +1000399 if (netdev->features & NETIF_F_RXCSUM) {
400 __le32 csum_vlan = rxdes->rxdes1;
401 __le32 err_bits = cpu_to_le32(FTGMAC100_RXDES1_TCP_CHKSUM_ERR |
402 FTGMAC100_RXDES1_UDP_CHKSUM_ERR |
403 FTGMAC100_RXDES1_IP_CHKSUM_ERR);
404 if ((csum_vlan & err_bits) ||
405 !(csum_vlan & cpu_to_le32(FTGMAC100_RXDES1_PROT_MASK)))
406 skb->ip_summed = CHECKSUM_NONE;
407 else
408 skb->ip_summed = CHECKSUM_UNNECESSARY;
409 }
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000410
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000411 /* Grab received size annd transfer to skb */
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000412 size = status & FTGMAC100_RXDES0_VDBC;
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000413 skb_put(skb, size);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000414
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000415 /* Tear down DMA mapping, do necessary cache management */
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000416 map = le32_to_cpu(rxdes->rxdes3);
417
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000418#if defined(CONFIG_ARM) && !defined(CONFIG_ARM_DMA_USE_IOMMU)
419 /* When we don't have an iommu, we can save cycles by not
420 * invalidating the cache for the part of the packet that
421 * wasn't received.
422 */
423 dma_unmap_single(priv->dev, map, size, DMA_FROM_DEVICE);
424#else
425 dma_unmap_single(priv->dev, map, RX_BUF_SIZE, DMA_FROM_DEVICE);
426#endif
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000427
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000428
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000429 /* Resplenish rx ring */
430 ftgmac100_alloc_rx_buf(priv, pointer, rxdes, GFP_ATOMIC);
Benjamin Herrenschmidt01dd70b2017-04-06 11:02:48 +1000431 priv->rx_pointer = ftgmac100_next_rx_pointer(pointer);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000432
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000433 skb->protocol = eth_type_trans(skb, netdev);
434
435 netdev->stats.rx_packets++;
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000436 netdev->stats.rx_bytes += size;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000437
438 /* push packet to protocol stack */
Benjamin Herrenschmidt67202192017-04-06 11:02:46 +1000439 if (skb->ip_summed == CHECKSUM_NONE)
440 netif_receive_skb(skb);
441 else
442 napi_gro_receive(&priv->napi, skb);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000443
444 (*processed)++;
445 return true;
Benjamin Herrenschmidt01dd70b2017-04-06 11:02:48 +1000446
447 drop:
448 /* Clean rxdes0 (which resets own bit) */
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000449 rxdes->rxdes0 = cpu_to_le32(status & priv->rxdes0_edorr_mask);
Benjamin Herrenschmidt01dd70b2017-04-06 11:02:48 +1000450 priv->rx_pointer = ftgmac100_next_rx_pointer(pointer);
451 netdev->stats.rx_dropped++;
452 return true;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000453}
454
Andrew Jeffery7906a4d2016-09-22 08:34:59 +0930455static void ftgmac100_txdes_reset(const struct ftgmac100 *priv,
456 struct ftgmac100_txdes *txdes)
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000457{
458 /* clear all except end of ring bit */
Andrew Jeffery7906a4d2016-09-22 08:34:59 +0930459 txdes->txdes0 &= cpu_to_le32(priv->txdes0_edotr_mask);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000460 txdes->txdes1 = 0;
461 txdes->txdes2 = 0;
462 txdes->txdes3 = 0;
463}
464
465static bool ftgmac100_txdes_owned_by_dma(struct ftgmac100_txdes *txdes)
466{
467 return txdes->txdes0 & cpu_to_le32(FTGMAC100_TXDES0_TXDMA_OWN);
468}
469
470static void ftgmac100_txdes_set_dma_own(struct ftgmac100_txdes *txdes)
471{
472 /*
473 * Make sure dma own bit will not be set before any other
474 * descriptor fields.
475 */
476 wmb();
477 txdes->txdes0 |= cpu_to_le32(FTGMAC100_TXDES0_TXDMA_OWN);
478}
479
Andrew Jeffery7906a4d2016-09-22 08:34:59 +0930480static void ftgmac100_txdes_set_end_of_ring(const struct ftgmac100 *priv,
481 struct ftgmac100_txdes *txdes)
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000482{
Andrew Jeffery7906a4d2016-09-22 08:34:59 +0930483 txdes->txdes0 |= cpu_to_le32(priv->txdes0_edotr_mask);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000484}
485
486static void ftgmac100_txdes_set_first_segment(struct ftgmac100_txdes *txdes)
487{
488 txdes->txdes0 |= cpu_to_le32(FTGMAC100_TXDES0_FTS);
489}
490
491static void ftgmac100_txdes_set_last_segment(struct ftgmac100_txdes *txdes)
492{
493 txdes->txdes0 |= cpu_to_le32(FTGMAC100_TXDES0_LTS);
494}
495
496static void ftgmac100_txdes_set_buffer_size(struct ftgmac100_txdes *txdes,
497 unsigned int len)
498{
499 txdes->txdes0 |= cpu_to_le32(FTGMAC100_TXDES0_TXBUF_SIZE(len));
500}
501
502static void ftgmac100_txdes_set_txint(struct ftgmac100_txdes *txdes)
503{
504 txdes->txdes1 |= cpu_to_le32(FTGMAC100_TXDES1_TXIC);
505}
506
507static void ftgmac100_txdes_set_tcpcs(struct ftgmac100_txdes *txdes)
508{
509 txdes->txdes1 |= cpu_to_le32(FTGMAC100_TXDES1_TCP_CHKSUM);
510}
511
512static void ftgmac100_txdes_set_udpcs(struct ftgmac100_txdes *txdes)
513{
514 txdes->txdes1 |= cpu_to_le32(FTGMAC100_TXDES1_UDP_CHKSUM);
515}
516
517static void ftgmac100_txdes_set_ipcs(struct ftgmac100_txdes *txdes)
518{
519 txdes->txdes1 |= cpu_to_le32(FTGMAC100_TXDES1_IP_CHKSUM);
520}
521
522static void ftgmac100_txdes_set_dma_addr(struct ftgmac100_txdes *txdes,
523 dma_addr_t addr)
524{
525 txdes->txdes3 = cpu_to_le32(addr);
526}
527
528static dma_addr_t ftgmac100_txdes_get_dma_addr(struct ftgmac100_txdes *txdes)
529{
530 return le32_to_cpu(txdes->txdes3);
531}
532
533/*
534 * txdes2 is not used by hardware. We use it to keep track of socket buffer.
535 * Since hardware does not touch it, we can skip cpu_to_le32()/le32_to_cpu().
536 */
537static void ftgmac100_txdes_set_skb(struct ftgmac100_txdes *txdes,
538 struct sk_buff *skb)
539{
540 txdes->txdes2 = (unsigned int)skb;
541}
542
543static struct sk_buff *ftgmac100_txdes_get_skb(struct ftgmac100_txdes *txdes)
544{
545 return (struct sk_buff *)txdes->txdes2;
546}
547
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000548static int ftgmac100_next_tx_pointer(int pointer)
549{
550 return (pointer + 1) & (TX_QUEUE_ENTRIES - 1);
551}
552
553static void ftgmac100_tx_pointer_advance(struct ftgmac100 *priv)
554{
555 priv->tx_pointer = ftgmac100_next_tx_pointer(priv->tx_pointer);
556}
557
558static void ftgmac100_tx_clean_pointer_advance(struct ftgmac100 *priv)
559{
560 priv->tx_clean_pointer = ftgmac100_next_tx_pointer(priv->tx_clean_pointer);
561}
562
563static struct ftgmac100_txdes *ftgmac100_current_txdes(struct ftgmac100 *priv)
564{
565 return &priv->descs->txdes[priv->tx_pointer];
566}
567
568static struct ftgmac100_txdes *
569ftgmac100_current_clean_txdes(struct ftgmac100 *priv)
570{
571 return &priv->descs->txdes[priv->tx_clean_pointer];
572}
573
574static bool ftgmac100_tx_complete_packet(struct ftgmac100 *priv)
575{
576 struct net_device *netdev = priv->netdev;
577 struct ftgmac100_txdes *txdes;
578 struct sk_buff *skb;
579 dma_addr_t map;
580
581 if (priv->tx_pending == 0)
582 return false;
583
584 txdes = ftgmac100_current_clean_txdes(priv);
585
586 if (ftgmac100_txdes_owned_by_dma(txdes))
587 return false;
588
589 skb = ftgmac100_txdes_get_skb(txdes);
590 map = ftgmac100_txdes_get_dma_addr(txdes);
591
592 netdev->stats.tx_packets++;
593 netdev->stats.tx_bytes += skb->len;
594
595 dma_unmap_single(priv->dev, map, skb_headlen(skb), DMA_TO_DEVICE);
596
597 dev_kfree_skb(skb);
598
Andrew Jeffery7906a4d2016-09-22 08:34:59 +0930599 ftgmac100_txdes_reset(priv, txdes);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000600
601 ftgmac100_tx_clean_pointer_advance(priv);
602
603 spin_lock(&priv->tx_lock);
604 priv->tx_pending--;
605 spin_unlock(&priv->tx_lock);
606 netif_wake_queue(netdev);
607
608 return true;
609}
610
611static void ftgmac100_tx_complete(struct ftgmac100 *priv)
612{
613 while (ftgmac100_tx_complete_packet(priv))
614 ;
615}
616
617static int ftgmac100_xmit(struct ftgmac100 *priv, struct sk_buff *skb,
618 dma_addr_t map)
619{
620 struct net_device *netdev = priv->netdev;
621 struct ftgmac100_txdes *txdes;
622 unsigned int len = (skb->len < ETH_ZLEN) ? ETH_ZLEN : skb->len;
623
624 txdes = ftgmac100_current_txdes(priv);
625 ftgmac100_tx_pointer_advance(priv);
626
627 /* setup TX descriptor */
628 ftgmac100_txdes_set_skb(txdes, skb);
629 ftgmac100_txdes_set_dma_addr(txdes, map);
630 ftgmac100_txdes_set_buffer_size(txdes, len);
631
632 ftgmac100_txdes_set_first_segment(txdes);
633 ftgmac100_txdes_set_last_segment(txdes);
634 ftgmac100_txdes_set_txint(txdes);
635 if (skb->ip_summed == CHECKSUM_PARTIAL) {
636 __be16 protocol = skb->protocol;
637
638 if (protocol == cpu_to_be16(ETH_P_IP)) {
639 u8 ip_proto = ip_hdr(skb)->protocol;
640
641 ftgmac100_txdes_set_ipcs(txdes);
642 if (ip_proto == IPPROTO_TCP)
643 ftgmac100_txdes_set_tcpcs(txdes);
644 else if (ip_proto == IPPROTO_UDP)
645 ftgmac100_txdes_set_udpcs(txdes);
646 }
647 }
648
649 spin_lock(&priv->tx_lock);
650 priv->tx_pending++;
651 if (priv->tx_pending == TX_QUEUE_ENTRIES)
652 netif_stop_queue(netdev);
653
654 /* start transmit */
655 ftgmac100_txdes_set_dma_own(txdes);
656 spin_unlock(&priv->tx_lock);
657
658 ftgmac100_txdma_normal_prio_start_polling(priv);
659
660 return NETDEV_TX_OK;
661}
662
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000663static void ftgmac100_free_buffers(struct ftgmac100 *priv)
664{
665 int i;
666
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +1000667 /* Free all RX buffers */
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000668 for (i = 0; i < RX_QUEUE_ENTRIES; i++) {
669 struct ftgmac100_rxdes *rxdes = &priv->descs->rxdes[i];
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000670 struct sk_buff *skb = priv->rx_skbs[i];
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000671 dma_addr_t map = le32_to_cpu(rxdes->rxdes3);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000672
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000673 if (!skb)
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000674 continue;
675
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000676 priv->rx_skbs[i] = NULL;
677 dma_unmap_single(priv->dev, map, RX_BUF_SIZE, DMA_FROM_DEVICE);
678 dev_kfree_skb_any(skb);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000679 }
680
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +1000681 /* Free all TX buffers */
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000682 for (i = 0; i < TX_QUEUE_ENTRIES; i++) {
683 struct ftgmac100_txdes *txdes = &priv->descs->txdes[i];
684 struct sk_buff *skb = ftgmac100_txdes_get_skb(txdes);
685 dma_addr_t map = ftgmac100_txdes_get_dma_addr(txdes);
686
687 if (!skb)
688 continue;
689
690 dma_unmap_single(priv->dev, map, skb_headlen(skb), DMA_TO_DEVICE);
Eric Dumazet0113e342014-01-16 23:38:24 -0800691 kfree_skb(skb);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000692 }
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000693}
694
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +1000695static void ftgmac100_free_rings(struct ftgmac100 *priv)
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000696{
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +1000697 /* Free descriptors */
698 if (priv->descs)
699 dma_free_coherent(priv->dev, sizeof(struct ftgmac100_descs),
700 priv->descs, priv->descs_dma_addr);
Benjamin Herrenschmidtd72e01a2017-04-06 11:02:45 +1000701
702 /* Free scratch packet buffer */
703 if (priv->rx_scratch)
704 dma_free_coherent(priv->dev, RX_BUF_SIZE,
705 priv->rx_scratch, priv->rx_scratch_dma);
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +1000706}
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000707
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +1000708static int ftgmac100_alloc_rings(struct ftgmac100 *priv)
709{
710 /* Allocate descriptors */
Joe Perchesede23fa82013-08-26 22:45:23 -0700711 priv->descs = dma_zalloc_coherent(priv->dev,
712 sizeof(struct ftgmac100_descs),
713 &priv->descs_dma_addr, GFP_KERNEL);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000714 if (!priv->descs)
715 return -ENOMEM;
716
Benjamin Herrenschmidtd72e01a2017-04-06 11:02:45 +1000717 /* Allocate scratch packet buffer */
718 priv->rx_scratch = dma_alloc_coherent(priv->dev,
719 RX_BUF_SIZE,
720 &priv->rx_scratch_dma,
721 GFP_KERNEL);
722 if (!priv->rx_scratch)
723 return -ENOMEM;
724
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +1000725 return 0;
726}
727
728static void ftgmac100_init_rings(struct ftgmac100 *priv)
729{
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000730 struct ftgmac100_rxdes *rxdes;
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +1000731 int i;
732
733 /* Initialize RX ring */
Benjamin Herrenschmidtd72e01a2017-04-06 11:02:45 +1000734 for (i = 0; i < RX_QUEUE_ENTRIES; i++) {
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000735 rxdes = &priv->descs->rxdes[i];
Benjamin Herrenschmidtd72e01a2017-04-06 11:02:45 +1000736 rxdes->rxdes0 = 0;
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000737 rxdes->rxdes3 = cpu_to_le32(priv->rx_scratch_dma);
Benjamin Herrenschmidtd72e01a2017-04-06 11:02:45 +1000738 }
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000739 /* Mark the end of the ring */
740 rxdes->rxdes0 |= cpu_to_le32(priv->rxdes0_edorr_mask);
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +1000741
742 /* Initialize TX ring */
743 for (i = 0; i < TX_QUEUE_ENTRIES; i++)
744 priv->descs->txdes[i].txdes0 = 0;
745 ftgmac100_txdes_set_end_of_ring(priv, &priv->descs->txdes[i -1]);
746}
747
748static int ftgmac100_alloc_rx_buffers(struct ftgmac100 *priv)
749{
750 int i;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000751
752 for (i = 0; i < RX_QUEUE_ENTRIES; i++) {
753 struct ftgmac100_rxdes *rxdes = &priv->descs->rxdes[i];
754
Benjamin Herrenschmidt7b49cd12017-04-06 11:02:49 +1000755 if (ftgmac100_alloc_rx_buf(priv, i, rxdes, GFP_KERNEL))
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +1000756 return -ENOMEM;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000757 }
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000758 return 0;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000759}
760
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000761static void ftgmac100_adjust_link(struct net_device *netdev)
762{
763 struct ftgmac100 *priv = netdev_priv(netdev);
Philippe Reynesb3c40ad2016-05-16 01:35:13 +0200764 struct phy_device *phydev = netdev->phydev;
Benjamin Herrenschmidt51764772017-04-05 12:28:45 +1000765 int new_speed;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000766
Benjamin Herrenschmidt51764772017-04-05 12:28:45 +1000767 /* We store "no link" as speed 0 */
768 if (!phydev->link)
769 new_speed = 0;
770 else
771 new_speed = phydev->speed;
772
773 if (phydev->speed == priv->cur_speed &&
774 phydev->duplex == priv->cur_duplex)
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000775 return;
776
Benjamin Herrenschmidt51764772017-04-05 12:28:45 +1000777 /* Print status if we have a link or we had one and just lost it,
778 * don't print otherwise.
779 */
780 if (new_speed || priv->cur_speed)
781 phy_print_status(phydev);
782
783 priv->cur_speed = new_speed;
784 priv->cur_duplex = phydev->duplex;
785
786 /* Link is down, do nothing else */
787 if (!new_speed)
788 return;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000789
Benjamin Herrenschmidt855944c2017-04-05 12:28:50 +1000790 /* Disable all interrupts */
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000791 iowrite32(0, priv->base + FTGMAC100_OFFSET_IER);
792
Benjamin Herrenschmidt855944c2017-04-05 12:28:50 +1000793 /* Reset the adapter asynchronously */
794 schedule_work(&priv->reset_task);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000795}
796
797static int ftgmac100_mii_probe(struct ftgmac100 *priv)
798{
799 struct net_device *netdev = priv->netdev;
Guenter Roecke574f392016-01-10 12:04:32 -0800800 struct phy_device *phydev;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000801
Guenter Roecke574f392016-01-10 12:04:32 -0800802 phydev = phy_find_first(priv->mii_bus);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000803 if (!phydev) {
804 netdev_info(netdev, "%s: no PHY found\n", netdev->name);
805 return -ENODEV;
806 }
807
Andrew Lunn84eff6d2016-01-06 20:11:10 +0100808 phydev = phy_connect(netdev, phydev_name(phydev),
Florian Fainellif9a8f832013-01-14 00:52:52 +0000809 &ftgmac100_adjust_link, PHY_INTERFACE_MODE_GMII);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000810
811 if (IS_ERR(phydev)) {
812 netdev_err(netdev, "%s: Could not attach to PHY\n", netdev->name);
813 return PTR_ERR(phydev);
814 }
815
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000816 return 0;
817}
818
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000819static int ftgmac100_mdiobus_read(struct mii_bus *bus, int phy_addr, int regnum)
820{
821 struct net_device *netdev = bus->priv;
822 struct ftgmac100 *priv = netdev_priv(netdev);
823 unsigned int phycr;
824 int i;
825
826 phycr = ioread32(priv->base + FTGMAC100_OFFSET_PHYCR);
827
828 /* preserve MDC cycle threshold */
829 phycr &= FTGMAC100_PHYCR_MDC_CYCTHR_MASK;
830
831 phycr |= FTGMAC100_PHYCR_PHYAD(phy_addr) |
832 FTGMAC100_PHYCR_REGAD(regnum) |
833 FTGMAC100_PHYCR_MIIRD;
834
835 iowrite32(phycr, priv->base + FTGMAC100_OFFSET_PHYCR);
836
837 for (i = 0; i < 10; i++) {
838 phycr = ioread32(priv->base + FTGMAC100_OFFSET_PHYCR);
839
840 if ((phycr & FTGMAC100_PHYCR_MIIRD) == 0) {
841 int data;
842
843 data = ioread32(priv->base + FTGMAC100_OFFSET_PHYDATA);
844 return FTGMAC100_PHYDATA_MIIRDATA(data);
845 }
846
847 udelay(100);
848 }
849
850 netdev_err(netdev, "mdio read timed out\n");
851 return -EIO;
852}
853
854static int ftgmac100_mdiobus_write(struct mii_bus *bus, int phy_addr,
855 int regnum, u16 value)
856{
857 struct net_device *netdev = bus->priv;
858 struct ftgmac100 *priv = netdev_priv(netdev);
859 unsigned int phycr;
860 int data;
861 int i;
862
863 phycr = ioread32(priv->base + FTGMAC100_OFFSET_PHYCR);
864
865 /* preserve MDC cycle threshold */
866 phycr &= FTGMAC100_PHYCR_MDC_CYCTHR_MASK;
867
868 phycr |= FTGMAC100_PHYCR_PHYAD(phy_addr) |
869 FTGMAC100_PHYCR_REGAD(regnum) |
870 FTGMAC100_PHYCR_MIIWR;
871
872 data = FTGMAC100_PHYDATA_MIIWDATA(value);
873
874 iowrite32(data, priv->base + FTGMAC100_OFFSET_PHYDATA);
875 iowrite32(phycr, priv->base + FTGMAC100_OFFSET_PHYCR);
876
877 for (i = 0; i < 10; i++) {
878 phycr = ioread32(priv->base + FTGMAC100_OFFSET_PHYCR);
879
880 if ((phycr & FTGMAC100_PHYCR_MIIWR) == 0)
881 return 0;
882
883 udelay(100);
884 }
885
886 netdev_err(netdev, "mdio write timed out\n");
887 return -EIO;
888}
889
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000890static void ftgmac100_get_drvinfo(struct net_device *netdev,
891 struct ethtool_drvinfo *info)
892{
Jiri Pirko7826d432013-01-06 00:44:26 +0000893 strlcpy(info->driver, DRV_NAME, sizeof(info->driver));
894 strlcpy(info->version, DRV_VERSION, sizeof(info->version));
895 strlcpy(info->bus_info, dev_name(&netdev->dev), sizeof(info->bus_info));
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000896}
897
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000898static const struct ethtool_ops ftgmac100_ethtool_ops = {
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000899 .get_drvinfo = ftgmac100_get_drvinfo,
900 .get_link = ethtool_op_get_link,
Philippe Reynesfd24d722016-05-16 01:35:14 +0200901 .get_link_ksettings = phy_ethtool_get_link_ksettings,
902 .set_link_ksettings = phy_ethtool_set_link_ksettings,
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000903};
904
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000905static irqreturn_t ftgmac100_interrupt(int irq, void *dev_id)
906{
907 struct net_device *netdev = dev_id;
908 struct ftgmac100 *priv = netdev_priv(netdev);
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +1000909 unsigned int status, new_mask = FTGMAC100_INT_BAD;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000910
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +1000911 /* Fetch and clear interrupt bits, process abnormal ones */
912 status = ioread32(priv->base + FTGMAC100_OFFSET_ISR);
913 iowrite32(status, priv->base + FTGMAC100_OFFSET_ISR);
914 if (unlikely(status & FTGMAC100_INT_BAD)) {
915
916 /* RX buffer unavailable */
917 if (status & FTGMAC100_INT_NO_RXBUF)
918 netdev->stats.rx_over_errors++;
919
920 /* received packet lost due to RX FIFO full */
921 if (status & FTGMAC100_INT_RPKT_LOST)
922 netdev->stats.rx_fifo_errors++;
923
924 /* sent packet lost due to excessive TX collision */
925 if (status & FTGMAC100_INT_XPKT_LOST)
926 netdev->stats.tx_fifo_errors++;
927
928 /* AHB error -> Reset the chip */
929 if (status & FTGMAC100_INT_AHB_ERR) {
930 if (net_ratelimit())
931 netdev_warn(netdev,
932 "AHB bus error ! Resetting chip.\n");
933 iowrite32(0, priv->base + FTGMAC100_OFFSET_IER);
934 schedule_work(&priv->reset_task);
935 return IRQ_HANDLED;
936 }
937
938 /* We may need to restart the MAC after such errors, delay
939 * this until after we have freed some Rx buffers though
940 */
941 priv->need_mac_restart = true;
942
943 /* Disable those errors until we restart */
944 new_mask &= ~status;
945 }
946
947 /* Only enable "bad" interrupts while NAPI is on */
948 iowrite32(new_mask, priv->base + FTGMAC100_OFFSET_IER);
949
950 /* Schedule NAPI bh */
951 napi_schedule_irqoff(&priv->napi);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000952
953 return IRQ_HANDLED;
954}
955
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +1000956static bool ftgmac100_check_rx(struct ftgmac100 *priv)
957{
958 struct ftgmac100_rxdes *rxdes = &priv->descs->rxdes[priv->rx_pointer];
959
960 /* Do we have a packet ? */
961 return !!(rxdes->rxdes0 & cpu_to_le32(FTGMAC100_RXDES0_RXPKT_RDY));
962}
963
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000964static int ftgmac100_poll(struct napi_struct *napi, int budget)
965{
966 struct ftgmac100 *priv = container_of(napi, struct ftgmac100, napi);
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +1000967 bool more, completed = true;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000968 int rx = 0;
969
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +1000970 ftgmac100_tx_complete(priv);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000971
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +1000972 do {
973 more = ftgmac100_rx_packet(priv, &rx);
974 } while (more && rx < budget);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000975
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +1000976 if (more && rx == budget)
977 completed = false;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000978
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +1000979
980 /* The interrupt is telling us to kick the MAC back to life
981 * after an RX overflow
982 */
983 if (unlikely(priv->need_mac_restart)) {
984 ftgmac100_start_hw(priv);
985
986 /* Re-enable "bad" interrupts */
987 iowrite32(FTGMAC100_INT_BAD,
988 priv->base + FTGMAC100_OFFSET_IER);
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000989 }
990
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +1000991 /* Keep NAPI going if we have still packets to reclaim */
992 if (priv->tx_pending)
993 return budget;
Po-Yu Chuang69785b72011-06-08 23:32:48 +0000994
995 if (completed) {
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +1000996 /* We are about to re-enable all interrupts. However
997 * the HW has been latching RX/TX packet interrupts while
998 * they were masked. So we clear them first, then we need
999 * to re-check if there's something to process
1000 */
1001 iowrite32(FTGMAC100_INT_RXTX,
1002 priv->base + FTGMAC100_OFFSET_ISR);
Benjamin Herrenschmidt4ca24152017-04-06 11:02:51 +10001003 if (ftgmac100_check_rx(priv) || priv->tx_pending)
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +10001004 return budget;
1005
1006 /* deschedule NAPI */
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001007 napi_complete(napi);
1008
1009 /* enable all interrupts */
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +10001010 iowrite32(FTGMAC100_INT_ALL,
Gavin Shanfc6061c2016-07-19 11:54:25 +10001011 priv->base + FTGMAC100_OFFSET_IER);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001012 }
1013
1014 return rx;
1015}
1016
Benjamin Herrenschmidtda40d9d2017-04-05 12:28:49 +10001017static int ftgmac100_init_all(struct ftgmac100 *priv, bool ignore_alloc_err)
1018{
1019 int err = 0;
1020
1021 /* Re-init descriptors (adjust queue sizes) */
1022 ftgmac100_init_rings(priv);
1023
1024 /* Realloc rx descriptors */
1025 err = ftgmac100_alloc_rx_buffers(priv);
1026 if (err && !ignore_alloc_err)
1027 return err;
1028
1029 /* Reinit and restart HW */
1030 ftgmac100_init_hw(priv);
1031 ftgmac100_start_hw(priv);
1032
1033 /* Re-enable the device */
1034 napi_enable(&priv->napi);
1035 netif_start_queue(priv->netdev);
1036
1037 /* Enable all interrupts */
Benjamin Herrenschmidt10cbd642017-04-05 12:28:53 +10001038 iowrite32(FTGMAC100_INT_ALL, priv->base + FTGMAC100_OFFSET_IER);
Benjamin Herrenschmidtda40d9d2017-04-05 12:28:49 +10001039
1040 return err;
1041}
1042
Benjamin Herrenschmidt855944c2017-04-05 12:28:50 +10001043static void ftgmac100_reset_task(struct work_struct *work)
1044{
1045 struct ftgmac100 *priv = container_of(work, struct ftgmac100,
1046 reset_task);
1047 struct net_device *netdev = priv->netdev;
1048 int err;
1049
1050 netdev_dbg(netdev, "Resetting NIC...\n");
1051
1052 /* Lock the world */
1053 rtnl_lock();
1054 if (netdev->phydev)
1055 mutex_lock(&netdev->phydev->lock);
1056 if (priv->mii_bus)
1057 mutex_lock(&priv->mii_bus->mdio_lock);
1058
1059
1060 /* Check if the interface is still up */
1061 if (!netif_running(netdev))
1062 goto bail;
1063
1064 /* Stop the network stack */
1065 netif_trans_update(netdev);
1066 napi_disable(&priv->napi);
1067 netif_tx_disable(netdev);
1068
1069 /* Stop and reset the MAC */
1070 ftgmac100_stop_hw(priv);
Benjamin Herrenschmidt874b55b2017-04-05 12:28:51 +10001071 err = ftgmac100_reset_and_config_mac(priv);
Benjamin Herrenschmidt855944c2017-04-05 12:28:50 +10001072 if (err) {
1073 /* Not much we can do ... it might come back... */
1074 netdev_err(netdev, "attempting to continue...\n");
1075 }
1076
1077 /* Free all rx and tx buffers */
1078 ftgmac100_free_buffers(priv);
1079
Benjamin Herrenschmidt855944c2017-04-05 12:28:50 +10001080 /* Setup everything again and restart chip */
1081 ftgmac100_init_all(priv, true);
1082
1083 netdev_dbg(netdev, "Reset done !\n");
1084 bail:
1085 if (priv->mii_bus)
1086 mutex_unlock(&priv->mii_bus->mdio_lock);
1087 if (netdev->phydev)
1088 mutex_unlock(&netdev->phydev->lock);
1089 rtnl_unlock();
1090}
1091
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001092static int ftgmac100_open(struct net_device *netdev)
1093{
1094 struct ftgmac100 *priv = netdev_priv(netdev);
1095 int err;
1096
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +10001097 /* Allocate ring buffers */
1098 err = ftgmac100_alloc_rings(priv);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001099 if (err) {
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +10001100 netdev_err(netdev, "Failed to allocate descriptors\n");
1101 return err;
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001102 }
1103
Benjamin Herrenschmidt51764772017-04-05 12:28:45 +10001104 /* When using NC-SI we force the speed to 100Mbit/s full duplex,
1105 *
1106 * Otherwise we leave it set to 0 (no link), the link
1107 * message from the PHY layer will handle setting it up to
1108 * something else if needed.
1109 */
1110 if (priv->use_ncsi) {
1111 priv->cur_duplex = DUPLEX_FULL;
1112 priv->cur_speed = SPEED_100;
1113 } else {
1114 priv->cur_duplex = 0;
1115 priv->cur_speed = 0;
1116 }
1117
Benjamin Herrenschmidt874b55b2017-04-05 12:28:51 +10001118 /* Reset the hardware */
1119 err = ftgmac100_reset_and_config_mac(priv);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001120 if (err)
1121 goto err_hw;
1122
Benjamin Herrenschmidtb8dbecf2017-04-05 12:28:47 +10001123 /* Initialize NAPI */
1124 netif_napi_add(netdev, &priv->napi, ftgmac100_poll, 64);
1125
Benjamin Herrenschmidt81f1eca2017-04-05 12:28:48 +10001126 /* Grab our interrupt */
1127 err = request_irq(netdev->irq, ftgmac100_interrupt, 0, netdev->name, netdev);
1128 if (err) {
1129 netdev_err(netdev, "failed to request irq %d\n", netdev->irq);
1130 goto err_irq;
1131 }
1132
Benjamin Herrenschmidtda40d9d2017-04-05 12:28:49 +10001133 /* Start things up */
1134 err = ftgmac100_init_all(priv, false);
1135 if (err) {
1136 netdev_err(netdev, "Failed to allocate packet buffers\n");
1137 goto err_alloc;
1138 }
Gavin Shan08c9c122016-09-22 08:35:01 +09301139
Benjamin Herrenschmidtda40d9d2017-04-05 12:28:49 +10001140 if (netdev->phydev) {
1141 /* If we have a PHY, start polling */
Gavin Shanbd466c32016-07-19 11:54:23 +10001142 phy_start(netdev->phydev);
Benjamin Herrenschmidtda40d9d2017-04-05 12:28:49 +10001143 } else if (priv->use_ncsi) {
1144 /* If using NC-SI, set our carrier on and start the stack */
Gavin Shanbd466c32016-07-19 11:54:23 +10001145 netif_carrier_on(netdev);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001146
Benjamin Herrenschmidtda40d9d2017-04-05 12:28:49 +10001147 /* Start the NCSI device */
Gavin Shanbd466c32016-07-19 11:54:23 +10001148 err = ncsi_start_dev(priv->ndev);
1149 if (err)
1150 goto err_ncsi;
1151 }
1152
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001153 return 0;
1154
Benjamin Herrenschmidtda40d9d2017-04-05 12:28:49 +10001155 err_ncsi:
Gavin Shanbd466c32016-07-19 11:54:23 +10001156 napi_disable(&priv->napi);
1157 netif_stop_queue(netdev);
Benjamin Herrenschmidtda40d9d2017-04-05 12:28:49 +10001158 err_alloc:
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +10001159 ftgmac100_free_buffers(priv);
Benjamin Herrenschmidtda40d9d2017-04-05 12:28:49 +10001160 free_irq(netdev->irq, netdev);
1161 err_irq:
1162 netif_napi_del(&priv->napi);
1163 err_hw:
1164 iowrite32(0, priv->base + FTGMAC100_OFFSET_IER);
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +10001165 ftgmac100_free_rings(priv);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001166 return err;
1167}
1168
1169static int ftgmac100_stop(struct net_device *netdev)
1170{
1171 struct ftgmac100 *priv = netdev_priv(netdev);
1172
Benjamin Herrenschmidt855944c2017-04-05 12:28:50 +10001173 /* Note about the reset task: We are called with the rtnl lock
1174 * held, so we are synchronized against the core of the reset
1175 * task. We must not try to synchronously cancel it otherwise
1176 * we can deadlock. But since it will test for netif_running()
1177 * which has already been cleared by the net core, we don't
1178 * anything special to do.
1179 */
1180
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001181 /* disable all interrupts */
1182 iowrite32(0, priv->base + FTGMAC100_OFFSET_IER);
1183
1184 netif_stop_queue(netdev);
1185 napi_disable(&priv->napi);
Benjamin Herrenschmidtb8dbecf2017-04-05 12:28:47 +10001186 netif_napi_del(&priv->napi);
Gavin Shanbd466c32016-07-19 11:54:23 +10001187 if (netdev->phydev)
1188 phy_stop(netdev->phydev);
Gavin Shan2c15f252016-10-04 11:25:54 +11001189 else if (priv->use_ncsi)
1190 ncsi_stop_dev(priv->ndev);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001191
1192 ftgmac100_stop_hw(priv);
Benjamin Herrenschmidt60b28a12017-04-05 12:28:41 +10001193 free_irq(netdev->irq, netdev);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001194 ftgmac100_free_buffers(priv);
Benjamin Herrenschmidt87d18752017-04-05 12:28:46 +10001195 ftgmac100_free_rings(priv);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001196
1197 return 0;
1198}
1199
1200static int ftgmac100_hard_start_xmit(struct sk_buff *skb,
1201 struct net_device *netdev)
1202{
1203 struct ftgmac100 *priv = netdev_priv(netdev);
1204 dma_addr_t map;
1205
1206 if (unlikely(skb->len > MAX_PKT_SIZE)) {
1207 if (net_ratelimit())
1208 netdev_dbg(netdev, "tx packet too big\n");
1209
1210 netdev->stats.tx_dropped++;
Eric Dumazet0113e342014-01-16 23:38:24 -08001211 kfree_skb(skb);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001212 return NETDEV_TX_OK;
1213 }
1214
1215 map = dma_map_single(priv->dev, skb->data, skb_headlen(skb), DMA_TO_DEVICE);
1216 if (unlikely(dma_mapping_error(priv->dev, map))) {
1217 /* drop packet */
1218 if (net_ratelimit())
1219 netdev_err(netdev, "map socket buffer failed\n");
1220
1221 netdev->stats.tx_dropped++;
Eric Dumazet0113e342014-01-16 23:38:24 -08001222 kfree_skb(skb);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001223 return NETDEV_TX_OK;
1224 }
1225
1226 return ftgmac100_xmit(priv, skb, map);
1227}
1228
1229/* optional */
1230static int ftgmac100_do_ioctl(struct net_device *netdev, struct ifreq *ifr, int cmd)
1231{
Gavin Shanbd466c32016-07-19 11:54:23 +10001232 if (!netdev->phydev)
1233 return -ENXIO;
1234
Philippe Reynesb3c40ad2016-05-16 01:35:13 +02001235 return phy_mii_ioctl(netdev->phydev, ifr, cmd);
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001236}
1237
1238static const struct net_device_ops ftgmac100_netdev_ops = {
1239 .ndo_open = ftgmac100_open,
1240 .ndo_stop = ftgmac100_stop,
1241 .ndo_start_xmit = ftgmac100_hard_start_xmit,
Gavin Shan113ce102016-07-19 11:54:22 +10001242 .ndo_set_mac_address = ftgmac100_set_mac_addr,
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001243 .ndo_validate_addr = eth_validate_addr,
1244 .ndo_do_ioctl = ftgmac100_do_ioctl,
1245};
1246
Gavin Shaneb418182016-07-19 11:54:21 +10001247static int ftgmac100_setup_mdio(struct net_device *netdev)
1248{
1249 struct ftgmac100 *priv = netdev_priv(netdev);
1250 struct platform_device *pdev = to_platform_device(priv->dev);
1251 int i, err = 0;
Joel Stanleye07dc632016-09-22 08:35:02 +09301252 u32 reg;
Gavin Shaneb418182016-07-19 11:54:21 +10001253
1254 /* initialize mdio bus */
1255 priv->mii_bus = mdiobus_alloc();
1256 if (!priv->mii_bus)
1257 return -EIO;
1258
Joel Stanleye07dc632016-09-22 08:35:02 +09301259 if (of_machine_is_compatible("aspeed,ast2400") ||
1260 of_machine_is_compatible("aspeed,ast2500")) {
1261 /* This driver supports the old MDIO interface */
1262 reg = ioread32(priv->base + FTGMAC100_OFFSET_REVR);
1263 reg &= ~FTGMAC100_REVR_NEW_MDIO_INTERFACE;
1264 iowrite32(reg, priv->base + FTGMAC100_OFFSET_REVR);
1265 };
1266
Gavin Shaneb418182016-07-19 11:54:21 +10001267 priv->mii_bus->name = "ftgmac100_mdio";
1268 snprintf(priv->mii_bus->id, MII_BUS_ID_SIZE, "%s-%d",
1269 pdev->name, pdev->id);
1270 priv->mii_bus->priv = priv->netdev;
1271 priv->mii_bus->read = ftgmac100_mdiobus_read;
1272 priv->mii_bus->write = ftgmac100_mdiobus_write;
1273
1274 for (i = 0; i < PHY_MAX_ADDR; i++)
1275 priv->mii_bus->irq[i] = PHY_POLL;
1276
1277 err = mdiobus_register(priv->mii_bus);
1278 if (err) {
1279 dev_err(priv->dev, "Cannot register MDIO bus!\n");
1280 goto err_register_mdiobus;
1281 }
1282
1283 err = ftgmac100_mii_probe(priv);
1284 if (err) {
1285 dev_err(priv->dev, "MII Probe failed!\n");
1286 goto err_mii_probe;
1287 }
1288
1289 return 0;
1290
1291err_mii_probe:
1292 mdiobus_unregister(priv->mii_bus);
1293err_register_mdiobus:
1294 mdiobus_free(priv->mii_bus);
1295 return err;
1296}
1297
1298static void ftgmac100_destroy_mdio(struct net_device *netdev)
1299{
1300 struct ftgmac100 *priv = netdev_priv(netdev);
1301
1302 if (!netdev->phydev)
1303 return;
1304
1305 phy_disconnect(netdev->phydev);
1306 mdiobus_unregister(priv->mii_bus);
1307 mdiobus_free(priv->mii_bus);
1308}
1309
Gavin Shanbd466c32016-07-19 11:54:23 +10001310static void ftgmac100_ncsi_handler(struct ncsi_dev *nd)
1311{
1312 if (unlikely(nd->state != ncsi_dev_state_functional))
1313 return;
1314
1315 netdev_info(nd->dev, "NCSI interface %s\n",
1316 nd->link_up ? "up" : "down");
1317}
1318
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001319static int ftgmac100_probe(struct platform_device *pdev)
1320{
1321 struct resource *res;
1322 int irq;
1323 struct net_device *netdev;
1324 struct ftgmac100 *priv;
Gavin Shanbd466c32016-07-19 11:54:23 +10001325 int err = 0;
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001326
1327 if (!pdev)
1328 return -ENODEV;
1329
1330 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1331 if (!res)
1332 return -ENXIO;
1333
1334 irq = platform_get_irq(pdev, 0);
1335 if (irq < 0)
1336 return irq;
1337
1338 /* setup net_device */
1339 netdev = alloc_etherdev(sizeof(*priv));
1340 if (!netdev) {
1341 err = -ENOMEM;
1342 goto err_alloc_etherdev;
1343 }
1344
1345 SET_NETDEV_DEV(netdev, &pdev->dev);
1346
Wilfried Klaebe7ad24ea2014-05-11 00:12:32 +00001347 netdev->ethtool_ops = &ftgmac100_ethtool_ops;
Po-Yu Chuang69785b72011-06-08 23:32:48 +00001348 netdev->netdev_ops = &ftgmac100_netdev_ops;
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");