?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
RT-AC56 3.0.0.4.374.37 core
[tomato.git] / release / src-rt-6.x.4708 / linux / linux-2.6.36 / drivers / net / ni65.c
blobb33e429a8f3f63050c7d2eeb2b2db2ef4ad2c88d
1 /*
2 * ni6510 (am7990 'lance' chip) driver for Linux-net-3
3 * BETAcode v0.71 (96/09/29) for 2.0.0 (or later)
4 * copyrights (c) 1994,1995,1996 by M.Hipp
5 *
6 * This driver can handle the old ni6510 board and the newer ni6510
7 * EtherBlaster. (probably it also works with every full NE2100
8 * compatible card)
9 *
10 * driver probes: io: 0x360,0x300,0x320,0x340 / dma: 3,5,6,7
11 *
12 * This is an extension to the Linux operating system, and is covered by the
13 * same GNU General Public License that covers the Linux-kernel.
14 *
15 * comments/bugs/suggestions can be sent to:
16 * Michael Hipp
17 * email: hippm@informatik.uni-tuebingen.de
18 *
19 * sources:
20 * some things are from the 'ni6510-packet-driver for dos by Russ Nelson'
21 * and from the original drivers by D.Becker
22 *
23 * known problems:
24 * - on some PCI boards (including my own) the card/board/ISA-bridge has
25 * problems with bus master DMA. This results in lotsa overruns.
26 * It may help to '#define RCV_PARANOIA_CHECK' or try to #undef
27 * the XMT and RCV_VIA_SKB option .. this reduces driver performance.
28 * Or just play with your BIOS options to optimize ISA-DMA access.
29 * Maybe you also wanna play with the LOW_PERFORAMCE and MID_PERFORMANCE
30 * defines -> please report me your experience then
31 * - Harald reported for ASUS SP3G mainboards, that you should use
32 * the 'optimal settings' from the user's manual on page 3-12!
33 *
34 * credits:
35 * thanx to Jason Sullivan for sending me a ni6510 card!
36 * lot of debug runs with ASUS SP3G Boards (Intel Saturn) by Harald Koenig
37 *
38 * simple performance test: (486DX-33/Ni6510-EB receives from 486DX4-100/Ni6510-EB)
39 * average: FTP -> 8384421 bytes received in 8.5 seconds
40 * (no RCV_VIA_SKB,no XMT_VIA_SKB,PARANOIA_CHECK,4 XMIT BUFS, 8 RCV_BUFFS)
41 * peak: FTP -> 8384421 bytes received in 7.5 seconds
42 * (RCV_VIA_SKB,XMT_VIA_SKB,no PARANOIA_CHECK,1(!) XMIT BUF, 16 RCV BUFFS)
43 */
44
45 /*
46 * 99.Jun.8: added support for /proc/net/dev byte count for xosview (HK)
47 * 96.Sept.29: virt_to_bus stuff added for new memory modell
48 * 96.April.29: Added Harald Koenig's Patches (MH)
49 * 96.April.13: enhanced error handling .. more tests (MH)
50 * 96.April.5/6: a lot of performance tests. Got it stable now (hopefully) (MH)
51 * 96.April.1: (no joke ;) .. added EtherBlaster and Module support (MH)
52 * 96.Feb.19: fixed a few bugs .. cleanups .. tested for 1.3.66 (MH)
53 * hopefully no more 16MB limit
54 *
55 * 95.Nov.18: multicast tweaked (AC).
56 *
57 * 94.Aug.22: changes in xmit_intr (ack more than one xmitted-packet), ni65_send_packet (p->lock) (MH)
58 *
59 * 94.July.16: fixed bugs in recv_skb and skb-alloc stuff (MH)
60 */
61
62 #include <linux/kernel.h>
63 #include <linux/string.h>
64 #include <linux/errno.h>
65 #include <linux/ioport.h>
66 #include <linux/slab.h>
67 #include <linux/interrupt.h>
68 #include <linux/delay.h>
69 #include <linux/init.h>
70 #include <linux/netdevice.h>
71 #include <linux/etherdevice.h>
72 #include <linux/skbuff.h>
73 #include <linux/module.h>
74 #include <linux/bitops.h>
75
76 #include <asm/io.h>
77 #include <asm/dma.h>
78
79 #include "ni65.h"
80
81 /*
82 * the current setting allows an acceptable performance
83 * for 'RCV_PARANOIA_CHECK' read the 'known problems' part in
84 * the header of this file
85 * 'invert' the defines for max. performance. This may cause DMA problems
86 * on some boards (e.g on my ASUS SP3G)
87 */
88 #undef XMT_VIA_SKB
89 #undef RCV_VIA_SKB
90 #define RCV_PARANOIA_CHECK
91
92 #define MID_PERFORMANCE
93
94 #if defined(LOW_PERFORMANCE)
95 static int isa0=7,isa1=7,csr80=0x0c10;
96 #elif defined(MID_PERFORMANCE)
97 static int isa0=5,isa1=5,csr80=0x2810;
98 #else /* high performance */
99 static int isa0=4,isa1=4,csr80=0x0017;
100 #endif
101
102 /*
103 * a few card/vendor specific defines
104 */
105 #define NI65_ID0 0x00
106 #define NI65_ID1 0x55
107 #define NI65_EB_ID0 0x52
108 #define NI65_EB_ID1 0x44
109 #define NE2100_ID0 0x57
110 #define NE2100_ID1 0x57
111
112 #define PORT p->cmdr_addr
113
114 /*
115 * buffer configuration
116 */
117 #define RMDNUM 16
118 #define RMDNUMMASK 0x80000000
119
120 #define TMDNUM 4
121 #define TMDNUMMASK 0x40000000 /* log2(TMDNUM)<<29 */
122
123 /* slightly oversized */
124 #define R_BUF_SIZE 1544
125 #define T_BUF_SIZE 1544
126
127 /*
128 * lance register defines
129 */
130 #define L_DATAREG 0x00
131 #define L_ADDRREG 0x02
132 #define L_RESET 0x04
133 #define L_CONFIG 0x05
134 #define L_BUSIF 0x06
135
136 /*
137 * to access the lance/am7990-regs, you have to write
138 * reg-number into L_ADDRREG, then you can access it using L_DATAREG
139 */
140 #define CSR0 0x00
141 #define CSR1 0x01
142 #define CSR2 0x02
143 #define CSR3 0x03
144
145 #define INIT_RING_BEFORE_START 0x1
146 #define FULL_RESET_ON_ERROR 0x2
147
148 #define writereg(val,reg) {outw(reg,PORT+L_ADDRREG);outw(val,PORT+L_DATAREG);}
149 #define readreg(reg) (outw(reg,PORT+L_ADDRREG),inw(PORT+L_DATAREG))
150 #define writedatareg(val) { writereg(val,CSR0); }
151
152 static unsigned char ni_vendor[] = { 0x02,0x07,0x01 };
153
154 static struct card {
155 unsigned char id0,id1;
156 short id_offset;
157 short total_size;
158 short cmd_offset;
159 short addr_offset;
160 unsigned char *vendor_id;
161 char *cardname;
162 unsigned long config;
163 } cards[] = {
164 {
165 .id0 = NI65_ID0,
166 .id1 = NI65_ID1,
167 .id_offset = 0x0e,
168 .total_size = 0x10,
169 .cmd_offset = 0x0,
170 .addr_offset = 0x8,
171 .vendor_id = ni_vendor,
172 .cardname = "ni6510",
173 .config = 0x1,
174 },
175 {
176 .id0 = NI65_EB_ID0,
177 .id1 = NI65_EB_ID1,
178 .id_offset = 0x0e,
179 .total_size = 0x18,
180 .cmd_offset = 0x10,
181 .addr_offset = 0x0,
182 .vendor_id = ni_vendor,
183 .cardname = "ni6510 EtherBlaster",
184 .config = 0x2,
185 },
186 {
187 .id0 = NE2100_ID0,
188 .id1 = NE2100_ID1,
189 .id_offset = 0x0e,
190 .total_size = 0x18,
191 .cmd_offset = 0x10,
192 .addr_offset = 0x0,
193 .vendor_id = NULL,
194 .cardname = "generic NE2100",
195 .config = 0x0,
196 },
197 };
198 #define NUM_CARDS 3
199
200 struct priv
201 {
202 struct rmd rmdhead[RMDNUM];
203 struct tmd tmdhead[TMDNUM];
204 struct init_block ib;
205 int rmdnum;
206 int tmdnum,tmdlast;
207 #ifdef RCV_VIA_SKB
208 struct sk_buff *recv_skb[RMDNUM];
209 #else
210 void *recvbounce[RMDNUM];
211 #endif
212 #ifdef XMT_VIA_SKB
213 struct sk_buff *tmd_skb[TMDNUM];
214 #endif
215 void *tmdbounce[TMDNUM];
216 int tmdbouncenum;
217 int lock,xmit_queued;
218
219 void *self;
220 int cmdr_addr;
221 int cardno;
222 int features;
223 spinlock_t ring_lock;
224 };
225
226 static int ni65_probe1(struct net_device *dev,int);
227 static irqreturn_t ni65_interrupt(int irq, void * dev_id);
228 static void ni65_recv_intr(struct net_device *dev,int);
229 static void ni65_xmit_intr(struct net_device *dev,int);
230 static int ni65_open(struct net_device *dev);
231 static int ni65_lance_reinit(struct net_device *dev);
232 static void ni65_init_lance(struct priv *p,unsigned char*,int,int);
233 static netdev_tx_t ni65_send_packet(struct sk_buff *skb,
234 struct net_device *dev);
235 static void ni65_timeout(struct net_device *dev);
236 static int ni65_close(struct net_device *dev);
237 static int ni65_alloc_buffer(struct net_device *dev);
238 static void ni65_free_buffer(struct priv *p);
239 static void set_multicast_list(struct net_device *dev);
240
241 static int irqtab[] __initdata = { 9,12,15,5 }; /* irq config-translate */
242 static int dmatab[] __initdata = { 0,3,5,6,7 }; /* dma config-translate and autodetect */
243
244 static int debuglevel = 1;
245
246 /*
247 * set 'performance' registers .. we must STOP lance for that
248 */
249 static void ni65_set_performance(struct priv *p)
250 {
251 writereg(CSR0_STOP | CSR0_CLRALL,CSR0); /* STOP */
252
253 if( !(cards[p->cardno].config & 0x02) )
254 return;
255
256 outw(80,PORT+L_ADDRREG);
257 if(inw(PORT+L_ADDRREG) != 80)
258 return;
259
260 writereg( (csr80 & 0x3fff) ,80); /* FIFO watermarks */
261 outw(0,PORT+L_ADDRREG);
262 outw((short)isa0,PORT+L_BUSIF); /* write ISA 0: DMA_R : isa0 * 50ns */
263 outw(1,PORT+L_ADDRREG);
264 outw((short)isa1,PORT+L_BUSIF); /* write ISA 1: DMA_W : isa1 * 50ns */
265
266 outw(CSR0,PORT+L_ADDRREG); /* switch back to CSR0 */
267 }
268
269 /*
270 * open interface (up)
271 */
272 static int ni65_open(struct net_device *dev)
273 {
274 struct priv *p = dev->ml_priv;
275 int irqval = request_irq(dev->irq, ni65_interrupt,0,
276 cards[p->cardno].cardname,dev);
277 if (irqval) {
278 printk(KERN_ERR "%s: unable to get IRQ %d (irqval=%d).\n",
279 dev->name,dev->irq, irqval);
280 return -EAGAIN;
281 }
282
283 if(ni65_lance_reinit(dev))
284 {
285 netif_start_queue(dev);
286 return 0;
287 }
288 else
289 {
290 free_irq(dev->irq,dev);
291 return -EAGAIN;
292 }
293 }
294
295 /*
296 * close interface (down)
297 */
298 static int ni65_close(struct net_device *dev)
299 {
300 struct priv *p = dev->ml_priv;
301
302 netif_stop_queue(dev);
303
304 outw(inw(PORT+L_RESET),PORT+L_RESET); /* that's the hard way */
305
306 #ifdef XMT_VIA_SKB
307 {
308 int i;
309 for(i=0;i<TMDNUM;i++)
310 {
311 if(p->tmd_skb[i]) {
312 dev_kfree_skb(p->tmd_skb[i]);
313 p->tmd_skb[i] = NULL;
314 }
315 }
316 }
317 #endif
318 free_irq(dev->irq,dev);
319 return 0;
320 }
321
322 static void cleanup_card(struct net_device *dev)
323 {
324 struct priv *p = dev->ml_priv;
325 disable_dma(dev->dma);
326 free_dma(dev->dma);
327 release_region(dev->base_addr, cards[p->cardno].total_size);
328 ni65_free_buffer(p);
329 }
330
331 /* set: io,irq,dma or set it when calling insmod */
332 static int irq;
333 static int io;
334 static int dma;
335
336 /*
337 * Probe The Card (not the lance-chip)
338 */
339 struct net_device * __init ni65_probe(int unit)
340 {
341 struct net_device *dev = alloc_etherdev(0);
342 static int ports[] = {0x360,0x300,0x320,0x340, 0};
343 int *port;
344 int err = 0;
345
346 if (!dev)
347 return ERR_PTR(-ENOMEM);
348
349 if (unit >= 0) {
350 sprintf(dev->name, "eth%d", unit);
351 netdev_boot_setup_check(dev);
352 irq = dev->irq;
353 dma = dev->dma;
354 } else {
355 dev->base_addr = io;
356 }
357
358 if (dev->base_addr > 0x1ff) { /* Check a single specified location. */
359 err = ni65_probe1(dev, dev->base_addr);
360 } else if (dev->base_addr > 0) { /* Don't probe at all. */
361 err = -ENXIO;
362 } else {
363 for (port = ports; *port && ni65_probe1(dev, *port); port++)
364 ;
365 if (!*port)
366 err = -ENODEV;
367 }
368 if (err)
369 goto out;
370
371 err = register_netdev(dev);
372 if (err)
373 goto out1;
374 return dev;
375 out1:
376 cleanup_card(dev);
377 out:
378 free_netdev(dev);
379 return ERR_PTR(err);
380 }
381
382 static const struct net_device_ops ni65_netdev_ops = {
383 .ndo_open = ni65_open,
384 .ndo_stop = ni65_close,
385 .ndo_start_xmit = ni65_send_packet,
386 .ndo_tx_timeout = ni65_timeout,
387 .ndo_set_multicast_list = set_multicast_list,
388 .ndo_change_mtu = eth_change_mtu,
389 .ndo_set_mac_address = eth_mac_addr,
390 .ndo_validate_addr = eth_validate_addr,
391 };
392
393 /*
394 * this is the real card probe ..
395 */
396 static int __init ni65_probe1(struct net_device *dev,int ioaddr)
397 {
398 int i,j;
399 struct priv *p;
400 unsigned long flags;
401
402 dev->irq = irq;
403 dev->dma = dma;
404
405 for(i=0;i<NUM_CARDS;i++) {
406 if(!request_region(ioaddr, cards[i].total_size, cards[i].cardname))
407 continue;
408 if(cards[i].id_offset >= 0) {
409 if(inb(ioaddr+cards[i].id_offset+0) != cards[i].id0 ||
410 inb(ioaddr+cards[i].id_offset+1) != cards[i].id1) {
411 release_region(ioaddr, cards[i].total_size);
412 continue;
413 }
414 }
415 if(cards[i].vendor_id) {
416 for(j=0;j<3;j++)
417 if(inb(ioaddr+cards[i].addr_offset+j) != cards[i].vendor_id[j]) {
418 release_region(ioaddr, cards[i].total_size);
419 continue;
420 }
421 }
422 break;
423 }
424 if(i == NUM_CARDS)
425 return -ENODEV;
426
427 for(j=0;j<6;j++)
428 dev->dev_addr[j] = inb(ioaddr+cards[i].addr_offset+j);
429
430 if( (j=ni65_alloc_buffer(dev)) < 0) {
431 release_region(ioaddr, cards[i].total_size);
432 return j;
433 }
434 p = dev->ml_priv;
435 p->cmdr_addr = ioaddr + cards[i].cmd_offset;
436 p->cardno = i;
437 spin_lock_init(&p->ring_lock);
438
439 printk(KERN_INFO "%s: %s found at %#3x, ", dev->name, cards[p->cardno].cardname , ioaddr);
440
441 outw(inw(PORT+L_RESET),PORT+L_RESET); /* first: reset the card */
442 if( (j=readreg(CSR0)) != 0x4) {
443 printk("failed.\n");
444 printk(KERN_ERR "%s: Can't RESET card: %04x\n", dev->name, j);
445 ni65_free_buffer(p);
446 release_region(ioaddr, cards[p->cardno].total_size);
447 return -EAGAIN;
448 }
449
450 outw(88,PORT+L_ADDRREG);
451 if(inw(PORT+L_ADDRREG) == 88) {
452 unsigned long v;
453 v = inw(PORT+L_DATAREG);
454 v <<= 16;
455 outw(89,PORT+L_ADDRREG);
456 v |= inw(PORT+L_DATAREG);
457 printk("Version %#08lx, ",v);
458 p->features = INIT_RING_BEFORE_START;
459 }
460 else {
461 printk("ancient LANCE, ");
462 p->features = 0x0;
463 }
464
465 if(test_bit(0,&cards[i].config)) {
466 dev->irq = irqtab[(inw(ioaddr+L_CONFIG)>>2)&3];
467 dev->dma = dmatab[inw(ioaddr+L_CONFIG)&3];
468 printk("IRQ %d (from card), DMA %d (from card).\n",dev->irq,dev->dma);
469 }
470 else {
471 if(dev->dma == 0) {
472 /* 'stuck test' from lance.c */
473 unsigned long dma_channels =
474 ((inb(DMA1_STAT_REG) >> 4) & 0x0f)
475 | (inb(DMA2_STAT_REG) & 0xf0);
476 for(i=1;i<5;i++) {
477 int dma = dmatab[i];
478 if(test_bit(dma,&dma_channels) || request_dma(dma,"ni6510"))
479 continue;
480
481 flags=claim_dma_lock();
482 disable_dma(dma);
483 set_dma_mode(dma,DMA_MODE_CASCADE);
484 enable_dma(dma);
485 release_dma_lock(flags);
486
487 ni65_init_lance(p,dev->dev_addr,0,0); /* trigger memory access */
488
489 flags=claim_dma_lock();
490 disable_dma(dma);
491 free_dma(dma);
492 release_dma_lock(flags);
493
494 if(readreg(CSR0) & CSR0_IDON)
495 break;
496 }
497 if(i == 5) {
498 printk("failed.\n");
499 printk(KERN_ERR "%s: Can't detect DMA channel!\n", dev->name);
500 ni65_free_buffer(p);
501 release_region(ioaddr, cards[p->cardno].total_size);
502 return -EAGAIN;
503 }
504 dev->dma = dmatab[i];
505 printk("DMA %d (autodetected), ",dev->dma);
506 }
507 else
508 printk("DMA %d (assigned), ",dev->dma);
509
510 if(dev->irq < 2)
511 {
512 unsigned long irq_mask;
513
514 ni65_init_lance(p,dev->dev_addr,0,0);
515 irq_mask = probe_irq_on();
516 writereg(CSR0_INIT|CSR0_INEA,CSR0); /* trigger interrupt */
517 msleep(20);
518 dev->irq = probe_irq_off(irq_mask);
519 if(!dev->irq)
520 {
521 printk("Failed to detect IRQ line!\n");
522 ni65_free_buffer(p);
523 release_region(ioaddr, cards[p->cardno].total_size);
524 return -EAGAIN;
525 }
526 printk("IRQ %d (autodetected).\n",dev->irq);
527 }
528 else
529 printk("IRQ %d (assigned).\n",dev->irq);
530 }
531
532 if(request_dma(dev->dma, cards[p->cardno].cardname ) != 0)
533 {
534 printk(KERN_ERR "%s: Can't request dma-channel %d\n",dev->name,(int) dev->dma);
535 ni65_free_buffer(p);
536 release_region(ioaddr, cards[p->cardno].total_size);
537 return -EAGAIN;
538 }
539
540 dev->base_addr = ioaddr;
541 dev->netdev_ops = &ni65_netdev_ops;
542 dev->watchdog_timeo = HZ/2;
543
544 return 0; /* everything is OK */
545 }
546
547 /*
548 * set lance register and trigger init
549 */
550 static void ni65_init_lance(struct priv *p,unsigned char *daddr,int filter,int mode)
551 {
552 int i;
553 u32 pib;
554
555 writereg(CSR0_CLRALL|CSR0_STOP,CSR0);
556
557 for(i=0;i<6;i++)
558 p->ib.eaddr[i] = daddr[i];
559
560 for(i=0;i<8;i++)
561 p->ib.filter[i] = filter;
562 p->ib.mode = mode;
563
564 p->ib.trp = (u32) isa_virt_to_bus(p->tmdhead) | TMDNUMMASK;
565 p->ib.rrp = (u32) isa_virt_to_bus(p->rmdhead) | RMDNUMMASK;
566 writereg(0,CSR3); /* busmaster/no word-swap */
567 pib = (u32) isa_virt_to_bus(&p->ib);
568 writereg(pib & 0xffff,CSR1);
569 writereg(pib >> 16,CSR2);
570
571 writereg(CSR0_INIT,CSR0); /* this changes L_ADDRREG to CSR0 */
572
573 for(i=0;i<32;i++)
574 {
575 mdelay(4);
576 if(inw(PORT+L_DATAREG) & (CSR0_IDON | CSR0_MERR) )
577 break; /* init ok ? */
578 }
579 }
580
581 /*
582 * allocate memory area and check the 16MB border
583 */
584 static void *ni65_alloc_mem(struct net_device *dev,char *what,int size,int type)
585 {
586 struct sk_buff *skb=NULL;
587 unsigned char *ptr;
588 void *ret;
589
590 if(type) {
591 ret = skb = alloc_skb(2+16+size,GFP_KERNEL|GFP_DMA);
592 if(!skb) {
593 printk(KERN_WARNING "%s: unable to allocate %s memory.\n",dev->name,what);
594 return NULL;
595 }
596 skb_reserve(skb,2+16);
597 skb_put(skb,R_BUF_SIZE); /* grab the whole space .. (not necessary) */
598 ptr = skb->data;
599 }
600 else {
601 ret = ptr = kmalloc(T_BUF_SIZE,GFP_KERNEL | GFP_DMA);
602 if(!ret) {
603 printk(KERN_WARNING "%s: unable to allocate %s memory.\n",dev->name,what);
604 return NULL;
605 }
606 }
607 if( (u32) virt_to_phys(ptr+size) > 0x1000000) {
608 printk(KERN_WARNING "%s: unable to allocate %s memory in lower 16MB!\n",dev->name,what);
609 if(type)
610 kfree_skb(skb);
611 else
612 kfree(ptr);
613 return NULL;
614 }
615 return ret;
616 }
617
618 /*
619 * allocate all memory structures .. send/recv buffers etc ...
620 */
621 static int ni65_alloc_buffer(struct net_device *dev)
622 {
623 unsigned char *ptr;
624 struct priv *p;
625 int i;
626
627 /*
628 * we need 8-aligned memory ..
629 */
630 ptr = ni65_alloc_mem(dev,"BUFFER",sizeof(struct priv)+8,0);
631 if(!ptr)
632 return -ENOMEM;
633
634 p = dev->ml_priv = (struct priv *) (((unsigned long) ptr + 7) & ~0x7);
635 memset((char *)p, 0, sizeof(struct priv));
636 p->self = ptr;
637
638 for(i=0;i<TMDNUM;i++)
639 {
640 #ifdef XMT_VIA_SKB
641 p->tmd_skb[i] = NULL;
642 #endif
643 p->tmdbounce[i] = ni65_alloc_mem(dev,"XMIT",T_BUF_SIZE,0);
644 if(!p->tmdbounce[i]) {
645 ni65_free_buffer(p);
646 return -ENOMEM;
647 }
648 }
649
650 for(i=0;i<RMDNUM;i++)
651 {
652 #ifdef RCV_VIA_SKB
653 p->recv_skb[i] = ni65_alloc_mem(dev,"RECV",R_BUF_SIZE,1);
654 if(!p->recv_skb[i]) {
655 ni65_free_buffer(p);
656 return -ENOMEM;
657 }
658 #else
659 p->recvbounce[i] = ni65_alloc_mem(dev,"RECV",R_BUF_SIZE,0);
660 if(!p->recvbounce[i]) {
661 ni65_free_buffer(p);
662 return -ENOMEM;
663 }
664 #endif
665 }
666
667 return 0; /* everything is OK */
668 }
669
670 /*
671 * free buffers and private struct
672 */
673 static void ni65_free_buffer(struct priv *p)
674 {
675 int i;
676
677 if(!p)
678 return;
679
680 for(i=0;i<TMDNUM;i++) {
681 kfree(p->tmdbounce[i]);
682 #ifdef XMT_VIA_SKB
683 if(p->tmd_skb[i])
684 dev_kfree_skb(p->tmd_skb[i]);
685 #endif
686 }
687
688 for(i=0;i<RMDNUM;i++)
689 {
690 #ifdef RCV_VIA_SKB
691 if(p->recv_skb[i])
692 dev_kfree_skb(p->recv_skb[i]);
693 #else
694 kfree(p->recvbounce[i]);
695 #endif
696 }
697 kfree(p->self);
698 }
699
700
701 /*
702 * stop and (re)start lance .. e.g after an error
703 */
704 static void ni65_stop_start(struct net_device *dev,struct priv *p)
705 {
706 int csr0 = CSR0_INEA;
707
708 writedatareg(CSR0_STOP);
709
710 if(debuglevel > 1)
711 printk(KERN_DEBUG "ni65_stop_start\n");
712
713 if(p->features & INIT_RING_BEFORE_START) {
714 int i;
715 #ifdef XMT_VIA_SKB
716 struct sk_buff *skb_save[TMDNUM];
717 #endif
718 unsigned long buffer[TMDNUM];
719 short blen[TMDNUM];
720
721 if(p->xmit_queued) {
722 while(1) {
723 if((p->tmdhead[p->tmdlast].u.s.status & XMIT_OWN))
724 break;
725 p->tmdlast = (p->tmdlast + 1) & (TMDNUM-1);
726 if(p->tmdlast == p->tmdnum)
727 break;
728 }
729 }
730
731 for(i=0;i<TMDNUM;i++) {
732 struct tmd *tmdp = p->tmdhead + i;
733 #ifdef XMT_VIA_SKB
734 skb_save[i] = p->tmd_skb[i];
735 #endif
736 buffer[i] = (u32) isa_bus_to_virt(tmdp->u.buffer);
737 blen[i] = tmdp->blen;
738 tmdp->u.s.status = 0x0;
739 }
740
741 for(i=0;i<RMDNUM;i++) {
742 struct rmd *rmdp = p->rmdhead + i;
743 rmdp->u.s.status = RCV_OWN;
744 }
745 p->tmdnum = p->xmit_queued = 0;
746 writedatareg(CSR0_STRT | csr0);
747
748 for(i=0;i<TMDNUM;i++) {
749 int num = (i + p->tmdlast) & (TMDNUM-1);
750 p->tmdhead[i].u.buffer = (u32) isa_virt_to_bus((char *)buffer[num]); /* status is part of buffer field */
751 p->tmdhead[i].blen = blen[num];
752 if(p->tmdhead[i].u.s.status & XMIT_OWN) {
753 p->tmdnum = (p->tmdnum + 1) & (TMDNUM-1);
754 p->xmit_queued = 1;
755 writedatareg(CSR0_TDMD | CSR0_INEA | csr0);
756 }
757 #ifdef XMT_VIA_SKB
758 p->tmd_skb[i] = skb_save[num];
759 #endif
760 }
761 p->rmdnum = p->tmdlast = 0;
762 if(!p->lock)
763 if (p->tmdnum || !p->xmit_queued)
764 netif_wake_queue(dev);
765 dev->trans_start = jiffies; /* prevent tx timeout */
766 }
767 else
768 writedatareg(CSR0_STRT | csr0);
769 }
770
771 /*
772 * init lance (write init-values .. init-buffers) (open-helper)
773 */
774 static int ni65_lance_reinit(struct net_device *dev)
775 {
776 int i;
777 struct priv *p = dev->ml_priv;
778 unsigned long flags;
779
780 p->lock = 0;
781 p->xmit_queued = 0;
782
783 flags=claim_dma_lock();
784 disable_dma(dev->dma); /* I've never worked with dma, but we do it like the packetdriver */
785 set_dma_mode(dev->dma,DMA_MODE_CASCADE);
786 enable_dma(dev->dma);
787 release_dma_lock(flags);
788
789 outw(inw(PORT+L_RESET),PORT+L_RESET); /* first: reset the card */
790 if( (i=readreg(CSR0) ) != 0x4)
791 {
792 printk(KERN_ERR "%s: can't RESET %s card: %04x\n",dev->name,
793 cards[p->cardno].cardname,(int) i);
794 flags=claim_dma_lock();
795 disable_dma(dev->dma);
796 release_dma_lock(flags);
797 return 0;
798 }
799
800 p->rmdnum = p->tmdnum = p->tmdlast = p->tmdbouncenum = 0;
801 for(i=0;i<TMDNUM;i++)
802 {
803 struct tmd *tmdp = p->tmdhead + i;
804 #ifdef XMT_VIA_SKB
805 if(p->tmd_skb[i]) {
806 dev_kfree_skb(p->tmd_skb[i]);
807 p->tmd_skb[i] = NULL;
808 }
809 #endif
810 tmdp->u.buffer = 0x0;
811 tmdp->u.s.status = XMIT_START | XMIT_END;
812 tmdp->blen = tmdp->status2 = 0;
813 }
814
815 for(i=0;i<RMDNUM;i++)
816 {
817 struct rmd *rmdp = p->rmdhead + i;
818 #ifdef RCV_VIA_SKB
819 rmdp->u.buffer = (u32) isa_virt_to_bus(p->recv_skb[i]->data);
820 #else
821 rmdp->u.buffer = (u32) isa_virt_to_bus(p->recvbounce[i]);
822 #endif
823 rmdp->blen = -(R_BUF_SIZE-8);
824 rmdp->mlen = 0;
825 rmdp->u.s.status = RCV_OWN;
826 }
827
828 if(dev->flags & IFF_PROMISC)
829 ni65_init_lance(p,dev->dev_addr,0x00,M_PROM);
830 else if (netdev_mc_count(dev) || dev->flags & IFF_ALLMULTI)
831 ni65_init_lance(p,dev->dev_addr,0xff,0x0);
832 else
833 ni65_init_lance(p,dev->dev_addr,0x00,0x00);
834
835 /*
836 * ni65_set_lance_mem() sets L_ADDRREG to CSR0
837 * NOW, WE WILL NEVER CHANGE THE L_ADDRREG, CSR0 IS ALWAYS SELECTED
838 */
839
840 if(inw(PORT+L_DATAREG) & CSR0_IDON) {
841 ni65_set_performance(p);
842 /* init OK: start lance , enable interrupts */
843 writedatareg(CSR0_CLRALL | CSR0_INEA | CSR0_STRT);
844 return 1; /* ->OK */
845 }
846 printk(KERN_ERR "%s: can't init lance, status: %04x\n",dev->name,(int) inw(PORT+L_DATAREG));
847 flags=claim_dma_lock();
848 disable_dma(dev->dma);
849 release_dma_lock(flags);
850 return 0; /* ->Error */
851 }
852
853 /*
854 * interrupt handler
855 */
856 static irqreturn_t ni65_interrupt(int irq, void * dev_id)
857 {
858 int csr0 = 0;
859 struct net_device *dev = dev_id;
860 struct priv *p;
861 int bcnt = 32;
862
863 p = dev->ml_priv;
864
865 spin_lock(&p->ring_lock);
866
867 while(--bcnt) {
868 csr0 = inw(PORT+L_DATAREG);
869
870 writedatareg( (csr0 & CSR0_CLRALL) | CSR0_INEA ); /* ack interrupts, interrupts enabled */
871
872 if(!(csr0 & (CSR0_ERR | CSR0_RINT | CSR0_TINT)))
873 break;
874
875 if(csr0 & CSR0_RINT) /* RECV-int? */
876 ni65_recv_intr(dev,csr0);
877 if(csr0 & CSR0_TINT) /* XMIT-int? */
878 ni65_xmit_intr(dev,csr0);
879
880 if(csr0 & CSR0_ERR)
881 {
882 if(debuglevel > 1)
883 printk(KERN_ERR "%s: general error: %04x.\n",dev->name,csr0);
884 if(csr0 & CSR0_BABL)
885 dev->stats.tx_errors++;
886 if(csr0 & CSR0_MISS) {
887 int i;
888 for(i=0;i<RMDNUM;i++)
889 printk("%02x ",p->rmdhead[i].u.s.status);
890 printk("\n");
891 dev->stats.rx_errors++;
892 }
893 if(csr0 & CSR0_MERR) {
894 if(debuglevel > 1)
895 printk(KERN_ERR "%s: Ooops .. memory error: %04x.\n",dev->name,csr0);
896 ni65_stop_start(dev,p);
897 }
898 }
899 }
900
901 #ifdef RCV_PARANOIA_CHECK
902 {
903 int j;
904 for(j=0;j<RMDNUM;j++)
905 {
906 int i, num2;
907 for(i=RMDNUM-1;i>0;i--) {
908 num2 = (p->rmdnum + i) & (RMDNUM-1);
909 if(!(p->rmdhead[num2].u.s.status & RCV_OWN))
910 break;
911 }
912
913 if(i) {
914 int k, num1;
915 for(k=0;k<RMDNUM;k++) {
916 num1 = (p->rmdnum + k) & (RMDNUM-1);
917 if(!(p->rmdhead[num1].u.s.status & RCV_OWN))
918 break;
919 }
920 if(!k)
921 break;
922
923 if(debuglevel > 0)
924 {
925 char buf[256],*buf1;
926 buf1 = buf;
927 for(k=0;k<RMDNUM;k++) {
928 sprintf(buf1,"%02x ",(p->rmdhead[k].u.s.status)); /* & RCV_OWN) ); */
929 buf1 += 3;
930 }
931 *buf1 = 0;
932 printk(KERN_ERR "%s: Ooops, receive ring corrupted %2d %2d | %s\n",dev->name,p->rmdnum,i,buf);
933 }
934
935 p->rmdnum = num1;
936 ni65_recv_intr(dev,csr0);
937 if((p->rmdhead[num2].u.s.status & RCV_OWN))
938 break; /* ok, we are 'in sync' again */
939 }
940 else
941 break;
942 }
943 }
944 #endif
945
946 if( (csr0 & (CSR0_RXON | CSR0_TXON)) != (CSR0_RXON | CSR0_TXON) ) {
947 printk(KERN_DEBUG "%s: RX or TX was offline -> restart\n",dev->name);
948 ni65_stop_start(dev,p);
949 }
950 else
951 writedatareg(CSR0_INEA);
952
953 spin_unlock(&p->ring_lock);
954 return IRQ_HANDLED;
955 }
956
957 /*
958 * We have received an Xmit-Interrupt ..
959 * send a new packet if necessary
960 */
961 static void ni65_xmit_intr(struct net_device *dev,int csr0)
962 {
963 struct priv *p = dev->ml_priv;
964
965 while(p->xmit_queued)
966 {
967 struct tmd *tmdp = p->tmdhead + p->tmdlast;
968 int tmdstat = tmdp->u.s.status;
969
970 if(tmdstat & XMIT_OWN)
971 break;
972
973 if(tmdstat & XMIT_ERR)
974 {
975 /* checking some errors */
976 if(tmdp->status2 & XMIT_RTRY)
977 dev->stats.tx_aborted_errors++;
978 if(tmdp->status2 & XMIT_LCAR)
979 dev->stats.tx_carrier_errors++;
980 if(tmdp->status2 & (XMIT_BUFF | XMIT_UFLO )) {
981 /* this stops the xmitter */
982 dev->stats.tx_fifo_errors++;
983 if(debuglevel > 0)
984 printk(KERN_ERR "%s: Xmit FIFO/BUFF error\n",dev->name);
985 if(p->features & INIT_RING_BEFORE_START) {
986 tmdp->u.s.status = XMIT_OWN | XMIT_START | XMIT_END; /* test: resend this frame */
987 ni65_stop_start(dev,p);
988 break; /* no more Xmit processing .. */
989 }
990 else
991 ni65_stop_start(dev,p);
992 }
993 if(debuglevel > 2)
994 printk(KERN_ERR "%s: xmit-error: %04x %02x-%04x\n",dev->name,csr0,(int) tmdstat,(int) tmdp->status2);
995 if(!(csr0 & CSR0_BABL)) /* don't count errors twice */
996 dev->stats.tx_errors++;
997 tmdp->status2 = 0;
998 }
999 else {
1000 dev->stats.tx_bytes -= (short)(tmdp->blen);
1001 dev->stats.tx_packets++;
1002 }
1003
1004 #ifdef XMT_VIA_SKB
1005 if(p->tmd_skb[p->tmdlast]) {
1006 dev_kfree_skb_irq(p->tmd_skb[p->tmdlast]);
1007 p->tmd_skb[p->tmdlast] = NULL;
1008 }
1009 #endif
1010
1011 p->tmdlast = (p->tmdlast + 1) & (TMDNUM-1);
1012 if(p->tmdlast == p->tmdnum)
1013 p->xmit_queued = 0;
1014 }
1015 netif_wake_queue(dev);
1016 }
1017
1018 /*
1019 * We have received a packet
1020 */
1021 static void ni65_recv_intr(struct net_device *dev,int csr0)
1022 {
1023 struct rmd *rmdp;
1024 int rmdstat,len;
1025 int cnt=0;
1026 struct priv *p = dev->ml_priv;
1027
1028 rmdp = p->rmdhead + p->rmdnum;
1029 while(!( (rmdstat = rmdp->u.s.status) & RCV_OWN))
1030 {
1031 cnt++;
1032 if( (rmdstat & (RCV_START | RCV_END | RCV_ERR)) != (RCV_START | RCV_END) ) /* error or oversized? */
1033 {
1034 if(!(rmdstat & RCV_ERR)) {
1035 if(rmdstat & RCV_START)
1036 {
1037 dev->stats.rx_length_errors++;
1038 printk(KERN_ERR "%s: recv, packet too long: %d\n",dev->name,rmdp->mlen & 0x0fff);
1039 }
1040 }
1041 else {
1042 if(debuglevel > 2)
1043 printk(KERN_ERR "%s: receive-error: %04x, lance-status: %04x/%04x\n",
1044 dev->name,(int) rmdstat,csr0,(int) inw(PORT+L_DATAREG) );
1045 if(rmdstat & RCV_FRAM)
1046 dev->stats.rx_frame_errors++;
1047 if(rmdstat & RCV_OFLO)
1048 dev->stats.rx_over_errors++;
1049 if(rmdstat & RCV_CRC)
1050 dev->stats.rx_crc_errors++;
1051 if(rmdstat & RCV_BUF_ERR)
1052 dev->stats.rx_fifo_errors++;
1053 }
1054 if(!(csr0 & CSR0_MISS)) /* don't count errors twice */
1055 dev->stats.rx_errors++;
1056 }
1057 else if( (len = (rmdp->mlen & 0x0fff) - 4) >= 60)
1058 {
1059 #ifdef RCV_VIA_SKB
1060 struct sk_buff *skb = alloc_skb(R_BUF_SIZE+2+16,GFP_ATOMIC);
1061 if (skb)
1062 skb_reserve(skb,16);
1063 #else
1064 struct sk_buff *skb = dev_alloc_skb(len+2);
1065 #endif
1066 if(skb)
1067 {
1068 skb_reserve(skb,2);
1069 #ifdef RCV_VIA_SKB
1070 if( (unsigned long) (skb->data + R_BUF_SIZE) > 0x1000000) {
1071 skb_put(skb,len);
1072 skb_copy_to_linear_data(skb, (unsigned char *)(p->recv_skb[p->rmdnum]->data),len);
1073 }
1074 else {
1075 struct sk_buff *skb1 = p->recv_skb[p->rmdnum];
1076 skb_put(skb,R_BUF_SIZE);
1077 p->recv_skb[p->rmdnum] = skb;
1078 rmdp->u.buffer = (u32) isa_virt_to_bus(skb->data);
1079 skb = skb1;
1080 skb_trim(skb,len);
1081 }
1082 #else
1083 skb_put(skb,len);
1084 skb_copy_to_linear_data(skb, (unsigned char *) p->recvbounce[p->rmdnum],len);
1085 #endif
1086 dev->stats.rx_packets++;
1087 dev->stats.rx_bytes += len;
1088 skb->protocol=eth_type_trans(skb,dev);
1089 netif_rx(skb);
1090 }
1091 else
1092 {
1093 printk(KERN_ERR "%s: can't alloc new sk_buff\n",dev->name);
1094 dev->stats.rx_dropped++;
1095 }
1096 }
1097 else {
1098 printk(KERN_INFO "%s: received runt packet\n",dev->name);
1099 dev->stats.rx_errors++;
1100 }
1101 rmdp->blen = -(R_BUF_SIZE-8);
1102 rmdp->mlen = 0;
1103 rmdp->u.s.status = RCV_OWN; /* change owner */
1104 p->rmdnum = (p->rmdnum + 1) & (RMDNUM-1);
1105 rmdp = p->rmdhead + p->rmdnum;
1106 }
1107 }
1108
1109 /*
1110 * kick xmitter ..
1111 */
1112
1113 static void ni65_timeout(struct net_device *dev)
1114 {
1115 int i;
1116 struct priv *p = dev->ml_priv;
1117
1118 printk(KERN_ERR "%s: xmitter timed out, try to restart!\n",dev->name);
1119 for(i=0;i<TMDNUM;i++)
1120 printk("%02x ",p->tmdhead[i].u.s.status);
1121 printk("\n");
1122 ni65_lance_reinit(dev);
1123 dev->trans_start = jiffies; /* prevent tx timeout */
1124 netif_wake_queue(dev);
1125 }
1126
1127 /*
1128 * Send a packet
1129 */
1130
1131 static netdev_tx_t ni65_send_packet(struct sk_buff *skb,
1132 struct net_device *dev)
1133 {
1134 struct priv *p = dev->ml_priv;
1135
1136 netif_stop_queue(dev);
1137
1138 if (test_and_set_bit(0, (void*)&p->lock)) {
1139 printk(KERN_ERR "%s: Queue was locked.\n", dev->name);
1140 return NETDEV_TX_BUSY;
1141 }
1142
1143 {
1144 short len = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
1145 struct tmd *tmdp;
1146 unsigned long flags;
1147
1148 #ifdef XMT_VIA_SKB
1149 if( (unsigned long) (skb->data + skb->len) > 0x1000000) {
1150 #endif
1151
1152 skb_copy_from_linear_data(skb, p->tmdbounce[p->tmdbouncenum],
1153 skb->len > T_BUF_SIZE ? T_BUF_SIZE :
1154 skb->len);
1155 if (len > skb->len)
1156 memset((char *)p->tmdbounce[p->tmdbouncenum]+skb->len, 0, len-skb->len);
1157 dev_kfree_skb (skb);
1158
1159 spin_lock_irqsave(&p->ring_lock, flags);
1160 tmdp = p->tmdhead + p->tmdnum;
1161 tmdp->u.buffer = (u32) isa_virt_to_bus(p->tmdbounce[p->tmdbouncenum]);
1162 p->tmdbouncenum = (p->tmdbouncenum + 1) & (TMDNUM - 1);
1163
1164 #ifdef XMT_VIA_SKB
1165 }
1166 else {
1167 spin_lock_irqsave(&p->ring_lock, flags);
1168
1169 tmdp = p->tmdhead + p->tmdnum;
1170 tmdp->u.buffer = (u32) isa_virt_to_bus(skb->data);
1171 p->tmd_skb[p->tmdnum] = skb;
1172 }
1173 #endif
1174 tmdp->blen = -len;
1175
1176 tmdp->u.s.status = XMIT_OWN | XMIT_START | XMIT_END;
1177 writedatareg(CSR0_TDMD | CSR0_INEA); /* enable xmit & interrupt */
1178
1179 p->xmit_queued = 1;
1180 p->tmdnum = (p->tmdnum + 1) & (TMDNUM-1);
1181
1182 if(p->tmdnum != p->tmdlast)
1183 netif_wake_queue(dev);
1184
1185 p->lock = 0;
1186
1187 spin_unlock_irqrestore(&p->ring_lock, flags);
1188 }
1189
1190 return NETDEV_TX_OK;
1191 }
1192
1193 static void set_multicast_list(struct net_device *dev)
1194 {
1195 if(!ni65_lance_reinit(dev))
1196 printk(KERN_ERR "%s: Can't switch card into MC mode!\n",dev->name);
1197 netif_wake_queue(dev);
1198 }
1199
1200 #ifdef MODULE
1201 static struct net_device *dev_ni65;
1202
1203 module_param(irq, int, 0);
1204 module_param(io, int, 0);
1205 module_param(dma, int, 0);
1206 MODULE_PARM_DESC(irq, "ni6510 IRQ number (ignored for some cards)");
1207 MODULE_PARM_DESC(io, "ni6510 I/O base address");
1208 MODULE_PARM_DESC(dma, "ni6510 ISA DMA channel (ignored for some cards)");
1209
1210 int __init init_module(void)
1211 {
1212 dev_ni65 = ni65_probe(-1);
1213 return IS_ERR(dev_ni65) ? PTR_ERR(dev_ni65) : 0;
1214 }
1215
1216 void __exit cleanup_module(void)
1217 {
1218 unregister_netdev(dev_ni65);
1219 cleanup_card(dev_ni65);
1220 free_netdev(dev_ni65);
1221 }
1222 #endif /* MODULE */
1223
1224 MODULE_LICENSE("GPL");
Tomato firmware and modifications.