1
2
3
4
5
6
7
8
9
10
11
12
13
14#include <linux/module.h>
15#include <linux/kernel.h>
16#include <linux/errno.h>
17#include <linux/isapnp.h>
18#include <linux/init.h>
19#include <linux/interrupt.h>
20#include <linux/platform_device.h>
21#include <linux/delay.h>
22#include <linux/timer.h>
23#include <linux/netdevice.h>
24#include <linux/etherdevice.h>
25#include <linux/ethtool.h>
26#include <linux/mii.h>
27#include <linux/eeprom_93cx6.h>
28#include <linux/slab.h>
29
30#include <net/ax88796.h>
31
32#include <asm/system.h>
33#include <asm/io.h>
34
35static int phy_debug = 0;
36
37
38#define __ei_open ax_ei_open
39#define __ei_close ax_ei_close
40#define __ei_poll ax_ei_poll
41#define __ei_start_xmit ax_ei_start_xmit
42#define __ei_tx_timeout ax_ei_tx_timeout
43#define __ei_get_stats ax_ei_get_stats
44#define __ei_set_multicast_list ax_ei_set_multicast_list
45#define __ei_interrupt ax_ei_interrupt
46#define ____alloc_ei_netdev ax__alloc_ei_netdev
47#define __NS8390_init ax_NS8390_init
48
49
50#define ax_convert_addr(_a) ((void __force __iomem *)(_a))
51
52#define ei_inb(_a) readb(ax_convert_addr(_a))
53#define ei_outb(_v, _a) writeb(_v, ax_convert_addr(_a))
54
55#define ei_inb_p(_a) ei_inb(_a)
56#define ei_outb_p(_v, _a) ei_outb(_v, _a)
57
58
59#define EI_SHIFT(x) (ei_local->reg_offset[(x)])
60
61
62#define AX88796_PLATFORM
63
64static unsigned char version[] = "ax88796.c: Copyright 2005,2007 Simtec Electronics\n";
65
66#include "lib8390.c"
67
68#define DRV_NAME "ax88796"
69#define DRV_VERSION "1.00"
70
71
72#define NE_CMD EI_SHIFT(0x00)
73#define NE_RESET EI_SHIFT(0x1f)
74#define NE_DATAPORT EI_SHIFT(0x10)
75
76#define NE1SM_START_PG 0x20
77#define NE1SM_STOP_PG 0x40
78#define NESM_START_PG 0x40
79#define NESM_STOP_PG 0x80
80
81
82
83struct ax_device {
84 struct timer_list mii_timer;
85 spinlock_t mii_lock;
86 struct mii_if_info mii;
87
88 u32 msg_enable;
89 void __iomem *map2;
90 struct platform_device *dev;
91 struct resource *mem;
92 struct resource *mem2;
93 struct ax_plat_data *plat;
94
95 unsigned char running;
96 unsigned char resume_open;
97 unsigned int irqflags;
98
99 u32 reg_offsets[0x20];
100};
101
102static inline struct ax_device *to_ax_dev(struct net_device *dev)
103{
104 struct ei_device *ei_local = netdev_priv(dev);
105 return (struct ax_device *)(ei_local+1);
106}
107
108
109
110
111
112
113
114static int ax_initial_check(struct net_device *dev)
115{
116 struct ei_device *ei_local = netdev_priv(dev);
117 void __iomem *ioaddr = ei_local->mem;
118 int reg0;
119 int regd;
120
121 reg0 = ei_inb(ioaddr);
122 if (reg0 == 0xFF)
123 return -ENODEV;
124
125 ei_outb(E8390_NODMA+E8390_PAGE1+E8390_STOP, ioaddr + E8390_CMD);
126 regd = ei_inb(ioaddr + 0x0d);
127 ei_outb(0xff, ioaddr + 0x0d);
128 ei_outb(E8390_NODMA+E8390_PAGE0, ioaddr + E8390_CMD);
129 ei_inb(ioaddr + EN0_COUNTER0);
130 if (ei_inb(ioaddr + EN0_COUNTER0) != 0) {
131 ei_outb(reg0, ioaddr);
132 ei_outb(regd, ioaddr + 0x0d);
133 return -ENODEV;
134 }
135
136 return 0;
137}
138
139
140
141
142static void ax_reset_8390(struct net_device *dev)
143{
144 struct ei_device *ei_local = netdev_priv(dev);
145 struct ax_device *ax = to_ax_dev(dev);
146 unsigned long reset_start_time = jiffies;
147 void __iomem *addr = (void __iomem *)dev->base_addr;
148
149 if (ei_debug > 1)
150 dev_dbg(&ax->dev->dev, "resetting the 8390 t=%ld\n", jiffies);
151
152 ei_outb(ei_inb(addr + NE_RESET), addr + NE_RESET);
153
154 ei_status.txing = 0;
155 ei_status.dmaing = 0;
156
157
158 while ((ei_inb(addr + EN0_ISR) & ENISR_RESET) == 0) {
159 if (jiffies - reset_start_time > 2*HZ/100) {
160 dev_warn(&ax->dev->dev, "%s: %s did not complete.\n",
161 __func__, dev->name);
162 break;
163 }
164 }
165
166 ei_outb(ENISR_RESET, addr + EN0_ISR);
167}
168
169
170static void ax_get_8390_hdr(struct net_device *dev, struct e8390_pkt_hdr *hdr,
171 int ring_page)
172{
173 struct ei_device *ei_local = netdev_priv(dev);
174 struct ax_device *ax = to_ax_dev(dev);
175 void __iomem *nic_base = ei_local->mem;
176
177
178 if (ei_status.dmaing) {
179 dev_err(&ax->dev->dev, "%s: DMAing conflict in %s "
180 "[DMAstat:%d][irqlock:%d].\n",
181 dev->name, __func__,
182 ei_status.dmaing, ei_status.irqlock);
183 return;
184 }
185
186 ei_status.dmaing |= 0x01;
187 ei_outb(E8390_NODMA+E8390_PAGE0+E8390_START, nic_base+ NE_CMD);
188 ei_outb(sizeof(struct e8390_pkt_hdr), nic_base + EN0_RCNTLO);
189 ei_outb(0, nic_base + EN0_RCNTHI);
190 ei_outb(0, nic_base + EN0_RSARLO);
191 ei_outb(ring_page, nic_base + EN0_RSARHI);
192 ei_outb(E8390_RREAD+E8390_START, nic_base + NE_CMD);
193
194 if (ei_status.word16)
195 readsw(nic_base + NE_DATAPORT, hdr, sizeof(struct e8390_pkt_hdr)>>1);
196 else
197 readsb(nic_base + NE_DATAPORT, hdr, sizeof(struct e8390_pkt_hdr));
198
199 ei_outb(ENISR_RDC, nic_base + EN0_ISR);
200 ei_status.dmaing &= ~0x01;
201
202 le16_to_cpus(&hdr->count);
203}
204
205
206
207
208
209
210
211static void ax_block_input(struct net_device *dev, int count,
212 struct sk_buff *skb, int ring_offset)
213{
214 struct ei_device *ei_local = netdev_priv(dev);
215 struct ax_device *ax = to_ax_dev(dev);
216 void __iomem *nic_base = ei_local->mem;
217 char *buf = skb->data;
218
219 if (ei_status.dmaing) {
220 dev_err(&ax->dev->dev,
221 "%s: DMAing conflict in %s "
222 "[DMAstat:%d][irqlock:%d].\n",
223 dev->name, __func__,
224 ei_status.dmaing, ei_status.irqlock);
225 return;
226 }
227
228 ei_status.dmaing |= 0x01;
229
230 ei_outb(E8390_NODMA+E8390_PAGE0+E8390_START, nic_base+ NE_CMD);
231 ei_outb(count & 0xff, nic_base + EN0_RCNTLO);
232 ei_outb(count >> 8, nic_base + EN0_RCNTHI);
233 ei_outb(ring_offset & 0xff, nic_base + EN0_RSARLO);
234 ei_outb(ring_offset >> 8, nic_base + EN0_RSARHI);
235 ei_outb(E8390_RREAD+E8390_START, nic_base + NE_CMD);
236
237 if (ei_status.word16) {
238 readsw(nic_base + NE_DATAPORT, buf, count >> 1);
239 if (count & 0x01)
240 buf[count-1] = ei_inb(nic_base + NE_DATAPORT);
241
242 } else {
243 readsb(nic_base + NE_DATAPORT, buf, count);
244 }
245
246 ei_status.dmaing &= ~1;
247}
248
249static void ax_block_output(struct net_device *dev, int count,
250 const unsigned char *buf, const int start_page)
251{
252 struct ei_device *ei_local = netdev_priv(dev);
253 struct ax_device *ax = to_ax_dev(dev);
254 void __iomem *nic_base = ei_local->mem;
255 unsigned long dma_start;
256
257
258
259
260
261 if (ei_status.word16 && (count & 0x01))
262 count++;
263
264
265 if (ei_status.dmaing) {
266 dev_err(&ax->dev->dev, "%s: DMAing conflict in %s."
267 "[DMAstat:%d][irqlock:%d]\n",
268 dev->name, __func__,
269 ei_status.dmaing, ei_status.irqlock);
270 return;
271 }
272
273 ei_status.dmaing |= 0x01;
274
275 ei_outb(E8390_PAGE0+E8390_START+E8390_NODMA, nic_base + NE_CMD);
276
277 ei_outb(ENISR_RDC, nic_base + EN0_ISR);
278
279
280 ei_outb(count & 0xff, nic_base + EN0_RCNTLO);
281 ei_outb(count >> 8, nic_base + EN0_RCNTHI);
282 ei_outb(0x00, nic_base + EN0_RSARLO);
283 ei_outb(start_page, nic_base + EN0_RSARHI);
284
285 ei_outb(E8390_RWRITE+E8390_START, nic_base + NE_CMD);
286 if (ei_status.word16) {
287 writesw(nic_base + NE_DATAPORT, buf, count>>1);
288 } else {
289 writesb(nic_base + NE_DATAPORT, buf, count);
290 }
291
292 dma_start = jiffies;
293
294 while ((ei_inb(nic_base + EN0_ISR) & ENISR_RDC) == 0) {
295 if (jiffies - dma_start > 2*HZ/100) {
296 dev_warn(&ax->dev->dev,
297 "%s: timeout waiting for Tx RDC.\n", dev->name);
298 ax_reset_8390(dev);
299 ax_NS8390_init(dev,1);
300 break;
301 }
302 }
303
304 ei_outb(ENISR_RDC, nic_base + EN0_ISR);
305 ei_status.dmaing &= ~0x01;
306}
307
308
309
310#define AX_MEMR EI_SHIFT(0x14)
311#define AX_MEMR_MDC (1<<0)
312#define AX_MEMR_MDIR (1<<1)
313#define AX_MEMR_MDI (1<<2)
314#define AX_MEMR_MDO (1<<3)
315#define AX_MEMR_EECS (1<<4)
316#define AX_MEMR_EEI (1<<5)
317#define AX_MEMR_EEO (1<<6)
318#define AX_MEMR_EECLK (1<<7)
319
320
321
322
323
324
325static void
326ax_mii_ei_outbits(struct net_device *dev, unsigned int bits, int len)
327{
328 struct ei_device *ei_local = netdev_priv(dev);
329 void __iomem *memr_addr = (void __iomem *)dev->base_addr + AX_MEMR;
330 unsigned int memr;
331
332
333 memr = ei_inb(memr_addr);
334 memr &= ~(AX_MEMR_MDC | AX_MEMR_MDIR);
335 ei_outb(memr, memr_addr);
336
337 for (len--; len >= 0; len--) {
338 if (bits & (1 << len))
339 memr |= AX_MEMR_MDO;
340 else
341 memr &= ~AX_MEMR_MDO;
342
343 ei_outb(memr, memr_addr);
344
345
346
347 ei_outb(memr | AX_MEMR_MDC, memr_addr);
348 udelay(1);
349
350
351 ei_outb(memr, memr_addr);
352 }
353
354
355 memr |= AX_MEMR_MDIR;
356 ei_outb(memr, (void __iomem *)dev->base_addr + AX_MEMR);
357}
358
359
360
361
362
363
364static unsigned int
365ax_phy_ei_inbits(struct net_device *dev, int no)
366{
367 struct ei_device *ei_local = netdev_priv(dev);
368 void __iomem *memr_addr = (void __iomem *)dev->base_addr + AX_MEMR;
369 unsigned int memr;
370 unsigned int result = 0;
371
372
373 memr = ei_inb(memr_addr);
374 memr &= ~AX_MEMR_MDC;
375 memr |= AX_MEMR_MDIR;
376 ei_outb(memr, memr_addr);
377
378 for (no--; no >= 0; no--) {
379 ei_outb(memr | AX_MEMR_MDC, memr_addr);
380
381 udelay(1);
382
383 if (ei_inb(memr_addr) & AX_MEMR_MDI)
384 result |= (1<<no);
385
386 ei_outb(memr, memr_addr);
387 }
388
389 return result;
390}
391
392
393
394
395
396
397
398static void
399ax_phy_issueaddr(struct net_device *dev, int phy_addr, int reg, int opc)
400{
401 if (phy_debug)
402 pr_debug("%s: dev %p, %04x, %04x, %d\n",
403 __func__, dev, phy_addr, reg, opc);
404
405 ax_mii_ei_outbits(dev, 0x3f, 6);
406 ax_mii_ei_outbits(dev, 1, 2);
407 ax_mii_ei_outbits(dev, opc, 2);
408 ax_mii_ei_outbits(dev, phy_addr, 5);
409 ax_mii_ei_outbits(dev, reg, 5);
410}
411
412static int
413ax_phy_read(struct net_device *dev, int phy_addr, int reg)
414{
415 struct ei_device *ei_local = netdev_priv(dev);
416 unsigned long flags;
417 unsigned int result;
418
419 spin_lock_irqsave(&ei_local->page_lock, flags);
420
421 ax_phy_issueaddr(dev, phy_addr, reg, 2);
422
423 result = ax_phy_ei_inbits(dev, 17);
424 result &= ~(3<<16);
425
426 spin_unlock_irqrestore(&ei_local->page_lock, flags);
427
428 if (phy_debug)
429 pr_debug("%s: %04x.%04x => read %04x\n", __func__,
430 phy_addr, reg, result);
431
432 return result;
433}
434
435static void
436ax_phy_write(struct net_device *dev, int phy_addr, int reg, int value)
437{
438 struct ei_device *ei = netdev_priv(dev);
439 struct ax_device *ax = to_ax_dev(dev);
440 unsigned long flags;
441
442 dev_dbg(&ax->dev->dev, "%s: %p, %04x, %04x %04x\n",
443 __func__, dev, phy_addr, reg, value);
444
445 spin_lock_irqsave(&ei->page_lock, flags);
446
447 ax_phy_issueaddr(dev, phy_addr, reg, 1);
448 ax_mii_ei_outbits(dev, 2, 2);
449 ax_mii_ei_outbits(dev, value, 16);
450
451 spin_unlock_irqrestore(&ei->page_lock, flags);
452}
453
454static void ax_mii_expiry(unsigned long data)
455{
456 struct net_device *dev = (struct net_device *)data;
457 struct ax_device *ax = to_ax_dev(dev);
458 unsigned long flags;
459
460 spin_lock_irqsave(&ax->mii_lock, flags);
461 mii_check_media(&ax->mii, netif_msg_link(ax), 0);
462 spin_unlock_irqrestore(&ax->mii_lock, flags);
463
464 if (ax->running) {
465 ax->mii_timer.expires = jiffies + HZ*2;
466 add_timer(&ax->mii_timer);
467 }
468}
469
470static int ax_open(struct net_device *dev)
471{
472 struct ax_device *ax = to_ax_dev(dev);
473 struct ei_device *ei_local = netdev_priv(dev);
474 int ret;
475
476 dev_dbg(&ax->dev->dev, "%s: open\n", dev->name);
477
478 ret = request_irq(dev->irq, ax_ei_interrupt, ax->irqflags,
479 dev->name, dev);
480 if (ret)
481 return ret;
482
483 ret = ax_ei_open(dev);
484 if (ret) {
485 free_irq(dev->irq, dev);
486 return ret;
487 }
488
489
490
491 ei_outb(ax->plat->gpoc_val, ei_local->mem + EI_SHIFT(0x17));
492 ax->running = 1;
493
494
495
496 init_timer(&ax->mii_timer);
497
498 ax->mii_timer.expires = jiffies+1;
499 ax->mii_timer.data = (unsigned long) dev;
500 ax->mii_timer.function = ax_mii_expiry;
501
502 add_timer(&ax->mii_timer);
503
504 return 0;
505}
506
507static int ax_close(struct net_device *dev)
508{
509 struct ax_device *ax = to_ax_dev(dev);
510 struct ei_device *ei_local = netdev_priv(dev);
511
512 dev_dbg(&ax->dev->dev, "%s: close\n", dev->name);
513
514
515
516 ei_outb(ax->plat->gpoc_val | (1<<6),
517 ei_local->mem + EI_SHIFT(0x17));
518
519 ax->running = 0;
520 wmb();
521
522 del_timer_sync(&ax->mii_timer);
523 ax_ei_close(dev);
524
525 free_irq(dev->irq, dev);
526 return 0;
527}
528
529static int ax_ioctl(struct net_device *dev, struct ifreq *req, int cmd)
530{
531 struct ax_device *ax = to_ax_dev(dev);
532 unsigned long flags;
533 int rc;
534
535 if (!netif_running(dev))
536 return -EINVAL;
537
538 spin_lock_irqsave(&ax->mii_lock, flags);
539 rc = generic_mii_ioctl(&ax->mii, if_mii(req), cmd, NULL);
540 spin_unlock_irqrestore(&ax->mii_lock, flags);
541
542 return rc;
543}
544
545
546
547static void ax_get_drvinfo(struct net_device *dev,
548 struct ethtool_drvinfo *info)
549{
550 struct ax_device *ax = to_ax_dev(dev);
551
552 strcpy(info->driver, DRV_NAME);
553 strcpy(info->version, DRV_VERSION);
554 strcpy(info->bus_info, ax->dev->name);
555}
556
557static int ax_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
558{
559 struct ax_device *ax = to_ax_dev(dev);
560 unsigned long flags;
561
562 spin_lock_irqsave(&ax->mii_lock, flags);
563 mii_ethtool_gset(&ax->mii, cmd);
564 spin_unlock_irqrestore(&ax->mii_lock, flags);
565
566 return 0;
567}
568
569static int ax_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
570{
571 struct ax_device *ax = to_ax_dev(dev);
572 unsigned long flags;
573 int rc;
574
575 spin_lock_irqsave(&ax->mii_lock, flags);
576 rc = mii_ethtool_sset(&ax->mii, cmd);
577 spin_unlock_irqrestore(&ax->mii_lock, flags);
578
579 return rc;
580}
581
582static int ax_nway_reset(struct net_device *dev)
583{
584 struct ax_device *ax = to_ax_dev(dev);
585 return mii_nway_restart(&ax->mii);
586}
587
588static u32 ax_get_link(struct net_device *dev)
589{
590 struct ax_device *ax = to_ax_dev(dev);
591 return mii_link_ok(&ax->mii);
592}
593
594static const struct ethtool_ops ax_ethtool_ops = {
595 .get_drvinfo = ax_get_drvinfo,
596 .get_settings = ax_get_settings,
597 .set_settings = ax_set_settings,
598 .nway_reset = ax_nway_reset,
599 .get_link = ax_get_link,
600};
601
602#ifdef CONFIG_AX88796_93CX6
603static void ax_eeprom_register_read(struct eeprom_93cx6 *eeprom)
604{
605 struct ei_device *ei_local = eeprom->data;
606 u8 reg = ei_inb(ei_local->mem + AX_MEMR);
607
608 eeprom->reg_data_in = reg & AX_MEMR_EEI;
609 eeprom->reg_data_out = reg & AX_MEMR_EEO;
610 eeprom->reg_data_clock = reg & AX_MEMR_EECLK;
611 eeprom->reg_chip_select = reg & AX_MEMR_EECS;
612}
613
614static void ax_eeprom_register_write(struct eeprom_93cx6 *eeprom)
615{
616 struct ei_device *ei_local = eeprom->data;
617 u8 reg = ei_inb(ei_local->mem + AX_MEMR);
618
619 reg &= ~(AX_MEMR_EEI | AX_MEMR_EECLK | AX_MEMR_EECS);
620
621 if (eeprom->reg_data_in)
622 reg |= AX_MEMR_EEI;
623 if (eeprom->reg_data_clock)
624 reg |= AX_MEMR_EECLK;
625 if (eeprom->reg_chip_select)
626 reg |= AX_MEMR_EECS;
627
628 ei_outb(reg, ei_local->mem + AX_MEMR);
629 udelay(10);
630}
631#endif
632
633static const struct net_device_ops ax_netdev_ops = {
634 .ndo_open = ax_open,
635 .ndo_stop = ax_close,
636 .ndo_do_ioctl = ax_ioctl,
637
638 .ndo_start_xmit = ax_ei_start_xmit,
639 .ndo_tx_timeout = ax_ei_tx_timeout,
640 .ndo_get_stats = ax_ei_get_stats,
641 .ndo_set_multicast_list = ax_ei_set_multicast_list,
642 .ndo_validate_addr = eth_validate_addr,
643 .ndo_set_mac_address = eth_mac_addr,
644 .ndo_change_mtu = eth_change_mtu,
645#ifdef CONFIG_NET_POLL_CONTROLLER
646 .ndo_poll_controller = ax_ei_poll,
647#endif
648};
649
650
651
652static void ax_initial_setup(struct net_device *dev, struct ei_device *ei_local)
653{
654 void __iomem *ioaddr = ei_local->mem;
655 struct ax_device *ax = to_ax_dev(dev);
656
657
658 ei_outb(E8390_NODMA+E8390_PAGE0+E8390_STOP, ioaddr + E8390_CMD);
659
660
661 ei_outb(ax->plat->dcr_val & ~1, ioaddr + EN0_DCFG);
662 ei_outb(ax->plat->gpoc_val, ioaddr + EI_SHIFT(0x17));
663}
664
665
666
667
668
669
670
671
672
673static int ax_init_dev(struct net_device *dev, int first_init)
674{
675 struct ei_device *ei_local = netdev_priv(dev);
676 struct ax_device *ax = to_ax_dev(dev);
677 void __iomem *ioaddr = ei_local->mem;
678 unsigned int start_page;
679 unsigned int stop_page;
680 int ret;
681 int i;
682
683 ret = ax_initial_check(dev);
684 if (ret)
685 goto err_out;
686
687
688
689 ax_initial_setup(dev, ei_local);
690
691
692
693 if (first_init && ax->plat->flags & AXFLG_HAS_EEPROM) {
694 unsigned char SA_prom[32];
695
696 for(i = 0; i < sizeof(SA_prom); i+=2) {
697 SA_prom[i] = ei_inb(ioaddr + NE_DATAPORT);
698 SA_prom[i+1] = ei_inb(ioaddr + NE_DATAPORT);
699 }
700
701 if (ax->plat->wordlength == 2)
702 for (i = 0; i < 16; i++)
703 SA_prom[i] = SA_prom[i+i];
704
705 memcpy(dev->dev_addr, SA_prom, 6);
706 }
707
708#ifdef CONFIG_AX88796_93CX6
709 if (first_init && ax->plat->flags & AXFLG_HAS_93CX6) {
710 unsigned char mac_addr[6];
711 struct eeprom_93cx6 eeprom;
712
713 eeprom.data = ei_local;
714 eeprom.register_read = ax_eeprom_register_read;
715 eeprom.register_write = ax_eeprom_register_write;
716 eeprom.width = PCI_EEPROM_WIDTH_93C56;
717
718 eeprom_93cx6_multiread(&eeprom, 0,
719 (__le16 __force *)mac_addr,
720 sizeof(mac_addr) >> 1);
721
722 memcpy(dev->dev_addr, mac_addr, 6);
723 }
724#endif
725 if (ax->plat->wordlength == 2) {
726
727 ei_outb(ax->plat->dcr_val, ei_local->mem + EN0_DCFG);
728 start_page = NESM_START_PG;
729 stop_page = NESM_STOP_PG;
730 } else {
731 start_page = NE1SM_START_PG;
732 stop_page = NE1SM_STOP_PG;
733 }
734
735
736
737
738 if (first_init) {
739 if (ax->plat->flags & AXFLG_MAC_FROMDEV) {
740 ei_outb(E8390_NODMA + E8390_PAGE1 + E8390_STOP,
741 ei_local->mem + E8390_CMD);
742 for (i = 0; i < ETHER_ADDR_LEN; i++)
743 dev->dev_addr[i] =
744 ei_inb(ioaddr + EN1_PHYS_SHIFT(i));
745 }
746
747 if ((ax->plat->flags & AXFLG_MAC_FROMPLATFORM) &&
748 ax->plat->mac_addr)
749 memcpy(dev->dev_addr, ax->plat->mac_addr,
750 ETHER_ADDR_LEN);
751 }
752
753 ax_reset_8390(dev);
754
755 ei_status.name = "AX88796";
756 ei_status.tx_start_page = start_page;
757 ei_status.stop_page = stop_page;
758 ei_status.word16 = (ax->plat->wordlength == 2);
759 ei_status.rx_start_page = start_page + TX_PAGES;
760
761#ifdef PACKETBUF_MEMSIZE
762
763 ei_status.stop_page = ei_status.tx_start_page + PACKETBUF_MEMSIZE;
764#endif
765
766 ei_status.reset_8390 = &ax_reset_8390;
767 ei_status.block_input = &ax_block_input;
768 ei_status.block_output = &ax_block_output;
769 ei_status.get_8390_hdr = &ax_get_8390_hdr;
770 ei_status.priv = 0;
771
772 dev->netdev_ops = &ax_netdev_ops;
773 dev->ethtool_ops = &ax_ethtool_ops;
774
775 ax->msg_enable = NETIF_MSG_LINK;
776 ax->mii.phy_id_mask = 0x1f;
777 ax->mii.reg_num_mask = 0x1f;
778 ax->mii.phy_id = 0x10;
779 ax->mii.force_media = 0;
780 ax->mii.full_duplex = 0;
781 ax->mii.mdio_read = ax_phy_read;
782 ax->mii.mdio_write = ax_phy_write;
783 ax->mii.dev = dev;
784
785 ax_NS8390_init(dev, 0);
786
787 if (first_init)
788 dev_info(&ax->dev->dev, "%dbit, irq %d, %lx, MAC: %pM\n",
789 ei_status.word16 ? 16:8, dev->irq, dev->base_addr,
790 dev->dev_addr);
791
792 ret = register_netdev(dev);
793 if (ret)
794 goto out_irq;
795
796 return 0;
797
798 out_irq:
799
800 free_irq(dev->irq, dev);
801 err_out:
802 return ret;
803}
804
805static int ax_remove(struct platform_device *_dev)
806{
807 struct net_device *dev = platform_get_drvdata(_dev);
808 struct ax_device *ax;
809
810 ax = to_ax_dev(dev);
811
812 unregister_netdev(dev);
813 free_irq(dev->irq, dev);
814
815 iounmap(ei_status.mem);
816 release_resource(ax->mem);
817 kfree(ax->mem);
818
819 if (ax->map2) {
820 iounmap(ax->map2);
821 release_resource(ax->mem2);
822 kfree(ax->mem2);
823 }
824
825 free_netdev(dev);
826
827 return 0;
828}
829
830
831
832
833
834
835
836
837static int ax_probe(struct platform_device *pdev)
838{
839 struct net_device *dev;
840 struct ax_device *ax;
841 struct resource *res;
842 size_t size;
843 int ret = 0;
844
845 dev = ax__alloc_ei_netdev(sizeof(struct ax_device));
846 if (dev == NULL)
847 return -ENOMEM;
848
849
850 ax = to_ax_dev(dev);
851
852 memset(ax, 0, sizeof(struct ax_device));
853
854 spin_lock_init(&ax->mii_lock);
855
856 ax->dev = pdev;
857 ax->plat = pdev->dev.platform_data;
858 platform_set_drvdata(pdev, dev);
859
860 ei_status.rxcr_base = ax->plat->rcr_val;
861
862
863
864 res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
865 if (res == NULL) {
866 dev_err(&pdev->dev, "no IRQ specified\n");
867 ret = -ENXIO;
868 goto exit_mem;
869 }
870
871 dev->irq = res->start;
872 ax->irqflags = res->flags & IRQF_TRIGGER_MASK;
873
874 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
875 if (res == NULL) {
876 dev_err(&pdev->dev, "no MEM specified\n");
877 ret = -ENXIO;
878 goto exit_mem;
879 }
880
881 size = (res->end - res->start) + 1;
882
883
884
885
886 if (ax->plat->reg_offsets)
887 ei_status.reg_offset = ax->plat->reg_offsets;
888 else {
889 ei_status.reg_offset = ax->reg_offsets;
890 for (ret = 0; ret < 0x18; ret++)
891 ax->reg_offsets[ret] = (size / 0x18) * ret;
892 }
893
894 ax->mem = request_mem_region(res->start, size, pdev->name);
895 if (ax->mem == NULL) {
896 dev_err(&pdev->dev, "cannot reserve registers\n");
897 ret = -ENXIO;
898 goto exit_mem;
899 }
900
901 ei_status.mem = ioremap(res->start, size);
902 dev->base_addr = (unsigned long)ei_status.mem;
903
904 if (ei_status.mem == NULL) {
905 dev_err(&pdev->dev, "Cannot ioremap area (%08llx,%08llx)\n",
906 (unsigned long long)res->start,
907 (unsigned long long)res->end);
908
909 ret = -ENXIO;
910 goto exit_req;
911 }
912
913
914
915 res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
916 if (res == NULL) {
917 if (!ax->plat->reg_offsets) {
918 for (ret = 0; ret < 0x20; ret++)
919 ax->reg_offsets[ret] = (size / 0x20) * ret;
920 }
921
922 ax->map2 = NULL;
923 } else {
924 size = (res->end - res->start) + 1;
925
926 ax->mem2 = request_mem_region(res->start, size, pdev->name);
927 if (ax->mem2 == NULL) {
928 dev_err(&pdev->dev, "cannot reserve registers\n");
929 ret = -ENXIO;
930 goto exit_mem1;
931 }
932
933 ax->map2 = ioremap(res->start, size);
934 if (ax->map2 == NULL) {
935 dev_err(&pdev->dev, "cannot map reset register\n");
936 ret = -ENXIO;
937 goto exit_mem2;
938 }
939
940 ei_status.reg_offset[0x1f] = ax->map2 - ei_status.mem;
941 }
942
943
944
945 ret = ax_init_dev(dev, 1);
946 if (!ret)
947 return 0;
948
949 if (ax->map2 == NULL)
950 goto exit_mem1;
951
952 iounmap(ax->map2);
953
954 exit_mem2:
955 release_resource(ax->mem2);
956 kfree(ax->mem2);
957
958 exit_mem1:
959 iounmap(ei_status.mem);
960
961 exit_req:
962 release_resource(ax->mem);
963 kfree(ax->mem);
964
965 exit_mem:
966 free_netdev(dev);
967
968 return ret;
969}
970
971
972
973#ifdef CONFIG_PM
974static int ax_suspend(struct platform_device *dev, pm_message_t state)
975{
976 struct net_device *ndev = platform_get_drvdata(dev);
977 struct ax_device *ax = to_ax_dev(ndev);
978
979 ax->resume_open = ax->running;
980
981 netif_device_detach(ndev);
982 ax_close(ndev);
983
984 return 0;
985}
986
987static int ax_resume(struct platform_device *pdev)
988{
989 struct net_device *ndev = platform_get_drvdata(pdev);
990 struct ax_device *ax = to_ax_dev(ndev);
991
992 ax_initial_setup(ndev, netdev_priv(ndev));
993 ax_NS8390_init(ndev, ax->resume_open);
994 netif_device_attach(ndev);
995
996 if (ax->resume_open)
997 ax_open(ndev);
998
999 return 0;
1000}
1001
1002#else
1003#define ax_suspend NULL
1004#define ax_resume NULL
1005#endif
1006
1007static struct platform_driver axdrv = {
1008 .driver = {
1009 .name = "ax88796",
1010 .owner = THIS_MODULE,
1011 },
1012 .probe = ax_probe,
1013 .remove = ax_remove,
1014 .suspend = ax_suspend,
1015 .resume = ax_resume,
1016};
1017
1018static int __init axdrv_init(void)
1019{
1020 return platform_driver_register(&axdrv);
1021}
1022
1023static void __exit axdrv_exit(void)
1024{
1025 platform_driver_unregister(&axdrv);
1026}
1027
1028module_init(axdrv_init);
1029module_exit(axdrv_exit);
1030
1031MODULE_DESCRIPTION("AX88796 10/100 Ethernet platform driver");
1032MODULE_AUTHOR("Ben Dooks, <ben@simtec.co.uk>");
1033MODULE_LICENSE("GPL v2");
1034MODULE_ALIAS("platform:ax88796");
1035