projects / openwrt.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
history | raw | HEAD
[ar71xx] register gpio-leds on the WP543 board
[openwrt.git] / target / linux / ar71xx / files / drivers / net / ag71xx / ag71xx_main.c
1 /*
2 * Atheros AR71xx built-in ethernet mac driver
3 *
4 * Copyright (C) 2008 Gabor Juhos <juhosg@openwrt.org>
5 * Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>
6 *
7 * Based on Atheros' AG7100 driver
8 *
9 * This program is free software; you can redistribute it and/or modify it
10 * under the terms of the GNU General Public License version 2 as published
11 * by the Free Software Foundation.
12 */
13
14 #include "ag71xx.h"
15
16 #define AG71XX_DEFAULT_MSG_ENABLE \
17 ( NETIF_MSG_DRV \
18 | NETIF_MSG_PROBE \
19 | NETIF_MSG_LINK \
20 | NETIF_MSG_TIMER \
21 | NETIF_MSG_IFDOWN \
22 | NETIF_MSG_IFUP \
23 | NETIF_MSG_RX_ERR \
24 | NETIF_MSG_TX_ERR )
25
26 static int ag71xx_debug = -1;
27
28 module_param(ag71xx_debug, int, 0);
29 MODULE_PARM_DESC(ag71xx_debug, "Debug level (-1=defaults,0=none,...,16=all)");
30
31 static void ag71xx_dump_regs(struct ag71xx *ag)
32 {
33 DBG("%s: mac_cfg1=%08x, mac_cfg2=%08x, ipg=%08x, hdx=%08x, mfl=%08x\n",
34 ag->dev->name,
35 ag71xx_rr(ag, AG71XX_REG_MAC_CFG1),
36 ag71xx_rr(ag, AG71XX_REG_MAC_CFG2),
37 ag71xx_rr(ag, AG71XX_REG_MAC_IPG),
38 ag71xx_rr(ag, AG71XX_REG_MAC_HDX),
39 ag71xx_rr(ag, AG71XX_REG_MAC_MFL));
40 DBG("%s: mac_ifctl=%08x, mac_addr1=%08x, mac_addr2=%08x\n",
41 ag->dev->name,
42 ag71xx_rr(ag, AG71XX_REG_MAC_IFCTL),
43 ag71xx_rr(ag, AG71XX_REG_MAC_ADDR1),
44 ag71xx_rr(ag, AG71XX_REG_MAC_ADDR2));
45 DBG("%s: fifo_cfg0=%08x, fifo_cfg1=%08x, fifo_cfg2=%08x\n",
46 ag->dev->name,
47 ag71xx_rr(ag, AG71XX_REG_FIFO_CFG0),
48 ag71xx_rr(ag, AG71XX_REG_FIFO_CFG1),
49 ag71xx_rr(ag, AG71XX_REG_FIFO_CFG2));
50 DBG("%s: fifo_cfg3=%08x, fifo_cfg3=%08x, fifo_cfg5=%08x\n",
51 ag->dev->name,
52 ag71xx_rr(ag, AG71XX_REG_FIFO_CFG3),
53 ag71xx_rr(ag, AG71XX_REG_FIFO_CFG4),
54 ag71xx_rr(ag, AG71XX_REG_FIFO_CFG5));
55 }
56
57 static void ag71xx_ring_free(struct ag71xx_ring *ring)
58 {
59 kfree(ring->buf);
60
61 if (ring->descs)
62 dma_free_coherent(NULL, ring->size * sizeof(*ring->descs),
63 ring->descs, ring->descs_dma);
64 }
65
66 static int ag71xx_ring_alloc(struct ag71xx_ring *ring, unsigned int size)
67 {
68 int err;
69
70 ring->descs = dma_alloc_coherent(NULL, size * sizeof(*ring->descs),
71 &ring->descs_dma,
72 GFP_ATOMIC);
73 if (!ring->descs) {
74 err = -ENOMEM;
75 goto err;
76 }
77
78 ring->size = size;
79
80 ring->buf = kzalloc(size * sizeof(*ring->buf), GFP_KERNEL);
81 if (!ring->buf) {
82 err = -ENOMEM;
83 goto err;
84 }
85
86 return 0;
87
88 err:
89 return err;
90 }
91
92 static void ag71xx_ring_tx_clean(struct ag71xx *ag)
93 {
94 struct ag71xx_ring *ring = &ag->tx_ring;
95 struct net_device *dev = ag->dev;
96
97 while (ring->curr != ring->dirty) {
98 u32 i = ring->dirty % AG71XX_TX_RING_SIZE;
99
100 if (!ag71xx_desc_empty(&ring->descs[i])) {
101 ring->descs[i].ctrl = 0;
102 dev->stats.tx_errors++;
103 }
104
105 if (ring->buf[i].skb)
106 dev_kfree_skb_any(ring->buf[i].skb);
107
108 ring->buf[i].skb = NULL;
109
110 ring->dirty++;
111 }
112
113 /* flush descriptors */
114 wmb();
115
116 }
117
118 static void ag71xx_ring_tx_init(struct ag71xx *ag)
119 {
120 struct ag71xx_ring *ring = &ag->tx_ring;
121 int i;
122
123 for (i = 0; i < AG71XX_TX_RING_SIZE; i++) {
124 ring->descs[i].next = (u32) (ring->descs_dma +
125 sizeof(*ring->descs) * ((i + 1) % AG71XX_TX_RING_SIZE));
126
127 ring->descs[i].ctrl = DESC_EMPTY;
128 ring->buf[i].skb = NULL;
129 }
130
131 /* flush descriptors */
132 wmb();
133
134 ring->curr = 0;
135 ring->dirty = 0;
136 }
137
138 static void ag71xx_ring_rx_clean(struct ag71xx *ag)
139 {
140 struct ag71xx_ring *ring = &ag->rx_ring;
141 int i;
142
143 if (!ring->buf)
144 return;
145
146 for (i = 0; i < AG71XX_RX_RING_SIZE; i++)
147 if (ring->buf[i].skb)
148 kfree_skb(ring->buf[i].skb);
149
150 }
151
152 static int ag71xx_ring_rx_init(struct ag71xx *ag)
153 {
154 struct ag71xx_ring *ring = &ag->rx_ring;
155 unsigned int i;
156 int ret;
157
158 ret = 0;
159 for (i = 0; i < AG71XX_RX_RING_SIZE; i++)
160 ring->descs[i].next = (u32) (ring->descs_dma +
161 sizeof(*ring->descs) * ((i + 1) % AG71XX_RX_RING_SIZE));
162
163 for (i = 0; i < AG71XX_RX_RING_SIZE; i++) {
164 struct sk_buff *skb;
165
166 skb = dev_alloc_skb(AG71XX_RX_PKT_SIZE);
167 if (!skb) {
168 ret = -ENOMEM;
169 break;
170 }
171
172 skb->dev = ag->dev;
173 skb_reserve(skb, AG71XX_RX_PKT_RESERVE);
174
175 ring->buf[i].skb = skb;
176 ring->descs[i].data = virt_to_phys(skb->data);
177 ring->descs[i].ctrl = DESC_EMPTY;
178 }
179
180 /* flush descriptors */
181 wmb();
182
183 ring->curr = 0;
184 ring->dirty = 0;
185
186 return ret;
187 }
188
189 static int ag71xx_ring_rx_refill(struct ag71xx *ag)
190 {
191 struct ag71xx_ring *ring = &ag->rx_ring;
192 unsigned int count;
193
194 count = 0;
195 for (; ring->curr - ring->dirty > 0; ring->dirty++) {
196 unsigned int i;
197
198 i = ring->dirty % AG71XX_RX_RING_SIZE;
199
200 if (ring->buf[i].skb == NULL) {
201 struct sk_buff *skb;
202
203 skb = dev_alloc_skb(AG71XX_RX_PKT_SIZE);
204 if (skb == NULL) {
205 printk(KERN_ERR "%s: no memory for skb\n",
206 ag->dev->name);
207 break;
208 }
209
210 skb_reserve(skb, AG71XX_RX_PKT_RESERVE);
211 skb->dev = ag->dev;
212 ring->buf[i].skb = skb;
213 ring->descs[i].data = virt_to_phys(skb->data);
214 }
215
216 ring->descs[i].ctrl = DESC_EMPTY;
217 count++;
218 }
219
220 /* flush descriptors */
221 wmb();
222
223 DBG("%s: %u rx descriptors refilled\n", ag->dev->name, count);
224
225 return count;
226 }
227
228 static int ag71xx_rings_init(struct ag71xx *ag)
229 {
230 int ret;
231
232 ret = ag71xx_ring_alloc(&ag->tx_ring, AG71XX_TX_RING_SIZE);
233 if (ret)
234 return ret;
235
236 ag71xx_ring_tx_init(ag);
237
238 ret = ag71xx_ring_alloc(&ag->rx_ring, AG71XX_RX_RING_SIZE);
239 if (ret)
240 return ret;
241
242 ret = ag71xx_ring_rx_init(ag);
243 return ret;
244 }
245
246 static void ag71xx_rings_cleanup(struct ag71xx *ag)
247 {
248 ag71xx_ring_rx_clean(ag);
249 ag71xx_ring_free(&ag->rx_ring);
250
251 ag71xx_ring_tx_clean(ag);
252 ag71xx_ring_free(&ag->tx_ring);
253 }
254
255 static void ag71xx_hw_set_macaddr(struct ag71xx *ag, unsigned char *mac)
256 {
257 u32 t;
258
259 t = (((u32) mac[0]) << 24) | (((u32) mac[1]) << 16)
260 | (((u32) mac[2]) << 8) | ((u32) mac[2]);
261
262 ag71xx_wr(ag, AG71XX_REG_MAC_ADDR1, t);
263
264 t = (((u32) mac[4]) << 24) | (((u32) mac[5]) << 16);
265 ag71xx_wr(ag, AG71XX_REG_MAC_ADDR2, t);
266 }
267
268 #define MAC_CFG1_INIT (MAC_CFG1_RXE | MAC_CFG1_TXE | MAC_CFG1_SRX \
269 | MAC_CFG1_STX)
270
271 static void ag71xx_hw_init(struct ag71xx *ag)
272 {
273 struct ag71xx_platform_data *pdata = ag71xx_get_pdata(ag);
274
275 ag71xx_sb(ag, AG71XX_REG_MAC_CFG1, MAC_CFG1_SR);
276 udelay(20);
277
278 ar71xx_device_stop(pdata->reset_bit);
279 mdelay(100);
280 ar71xx_device_start(pdata->reset_bit);
281 mdelay(100);
282
283 ag71xx_wr(ag, AG71XX_REG_MAC_CFG1, MAC_CFG1_INIT);
284
285 /* TODO: set max packet size */
286
287 ag71xx_sb(ag, AG71XX_REG_MAC_CFG2,
288 MAC_CFG2_PAD_CRC_EN | MAC_CFG2_LEN_CHECK);
289
290 ag71xx_wr(ag, AG71XX_REG_FIFO_CFG0, 0x00001f00);
291
292 ag71xx_mii_ctrl_set_if(ag, pdata->mii_if);
293
294 ag71xx_wr(ag, AG71XX_REG_FIFO_CFG1, 0x0fff0000);
295 ag71xx_wr(ag, AG71XX_REG_FIFO_CFG2, 0x00001fff);
296 ag71xx_wr(ag, AG71XX_REG_FIFO_CFG4, 0x0000ffff);
297 ag71xx_wr(ag, AG71XX_REG_FIFO_CFG5, 0x0007ffef);
298 }
299
300 static void ag71xx_hw_start(struct ag71xx *ag)
301 {
302 /* start RX engine */
303 ag71xx_wr(ag, AG71XX_REG_RX_CTRL, RX_CTRL_RXE);
304
305 /* enable interrupts */
306 ag71xx_wr(ag, AG71XX_REG_INT_ENABLE, AG71XX_INT_INIT);
307 }
308
309 static void ag71xx_hw_stop(struct ag71xx *ag)
310 {
311 /* stop RX and TX */
312 ag71xx_wr(ag, AG71XX_REG_RX_CTRL, 0);
313 ag71xx_wr(ag, AG71XX_REG_TX_CTRL, 0);
314
315 /* disable all interrupts */
316 ag71xx_wr(ag, AG71XX_REG_INT_ENABLE, 0);
317 }
318
319 static int ag71xx_open(struct net_device *dev)
320 {
321 struct ag71xx *ag = netdev_priv(dev);
322 int ret;
323
324 ret = ag71xx_rings_init(ag);
325 if (ret)
326 goto err;
327
328 napi_enable(&ag->napi);
329
330 netif_carrier_off(dev);
331 ag71xx_phy_start(ag);
332
333 ag71xx_wr(ag, AG71XX_REG_TX_DESC, ag->tx_ring.descs_dma);
334 ag71xx_wr(ag, AG71XX_REG_RX_DESC, ag->rx_ring.descs_dma);
335
336 ag71xx_hw_set_macaddr(ag, dev->dev_addr);
337
338 ag71xx_hw_start(ag);
339
340 netif_start_queue(dev);
341
342 return 0;
343
344 err:
345 ag71xx_rings_cleanup(ag);
346 return ret;
347 }
348
349 static int ag71xx_stop(struct net_device *dev)
350 {
351 struct ag71xx *ag = netdev_priv(dev);
352 unsigned long flags;
353
354 spin_lock_irqsave(&ag->lock, flags);
355
356 netif_stop_queue(dev);
357
358 ag71xx_hw_stop(ag);
359
360 netif_carrier_off(dev);
361 ag71xx_phy_stop(ag);
362
363 napi_disable(&ag->napi);
364
365 spin_unlock_irqrestore(&ag->lock, flags);
366
367 ag71xx_rings_cleanup(ag);
368
369 return 0;
370 }
371
372 static int ag71xx_hard_start_xmit(struct sk_buff *skb, struct net_device *dev)
373 {
374 struct ag71xx *ag = netdev_priv(dev);
375 struct ag71xx_platform_data *pdata = ag71xx_get_pdata(ag);
376 struct ag71xx_ring *ring = &ag->tx_ring;
377 struct ag71xx_desc *desc;
378 unsigned long flags;
379 int i;
380
381 i = ring->curr % AG71XX_TX_RING_SIZE;
382 desc = &ring->descs[i];
383
384 spin_lock_irqsave(&ag->lock, flags);
385 ar71xx_ddr_flush(pdata->flush_reg);
386 spin_unlock_irqrestore(&ag->lock, flags);
387
388 if (!ag71xx_desc_empty(desc))
389 goto err_drop;
390
391 if (skb->len <= 0) {
392 DBG("%s: packet len is too small\n", ag->dev->name);
393 goto err_drop;
394 }
395
396 dma_cache_wback_inv((unsigned long)skb->data, skb->len);
397
398 ring->buf[i].skb = skb;
399
400 /* setup descriptor fields */
401 desc->data = virt_to_phys(skb->data);
402 desc->ctrl = (skb->len & DESC_PKTLEN_M);
403
404 /* flush descriptor */
405 wmb();
406
407 ring->curr++;
408 if (ring->curr == (ring->dirty + AG71XX_TX_THRES_STOP)) {
409 DBG("%s: tx queue full\n", ag->dev->name);
410 netif_stop_queue(dev);
411 }
412
413 DBG("%s: packet injected into TX queue\n", ag->dev->name);
414
415 /* enable TX engine */
416 ag71xx_wr(ag, AG71XX_REG_TX_CTRL, TX_CTRL_TXE);
417
418 dev->trans_start = jiffies;
419
420 return 0;
421
422 err_drop:
423 dev->stats.tx_dropped++;
424
425 dev_kfree_skb(skb);
426 return 0;
427 }
428
429 static int ag71xx_do_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
430 {
431 struct mii_ioctl_data *data = (struct mii_ioctl_data *) &ifr->ifr_data;
432 struct ag71xx *ag = netdev_priv(dev);
433 int ret;
434
435 switch (cmd) {
436 case SIOCETHTOOL:
437 if (ag->phy_dev == NULL)
438 break;
439
440 spin_lock_irq(&ag->lock);
441 ret = phy_ethtool_ioctl(ag->phy_dev, (void *) ifr->ifr_data);
442 spin_unlock_irq(&ag->lock);
443 return ret;
444
445 case SIOCSIFHWADDR:
446 if (copy_from_user
447 (dev->dev_addr, ifr->ifr_data, sizeof(dev->dev_addr)))
448 return -EFAULT;
449 return 0;
450
451 case SIOCGIFHWADDR:
452 if (copy_to_user
453 (ifr->ifr_data, dev->dev_addr, sizeof(dev->dev_addr)))
454 return -EFAULT;
455 return 0;
456
457 case SIOCGMIIPHY:
458 case SIOCGMIIREG:
459 case SIOCSMIIREG:
460 if (ag->phy_dev == NULL)
461 break;
462
463 return phy_mii_ioctl(ag->phy_dev, data, cmd);
464
465 default:
466 break;
467 }
468
469 return -EOPNOTSUPP;
470 }
471
472 static void ag71xx_tx_packets(struct ag71xx *ag)
473 {
474 struct ag71xx_platform_data *pdata = ag71xx_get_pdata(ag);
475 struct ag71xx_ring *ring = &ag->tx_ring;
476 unsigned int sent;
477
478 DBG("%s: processing TX ring\n", ag->dev->name);
479
480 #ifdef AG71XX_NAPI_TX
481 ar71xx_ddr_flush(pdata->flush_reg);
482 #endif
483
484 sent = 0;
485 while (ring->dirty != ring->curr) {
486 unsigned int i = ring->dirty % AG71XX_TX_RING_SIZE;
487 struct ag71xx_desc *desc = &ring->descs[i];
488 struct sk_buff *skb = ring->buf[i].skb;
489
490 if (!ag71xx_desc_empty(desc))
491 break;
492
493 ag71xx_wr(ag, AG71XX_REG_TX_STATUS, TX_STATUS_PS);
494
495 ag->dev->stats.tx_bytes += skb->len;
496 ag->dev->stats.tx_packets++;
497
498 dev_kfree_skb_any(skb);
499 ring->buf[i].skb = NULL;
500
501 ring->dirty++;
502 sent++;
503 }
504
505 DBG("%s: %d packets sent out\n", ag->dev->name, sent);
506
507 if ((ring->curr - ring->dirty) < AG71XX_TX_THRES_WAKEUP)
508 netif_wake_queue(ag->dev);
509
510 }
511
512 static int ag71xx_rx_packets(struct ag71xx *ag, int limit)
513 {
514 struct net_device *dev = ag->dev;
515 struct ag71xx_ring *ring = &ag->rx_ring;
516 #ifndef AG71XX_NAPI_TX
517 struct ag71xx_platform_data *pdata = ag71xx_get_pdata(ag);
518 unsigned long flags;
519 #endif
520 int done = 0;
521
522 #ifndef AG71XX_NAPI_TX
523 spin_lock_irqsave(&ag->lock, flags);
524 ar71xx_ddr_flush(pdata->flush_reg);
525 spin_unlock_irqrestore(&ag->lock, flags);
526 #endif
527
528 DBG("%s: rx packets, limit=%d, curr=%u, dirty=%u\n",
529 dev->name, limit, ring->curr, ring->dirty);
530
531 while (done < limit) {
532 unsigned int i = ring->curr % AG71XX_RX_RING_SIZE;
533 struct ag71xx_desc *desc = &ring->descs[i];
534 struct sk_buff *skb;
535 int pktlen;
536
537 if (ag71xx_desc_empty(desc))
538 break;
539
540 if ((ring->dirty + AG71XX_RX_RING_SIZE) == ring->curr) {
541 ag71xx_assert(0);
542 break;
543 }
544
545 skb = ring->buf[i].skb;
546 pktlen = ag71xx_desc_pktlen(desc);
547 pktlen -= ETH_FCS_LEN;
548
549 /* TODO: move it into the refill function */
550 dma_cache_wback_inv((unsigned long)skb->data, pktlen);
551 skb_put(skb, pktlen);
552
553 skb->dev = dev;
554 skb->protocol = eth_type_trans(skb, dev);
555 skb->ip_summed = CHECKSUM_UNNECESSARY;
556
557 netif_receive_skb(skb);
558
559 dev->last_rx = jiffies;
560 dev->stats.rx_packets++;
561 dev->stats.rx_bytes += pktlen;
562
563 ring->buf[i].skb = NULL;
564 done++;
565
566 ag71xx_wr(ag, AG71XX_REG_RX_STATUS, RX_STATUS_PR);
567
568 ring->curr++;
569 if ((ring->curr - ring->dirty) > (AG71XX_RX_RING_SIZE / 4))
570 ag71xx_ring_rx_refill(ag);
571 }
572
573 ag71xx_ring_rx_refill(ag);
574
575 DBG("%s: rx finish, curr=%u, dirty=%u, done=%d\n",
576 dev->name, ring->curr, ring->dirty, done);
577
578 return done;
579 }
580
581 static int ag71xx_poll(struct napi_struct *napi, int limit)
582 {
583 struct ag71xx *ag = container_of(napi, struct ag71xx, napi);
584 #ifdef AG71XX_NAPI_TX
585 struct ag71xx_platform_data *pdata = ag71xx_get_pdata(ag);
586 #endif
587 struct net_device *dev = ag->dev;
588 unsigned long flags;
589 u32 status;
590 int done;
591
592 #ifdef AG71XX_NAPI_TX
593 ar71xx_ddr_flush(pdata->flush_reg);
594 ag71xx_tx_packets(ag);
595 #endif
596
597 DBG("%s: processing RX ring\n", dev->name);
598 done = ag71xx_rx_packets(ag, limit);
599
600 /* TODO: add OOM handler */
601
602 status = ag71xx_rr(ag, AG71XX_REG_INT_STATUS);
603 status &= AG71XX_INT_POLL;
604
605 if ((done < limit) && (!status)) {
606 DBG("%s: disable polling mode, done=%d, status=%x\n",
607 dev->name, done, status);
608
609 netif_rx_complete(dev, napi);
610
611 /* enable interrupts */
612 spin_lock_irqsave(&ag->lock, flags);
613 ag71xx_int_enable(ag, AG71XX_INT_POLL);
614 spin_unlock_irqrestore(&ag->lock, flags);
615 return 0;
616 }
617
618 if (status & AG71XX_INT_RX_OF) {
619 if (netif_msg_rx_err(ag))
620 printk(KERN_ALERT "%s: rx owerflow, restarting dma\n",
621 dev->name);
622
623 /* ack interrupt */
624 ag71xx_wr(ag, AG71XX_REG_RX_STATUS, RX_STATUS_OF);
625 /* restart RX */
626 ag71xx_wr(ag, AG71XX_REG_RX_CTRL, RX_CTRL_RXE);
627 }
628
629 DBG("%s: stay in polling mode, done=%d, status=%x\n",
630 dev->name, done, status);
631 return 1;
632 }
633
634 static irqreturn_t ag71xx_interrupt(int irq, void *dev_id)
635 {
636 struct net_device *dev = dev_id;
637 struct ag71xx *ag = netdev_priv(dev);
638 u32 status;
639
640 status = ag71xx_rr(ag, AG71XX_REG_INT_STATUS);
641 status &= ag71xx_rr(ag, AG71XX_REG_INT_ENABLE);
642
643 if (unlikely(!status))
644 return IRQ_NONE;
645
646 if (unlikely(status & AG71XX_INT_ERR)) {
647 if (status & AG71XX_INT_TX_BE) {
648 ag71xx_wr(ag, AG71XX_REG_TX_STATUS, TX_STATUS_BE);
649 dev_err(&dev->dev, "TX BUS error\n");
650 }
651 if (status & AG71XX_INT_RX_BE) {
652 ag71xx_wr(ag, AG71XX_REG_RX_STATUS, RX_STATUS_BE);
653 dev_err(&dev->dev, "RX BUS error\n");
654 }
655 }
656
657 #if 0
658 if (unlikely(status & AG71XX_INT_TX_UR)) {
659 ag71xx_wr(ag, AG71XX_REG_TX_STATUS, TX_STATUS_UR);
660 DBG("%s: TX underrun\n", dev->name);
661 }
662 #endif
663
664 #ifndef AG71XX_NAPI_TX
665 if (likely(status & AG71XX_INT_TX_PS))
666 ag71xx_tx_packets(ag);
667 #endif
668
669 if (likely(status & AG71XX_INT_POLL)) {
670 ag71xx_int_disable(ag, AG71XX_INT_POLL);
671 DBG("%s: enable polling mode\n", dev->name);
672 netif_rx_schedule(dev, &ag->napi);
673 }
674
675 return IRQ_HANDLED;
676 }
677
678 static void ag71xx_set_multicast_list(struct net_device *dev)
679 {
680 /* TODO */
681 }
682
683 static int __init ag71xx_probe(struct platform_device *pdev)
684 {
685 struct net_device *dev;
686 struct resource *res;
687 struct ag71xx *ag;
688 struct ag71xx_platform_data *pdata;
689 int err;
690
691 pdata = pdev->dev.platform_data;
692 if (!pdata) {
693 dev_err(&pdev->dev, "no platform data specified\n");
694 err = -ENXIO;
695 goto err_out;
696 }
697
698 dev = alloc_etherdev(sizeof(*ag));
699 if (!dev) {
700 dev_err(&pdev->dev, "alloc_etherdev failed\n");
701 err = -ENOMEM;
702 goto err_out;
703 }
704
705 SET_NETDEV_DEV(dev, &pdev->dev);
706
707 ag = netdev_priv(dev);
708 ag->pdev = pdev;
709 ag->dev = dev;
710 ag->mii_bus = &ag71xx_mdio_bus->mii_bus;
711 ag->msg_enable = netif_msg_init(ag71xx_debug,
712 AG71XX_DEFAULT_MSG_ENABLE);
713 spin_lock_init(&ag->lock);
714
715 res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "mac_base");
716 if (!res) {
717 dev_err(&pdev->dev, "no mac_base resource found\n");
718 err = -ENXIO;
719 goto err_out;
720 }
721
722 ag->mac_base = ioremap_nocache(res->start, res->end - res->start + 1);
723 if (!ag->mac_base) {
724 dev_err(&pdev->dev, "unable to ioremap mac_base\n");
725 err = -ENOMEM;
726 goto err_free_dev;
727 }
728
729 res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "mac_base2");
730 if (!res) {
731 dev_err(&pdev->dev, "no mac_base2 resource found\n");
732 err = -ENXIO;
733 goto err_unmap_base1;
734 }
735
736 ag->mac_base2 = ioremap_nocache(res->start, res->end - res->start + 1);
737 if (!ag->mac_base) {
738 dev_err(&pdev->dev, "unable to ioremap mac_base2\n");
739 err = -ENOMEM;
740 goto err_unmap_base1;
741 }
742
743 res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "mii_ctrl");
744 if (!res) {
745 dev_err(&pdev->dev, "no mii_ctrl resource found\n");
746 err = -ENXIO;
747 goto err_unmap_base2;
748 }
749
750 ag->mii_ctrl = ioremap_nocache(res->start, res->end - res->start + 1);
751 if (!ag->mii_ctrl) {
752 dev_err(&pdev->dev, "unable to ioremap mii_ctrl\n");
753 err = -ENOMEM;
754 goto err_unmap_base2;
755 }
756
757 dev->irq = platform_get_irq(pdev, 0);
758 err = request_irq(dev->irq, ag71xx_interrupt,
759 IRQF_DISABLED | IRQF_SAMPLE_RANDOM,
760 dev->name, dev);
761 if (err) {
762 dev_err(&pdev->dev, "unable to request IRQ %d\n", dev->irq);
763 goto err_unmap_mii_ctrl;
764 }
765
766 dev->base_addr = (unsigned long)ag->mac_base;
767 dev->open = ag71xx_open;
768 dev->stop = ag71xx_stop;
769 dev->hard_start_xmit = ag71xx_hard_start_xmit;
770 dev->set_multicast_list = ag71xx_set_multicast_list;
771 dev->do_ioctl = ag71xx_do_ioctl;
772 dev->ethtool_ops = &ag71xx_ethtool_ops;
773
774 netif_napi_add(dev, &ag->napi, ag71xx_poll, AG71XX_NAPI_WEIGHT);
775
776 if (is_valid_ether_addr(pdata->mac_addr))
777 memcpy(dev->dev_addr, pdata->mac_addr, ETH_ALEN);
778 else {
779 dev->dev_addr[0] = 0xde;
780 dev->dev_addr[1] = 0xad;
781 get_random_bytes(&dev->dev_addr[2], 3);
782 dev->dev_addr[5] = pdev->id & 0xff;
783 }
784
785 err = register_netdev(dev);
786 if (err) {
787 dev_err(&pdev->dev, "unable to register net device\n");
788 goto err_free_irq;
789 }
790
791 printk(KERN_INFO "%s: Atheros AG71xx at 0x%08lx, irq %d\n",
792 dev->name, dev->base_addr, dev->irq);
793
794 ag71xx_dump_regs(ag);
795
796 ag71xx_hw_init(ag);
797
798 ag71xx_dump_regs(ag);
799
800 /* Reset the mdio bus explicitly */
801 if (ag->mii_bus) {
802 mutex_lock(&ag->mii_bus->mdio_lock);
803 ag->mii_bus->reset(ag->mii_bus);
804 mutex_unlock(&ag->mii_bus->mdio_lock);
805 }
806
807 err = ag71xx_phy_connect(ag);
808 if (err)
809 goto err_unregister_netdev;
810
811 platform_set_drvdata(pdev, dev);
812
813 return 0;
814
815 err_unregister_netdev:
816 unregister_netdev(dev);
817 err_free_irq:
818 free_irq(dev->irq, dev);
819 err_unmap_mii_ctrl:
820 iounmap(ag->mii_ctrl);
821 err_unmap_base2:
822 iounmap(ag->mac_base2);
823 err_unmap_base1:
824 iounmap(ag->mac_base);
825 err_free_dev:
826 kfree(dev);
827 err_out:
828 platform_set_drvdata(pdev, NULL);
829 return err;
830 }
831
832 static int __exit ag71xx_remove(struct platform_device *pdev)
833 {
834 struct net_device *dev = platform_get_drvdata(pdev);
835
836 if (dev) {
837 struct ag71xx *ag = netdev_priv(dev);
838
839 ag71xx_phy_disconnect(ag);
840 unregister_netdev(dev);
841 free_irq(dev->irq, dev);
842 iounmap(ag->mii_ctrl);
843 iounmap(ag->mac_base2);
844 iounmap(ag->mac_base);
845 kfree(dev);
846 platform_set_drvdata(pdev, NULL);
847 }
848
849 return 0;
850 }
851
852 static struct platform_driver ag71xx_driver = {
853 .probe = ag71xx_probe,
854 .remove = __exit_p(ag71xx_remove),
855 .driver = {
856 .name = AG71XX_DRV_NAME,
857 }
858 };
859
860 static int __init ag71xx_module_init(void)
861 {
862 int ret;
863
864 ret = ag71xx_mdio_driver_init();
865 if (ret)
866 goto err_out;
867
868 ret = platform_driver_register(&ag71xx_driver);
869 if (ret)
870 goto err_mdio_exit;
871
872 return 0;
873
874 err_mdio_exit:
875 ag71xx_mdio_driver_exit();
876 err_out:
877 return ret;
878 }
879
880 static void __exit ag71xx_module_exit(void)
881 {
882 platform_driver_unregister(&ag71xx_driver);
883 }
884
885 module_init(ag71xx_module_init);
886 module_exit(ag71xx_module_exit);
887
888 MODULE_VERSION(AG71XX_DRV_VERSION);
889 MODULE_AUTHOR("Gabor Juhos <juhosg@openwrt.org>");
890 MODULE_AUTHOR("Imre Kaloz <kaloz@openwrt.org>");
891 MODULE_LICENSE("GPL v2");
892 MODULE_ALIAS("platform:" AG71XX_DRV_NAME);
Personal OpenWRT clone
This page took 0.091396 seconds and 5 git commands to generate.