1
2
3
4
5
6
7
8
9
10
11
12
13
14
15static char *version = "bagetlance.c: v1.1 11/10/98\n";
16
17#include <linux/module.h>
18#include <linux/stddef.h>
19#include <linux/kernel.h>
20#include <linux/string.h>
21#include <linux/errno.h>
22#include <linux/slab.h>
23#include <linux/interrupt.h>
24#include <linux/init.h>
25#include <linux/netdevice.h>
26#include <linux/etherdevice.h>
27#include <linux/skbuff.h>
28
29#include <asm/irq.h>
30#include <asm/bitops.h>
31#include <asm/io.h>
32#include <asm/baget/baget.h>
33
34#define BAGET_LANCE_IRQ BAGET_IRQ_MASK(0xdf)
35
36
37
38
39
40#undef NORMAL_MEM_ACCESS
41
42
43
44
45
46
47
48
49#define LANCE_DEBUG 1
50
51#ifdef LANCE_DEBUG
52static int lance_debug = LANCE_DEBUG;
53#else
54static int lance_debug = 1;
55#endif
56MODULE_PARM(lance_debug, "i");
57MODULE_PARM_DESC(lance_debug, "Lance debug level (0-3)");
58MODULE_LICENSE("GPL");
59
60
61#undef LANCE_DEBUG_PROBE
62
63#define DPRINTK(n,a) \
64 do { \
65 if (lance_debug >= n) \
66 printk a; \
67 } while( 0 )
68
69#ifdef LANCE_DEBUG_PROBE
70# define PROBE_PRINT(a) printk a
71#else
72# define PROBE_PRINT(a)
73#endif
74
75
76
77
78
79
80
81
82
83
84
85#define TX_LOG_RING_SIZE 3
86#define RX_LOG_RING_SIZE 5
87
88
89
90#define TX_RING_SIZE (1 << TX_LOG_RING_SIZE)
91#define TX_RING_LEN_BITS (TX_LOG_RING_SIZE << 5)
92#define TX_RING_MOD_MASK (TX_RING_SIZE - 1)
93
94#define RX_RING_SIZE (1 << RX_LOG_RING_SIZE)
95#define RX_RING_LEN_BITS (RX_LOG_RING_SIZE << 5)
96#define RX_RING_MOD_MASK (RX_RING_SIZE - 1)
97
98
99struct lance_rx_head {
100 volatile unsigned short base;
101#ifdef NORMAL_MEM_ACCESS
102
103
104 volatile unsigned char flag;
105 unsigned char base_hi;
106#else
107
108#define GET_FLAG(h) (((h)->flag_base_hi >> 8) & 0xff)
109#define SET_FLAG(h,f) (h)->flag_base_hi = ((h)->flag_base_hi & 0xff) | \
110 (((unsigned)(f)) << 8)
111 volatile unsigned short flag_base_hi;
112#endif
113 volatile short buf_length;
114 volatile short msg_length;
115};
116
117
118struct lance_tx_head {
119 volatile unsigned short base;
120#ifdef NORMAL_MEM_ACCESS
121
122 volatile unsigned char flag;
123 unsigned char base_hi;
124#else
125 volatile unsigned short flag_base_hi;
126#endif
127 volatile short length;
128 volatile short misc;
129};
130
131struct ringdesc {
132 volatile unsigned short adr_lo;
133#ifdef NORMAL_MEM_ACCESS
134
135 unsigned char len;
136 unsigned char adr_hi;
137#else
138 volatile unsigned short len_adr_hi;
139#endif
140};
141
142
143struct lance_init_block {
144 unsigned short mode;
145 unsigned char hwaddr[6];
146 unsigned filter[2];
147
148 struct ringdesc rx_ring;
149 struct ringdesc tx_ring;
150};
151
152
153struct lance_memory {
154 struct lance_init_block init;
155 struct lance_tx_head tx_head[TX_RING_SIZE];
156 struct lance_rx_head rx_head[RX_RING_SIZE];
157 char packet_area[0];
158
159
160
161};
162
163
164
165
166
167
168
169
170#define RIEBL_RSVD_START 0xee70
171#define RIEBL_RSVD_END 0xeec0
172#define RIEBL_MAGIC 0x09051990
173#define RIEBL_MAGIC_ADDR ((unsigned long *)(((char *)MEM) + 0xee8a))
174#define RIEBL_HWADDR_ADDR ((unsigned char *)(((char *)MEM) + 0xee8e))
175#define RIEBL_IVEC_ADDR ((unsigned short *)(((char *)MEM) + 0xfffe))
176
177
178
179
180
181
182static unsigned char OldRieblDefHwaddr[6] = {
183 0x00, 0x00, 0x36, 0x04, 0x00, 0x00
184};
185
186
187
188struct lance_ioreg {
189 volatile unsigned short data;
190 volatile unsigned short addr;
191 unsigned char _dummy1[3];
192 volatile unsigned char ivec;
193 unsigned char _dummy2[5];
194 volatile unsigned char eeprom;
195 unsigned char _dummy3;
196 volatile unsigned char mem;
197};
198
199
200
201enum lance_type {
202 OLD_RIEBL,
203 NEW_RIEBL,
204 PAM_CARD
205};
206
207static char *lance_names[] = {
208 "Riebl-Card (without battery)",
209 "Riebl-Card (with battery)",
210 "PAM intern card"
211};
212
213
214
215struct lance_private {
216 enum lance_type cardtype;
217 struct lance_ioreg *iobase;
218 struct lance_memory *mem;
219 int cur_rx, cur_tx;
220 int dirty_tx;
221
222 void *(*memcpy_f)( void *, const void *, size_t );
223 struct net_device_stats stats;
224
225 long tx_full;
226 long lock;
227};
228
229
230
231#define MEM lp->mem
232#define DREG IO->data
233#define AREG IO->addr
234#define REGA(a) ( AREG = (a), DREG )
235
236
237#define PKT_BUF_SZ 1544
238
239#define PKTBUF_ADDR(head) (((unsigned char *)(MEM)) + (head)->base)
240
241
242
243struct lance_addr {
244 unsigned long memaddr;
245 unsigned long ioaddr;
246 int slow_flag;
247} lance_addr_list[] = {
248 { BAGET_LANCE_MEM_BASE, BAGET_LANCE_IO_BASE, 1 }
249};
250
251#define N_LANCE_ADDR (sizeof(lance_addr_list)/sizeof(*lance_addr_list))
252
253
254#define LANCE_HI_BASE (0xff & (BAGET_LANCE_MEM_BASE >> 16))
255
256
257
258
259#define TMD1_ENP 0x01
260#define TMD1_STP 0x02
261#define TMD1_DEF 0x04
262#define TMD1_ONE 0x08
263#define TMD1_MORE 0x10
264#define TMD1_ERR 0x40
265#define TMD1_OWN 0x80
266
267#define TMD1_OWN_CHIP TMD1_OWN
268#define TMD1_OWN_HOST 0
269
270
271#define TMD3_TDR 0x03FF
272#define TMD3_RTRY 0x0400
273#define TMD3_LCAR 0x0800
274#define TMD3_LCOL 0x1000
275#define TMD3_UFLO 0x4000
276#define TMD3_BUFF 0x8000
277
278
279#define RMD1_ENP 0x01
280#define RMD1_STP 0x02
281#define RMD1_BUFF 0x04
282#define RMD1_CRC 0x08
283#define RMD1_OFLO 0x10
284#define RMD1_FRAM 0x20
285#define RMD1_ERR 0x40
286#define RMD1_OWN 0x80
287
288#define RMD1_OWN_CHIP RMD1_OWN
289#define RMD1_OWN_HOST 0
290
291
292#define CSR0 0
293#define CSR1 1
294#define CSR2 2
295#define CSR3 3
296#define CSR8 8
297#define CSR15 15
298
299
300
301#define CSR0_INIT 0x0001
302#define CSR0_STRT 0x0002
303#define CSR0_STOP 0x0004
304#define CSR0_TDMD 0x0008
305#define CSR0_TXON 0x0010
306#define CSR0_RXON 0x0020
307#define CSR0_INEA 0x0040
308#define CSR0_INTR 0x0080
309#define CSR0_IDON 0x0100
310#define CSR0_TINT 0x0200
311#define CSR0_RINT 0x0400
312#define CSR0_MERR 0x0800
313#define CSR0_MISS 0x1000
314#define CSR0_CERR 0x2000
315#define CSR0_BABL 0x4000
316#define CSR0_ERR 0x8000
317
318
319#define CSR3_BCON 0x0001
320#define CSR3_ACON 0
321#define CSR3_BSWP 0x0004
322
323
324
325
326
327static int addr_accessible( volatile void *regp, int wordflag, int
328 writeflag );
329static int lance_probe1( struct net_device *dev, struct lance_addr *init_rec );
330static int lance_open( struct net_device *dev );
331static void lance_init_ring( struct net_device *dev );
332static int lance_start_xmit( struct sk_buff *skb, struct net_device *dev );
333static irqreturn_t lance_interrupt( int irq, void *dev_id, struct pt_regs *fp );
334static int lance_rx( struct net_device *dev );
335static int lance_close( struct net_device *dev );
336static struct net_device_stats *lance_get_stats( struct net_device *dev );
337static void set_multicast_list( struct net_device *dev );
338static int lance_set_mac_address( struct net_device *dev, void *addr );
339
340
341
342
343
344int lance_stat = 0;
345
346static void update_lance_stat (int len) {
347 lance_stat += len;
348}
349
350
351
352
353
354
355
356
357void *slow_memcpy( void *dst, const void *src, size_t len )
358
359{
360 unsigned long to = (unsigned long)dst;
361 unsigned long from = (unsigned long)src;
362 unsigned long to_end = to +len;
363
364
365
366 int odd_from = from & 1;
367 int odd_to = to & 1;
368 int odd_to_end = to_end & 1;
369
370
371
372 register unsigned short *from_a = (unsigned short*) (from & ~1);
373 register unsigned short *to_a = (unsigned short*) (to & ~1);
374 register unsigned short *to_end_a = (unsigned short*) (to_end & ~1);
375
376
377
378 register unsigned short from_v;
379 register unsigned short to_v;
380
381
382
383
384 if (odd_to) {
385
386 from_v = *from_a;
387 to_v = *to_a;
388
389 to_v &= ~0xff;
390 to_v |= 0xff & (from_v >> (odd_from ? 0 : 8));
391 *to_a++ = to_v;
392
393 if (odd_from) from_a++;
394 }
395 if (odd_from == odd_to) {
396
397 while (to_a + 7 < to_end_a) {
398 unsigned long dummy1, dummy2;
399 unsigned long reg1, reg2, reg3, reg4;
400
401 __asm__ __volatile__(
402 ".set\tnoreorder\n\t"
403 ".set\tnoat\n\t"
404 "lh\t%2,0(%1)\n\t"
405 "nop\n\t"
406 "lh\t%3,2(%1)\n\t"
407 "sh\t%2,0(%0)\n\t"
408 "lh\t%4,4(%1)\n\t"
409 "sh\t%3,2(%0)\n\t"
410 "lh\t%5,6(%1)\n\t"
411 "sh\t%4,4(%0)\n\t"
412 "lh\t%2,8(%1)\n\t"
413 "sh\t%5,6(%0)\n\t"
414 "lh\t%3,10(%1)\n\t"
415 "sh\t%2,8(%0)\n\t"
416 "lh\t%4,12(%1)\n\t"
417 "sh\t%3,10(%0)\n\t"
418 "lh\t%5,14(%1)\n\t"
419 "sh\t%4,12(%0)\n\t"
420 "nop\n\t"
421 "sh\t%5,14(%0)\n\t"
422 ".set\tat\n\t"
423 ".set\treorder"
424 :"=r" (dummy1), "=r" (dummy2),
425 "=&r" (reg1), "=&r" (reg2), "=&r" (reg3), "=&r" (reg4)
426 :"0" (to_a), "1" (from_a)
427 :"memory");
428
429 to_a += 8;
430 from_a += 8;
431
432 }
433 while (to_a < to_end_a) {
434 *to_a++ = *from_a++;
435 }
436 } else {
437
438 from_v = *from_a;
439 while (to_a < to_end_a) {
440 unsigned short from_v_next;
441 from_v_next = *++from_a;
442 *to_a++ = ((from_v & 0xff)<<8) | ((from_v_next>>8) & 0xff);
443 from_v = from_v_next;
444 }
445
446 }
447 if (odd_to_end) {
448
449 to_v = *to_a;
450 from_v = *from_a;
451
452 to_v &= ~0xff00;
453 if (odd_from == odd_to) {
454 to_v |= from_v & 0xff00;
455 } else {
456 to_v |= (from_v<<8) & 0xff00;
457 }
458
459 *to_a = to_v;
460 }
461
462 update_lance_stat( len );
463
464 return( dst );
465}
466
467
468int __init bagetlance_probe( struct net_device *dev )
469
470{ int i;
471 static int found;
472
473 SET_MODULE_OWNER(dev);
474
475 if (found)
476
477
478 return( -ENODEV );
479
480 for( i = 0; i < N_LANCE_ADDR; ++i ) {
481 if (lance_probe1( dev, &lance_addr_list[i] )) {
482 found = 1;
483 return( 0 );
484 }
485 }
486
487 return( -ENODEV );
488}
489
490
491
492
493
494static int __init addr_accessible( volatile void *regp,
495 int wordflag,
496 int writeflag )
497{
498
499 extern int try_read(unsigned long, int);
500 return try_read((unsigned long)regp, sizeof(short)) != -1;
501}
502
503
504
505
506#define IRQ_TYPE_PRIO SA_INTERRUPT
507#define IRQ_SOURCE_TO_VECTOR(x) (x)
508
509static int __init lance_probe1( struct net_device *dev,
510 struct lance_addr *init_rec )
511
512{ volatile unsigned short *memaddr =
513 (volatile unsigned short *)init_rec->memaddr;
514 volatile unsigned short *ioaddr =
515 (volatile unsigned short *)init_rec->ioaddr;
516 struct lance_private *lp;
517 struct lance_ioreg *IO;
518 int i;
519 static int did_version;
520 unsigned short save1, save2;
521
522 PROBE_PRINT(( "Probing for Lance card at mem %#lx io %#lx\n",
523 (long)memaddr, (long)ioaddr ));
524
525
526 PROBE_PRINT(( "lance_probe1: testing memory to be accessible\n" ));
527 if (!addr_accessible( memaddr, 1, 1 )) goto probe_fail;
528
529 if ((unsigned long)memaddr >= KSEG2) {
530 extern int kseg2_alloc_io (unsigned long addr, unsigned long size);
531 if (kseg2_alloc_io((unsigned long)memaddr, BAGET_LANCE_MEM_SIZE)) {
532 printk("bagetlance: unable map lance memory\n");
533 goto probe_fail;
534 }
535 }
536
537
538 PROBE_PRINT(( "lance_probe1: testing memory to be writable (1)\n" ));
539 save1 = *memaddr;
540 *memaddr = 0x0001;
541 if (*memaddr != 0x0001) goto probe_fail;
542 PROBE_PRINT(( "lance_probe1: testing memory to be writable (2)\n" ));
543 *memaddr = 0x0000;
544 if (*memaddr != 0x0000) goto probe_fail;
545 *memaddr = save1;
546
547
548 PROBE_PRINT(( "lance_probe1: testing ioport to be accessible\n" ));
549 if (!addr_accessible( ioaddr, 1, 1 )) goto probe_fail;
550
551
552 PROBE_PRINT(( "lance_probe1: testing ioport to be writeable\n" ));
553 save2 = ioaddr[1];
554 ioaddr[1] = 0x0001;
555 if (ioaddr[1] != 0x0001) goto probe_fail;
556
557
558 PROBE_PRINT(( "lance_probe1: testing CSR0 register function (1)\n" ));
559 save1 = ioaddr[0];
560 ioaddr[1] = CSR0;
561 ioaddr[0] = CSR0_INIT | CSR0_STOP;
562 if (ioaddr[0] != CSR0_STOP) {
563 ioaddr[0] = save1;
564 ioaddr[1] = save2;
565 goto probe_fail;
566 }
567 PROBE_PRINT(( "lance_probe1: testing CSR0 register function (2)\n" ));
568 ioaddr[0] = CSR0_STOP;
569 if (ioaddr[0] != CSR0_STOP) {
570 ioaddr[0] = save1;
571 ioaddr[1] = save2;
572 goto probe_fail;
573 }
574
575
576 PROBE_PRINT(( "lance_probe1: Lance card detected\n" ));
577 goto probe_ok;
578
579 probe_fail:
580 return( 0 );
581
582 probe_ok:
583 init_etherdev( dev, sizeof(struct lance_private) );
584 if (!dev->priv) {
585 dev->priv = kmalloc( sizeof(struct lance_private), GFP_KERNEL );
586 if (!dev->priv)
587 return 0;
588 }
589 lp = (struct lance_private *)dev->priv;
590 MEM = (struct lance_memory *)memaddr;
591 IO = lp->iobase = (struct lance_ioreg *)ioaddr;
592 dev->base_addr = (unsigned long)ioaddr;
593 lp->memcpy_f = init_rec->slow_flag ? slow_memcpy : memcpy;
594
595 REGA( CSR0 ) = CSR0_STOP;
596
597
598
599 if (addr_accessible( &(IO->eeprom), 0, 0 )) {
600
601 i = IO->mem;
602 lp->cardtype = PAM_CARD;
603 }
604#ifdef NORMAL_MEM_ACCESS
605 else if (*RIEBL_MAGIC_ADDR == RIEBL_MAGIC) {
606#else
607 else if (({
608 unsigned short *a = (unsigned short*)RIEBL_MAGIC_ADDR;
609 (((int)a[0]) << 16) + ((int)a[1]) == RIEBL_MAGIC;
610 })) {
611#endif
612 lp->cardtype = NEW_RIEBL;
613 }
614 else
615 lp->cardtype = OLD_RIEBL;
616
617 if (lp->cardtype == PAM_CARD ||
618 memaddr == (unsigned short *)0xffe00000) {
619
620 request_irq(BAGET_LANCE_IRQ, lance_interrupt, IRQ_TYPE_PRIO,
621 "PAM/Riebl-ST Ethernet", dev);
622 dev->irq = (unsigned short)BAGET_LANCE_IRQ;
623 }
624 else {
625
626
627
628
629 unsigned long irq = BAGET_LANCE_IRQ;
630 if (!irq) {
631 printk( "Lance: request for VME interrupt failed\n" );
632 return( 0 );
633 }
634 request_irq(irq, lance_interrupt, IRQ_TYPE_PRIO,
635 "Riebl-VME Ethernet", dev);
636 dev->irq = irq;
637 }
638
639 printk("%s: %s at io %#lx, mem %#lx, irq %d%s, hwaddr ",
640 dev->name, lance_names[lp->cardtype],
641 (unsigned long)ioaddr,
642 (unsigned long)memaddr,
643 dev->irq,
644 init_rec->slow_flag ? " (slow memcpy)" : "" );
645
646
647 switch( lp->cardtype ) {
648 case OLD_RIEBL:
649
650 slow_memcpy( dev->dev_addr, OldRieblDefHwaddr, 6 );
651 break;
652 case NEW_RIEBL:
653 lp->memcpy_f( dev->dev_addr, RIEBL_HWADDR_ADDR, 6 );
654 break;
655 case PAM_CARD:
656 i = IO->eeprom;
657 for( i = 0; i < 6; ++i )
658 dev->dev_addr[i] =
659 ((((unsigned short *)MEM)[i*2] & 0x0f) << 4) |
660 ((((unsigned short *)MEM)[i*2+1] & 0x0f));
661 i = IO->mem;
662 break;
663 }
664 for( i = 0; i < 6; ++i )
665 printk( "%02x%s", dev->dev_addr[i], (i < 5) ? ":" : "\n" );
666 if (lp->cardtype == OLD_RIEBL) {
667 printk( "%s: Warning: This is a default ethernet address!\n",
668 dev->name );
669 printk( " Use \"ifconfig hw ether ...\" to set the address.\n" );
670 }
671
672 MEM->init.mode = 0x0000;
673
674 {
675 unsigned char hwaddr[6];
676 for( i = 0; i < 6; i++ )
677 hwaddr[i] = dev->dev_addr[i^1];
678 slow_memcpy(MEM->init.hwaddr, hwaddr, sizeof(hwaddr));
679 }
680
681 MEM->init.filter[0] = 0x00000000;
682 MEM->init.filter[1] = 0x00000000;
683 MEM->init.rx_ring.adr_lo = offsetof( struct lance_memory, rx_head );
684
685#ifdef NORMAL_MEM_ACCESS
686 MEM->init.rx_ring.adr_hi = LANCE_HI_BASE;
687 MEM->init.rx_ring.len = RX_RING_LEN_BITS;
688#else
689 MEM->init.rx_ring.len_adr_hi =
690 ((unsigned)RX_RING_LEN_BITS << 8) | LANCE_HI_BASE;
691#endif
692
693
694 MEM->init.tx_ring.adr_lo = offsetof( struct lance_memory, tx_head );
695
696#ifdef NORMAL_MEM_ACCESS
697 MEM->init.tx_ring.adr_hi = LANCE_HI_BASE;
698 MEM->init.tx_ring.len = TX_RING_LEN_BITS;
699#else
700 MEM->init.tx_ring.len_adr_hi =
701 ((unsigned)TX_RING_LEN_BITS<<8) | LANCE_HI_BASE;
702#endif
703
704 if (lp->cardtype == PAM_CARD)
705 IO->ivec = IRQ_SOURCE_TO_VECTOR(dev->irq);
706 else
707 *RIEBL_IVEC_ADDR = IRQ_SOURCE_TO_VECTOR(dev->irq);
708
709 if (did_version++ == 0)
710 DPRINTK( 1, ( version ));
711
712
713 dev->open = &lance_open;
714 dev->hard_start_xmit = &lance_start_xmit;
715 dev->stop = &lance_close;
716 dev->get_stats = &lance_get_stats;
717 dev->set_multicast_list = &set_multicast_list;
718 dev->set_mac_address = &lance_set_mac_address;
719 dev->start = 0;
720
721 memset( &lp->stats, 0, sizeof(lp->stats) );
722
723 return( 1 );
724}
725
726
727static int lance_open( struct net_device *dev )
728
729{ struct lance_private *lp = (struct lance_private *)dev->priv;
730 struct lance_ioreg *IO = lp->iobase;
731 int i;
732
733 DPRINTK( 2, ( "%s: lance_open()\n", dev->name ));
734
735 lance_init_ring(dev);
736
737
738 REGA( CSR3 ) = CSR3_BSWP | (lp->cardtype == PAM_CARD ? CSR3_ACON : 0);
739 REGA( CSR2 ) = 0;
740 REGA( CSR1 ) = 0;
741 REGA( CSR0 ) = CSR0_INIT;
742
743
744 i = 1000000;
745 while (--i > 0)
746 if (DREG & CSR0_IDON)
747 break;
748 if (i < 0 || (DREG & CSR0_ERR)) {
749 DPRINTK( 2, ( "lance_open(): opening %s failed, i=%d, csr0=%04x\n",
750 dev->name, i, DREG ));
751 DREG = CSR0_STOP;
752 return( -EIO );
753 }
754 DREG = CSR0_IDON;
755 DREG = CSR0_STRT;
756 DREG = CSR0_INEA;
757
758 dev->tbusy = 0;
759 dev->interrupt = 0;
760 dev->start = 1;
761
762 DPRINTK( 2, ( "%s: LANCE is open, csr0 %04x\n", dev->name, DREG ));
763 return( 0 );
764}
765
766
767
768
769static void lance_init_ring( struct net_device *dev )
770
771{ struct lance_private *lp = (struct lance_private *)dev->priv;
772 int i;
773 unsigned offset;
774
775 lp->lock = 0;
776 lp->tx_full = 0;
777 lp->cur_rx = lp->cur_tx = 0;
778 lp->dirty_tx = 0;
779
780 offset = offsetof( struct lance_memory, packet_area );
781
782
783
784#define CHECK_OFFSET(o) \
785 do { \
786 if (lp->cardtype == OLD_RIEBL || lp->cardtype == NEW_RIEBL) { \
787 if (((o) < RIEBL_RSVD_START) ? (o)+PKT_BUF_SZ > RIEBL_RSVD_START \
788 : (o) < RIEBL_RSVD_END) \
789 (o) = RIEBL_RSVD_END; \
790 } \
791 } while(0)
792
793 for( i = 0; i < TX_RING_SIZE; i++ ) {
794 CHECK_OFFSET(offset);
795 MEM->tx_head[i].base = offset;
796#ifdef NORMAL_MEM_ACCESS
797 MEM->tx_head[i].flag = TMD1_OWN_HOST;
798 MEM->tx_head[i].base_hi = LANCE_HI_BASE;
799#else
800 MEM->tx_head[i].flag_base_hi =
801 (TMD1_OWN_HOST<<8) | LANCE_HI_BASE;
802#endif
803 MEM->tx_head[i].length = 0;
804 MEM->tx_head[i].misc = 0;
805 offset += PKT_BUF_SZ;
806 }
807
808 for( i = 0; i < RX_RING_SIZE; i++ ) {
809 CHECK_OFFSET(offset);
810 MEM->rx_head[i].base = offset;
811#ifdef NORMAL_MEM_ACCESS
812 MEM->rx_head[i].flag = TMD1_OWN_CHIP;
813 MEM->rx_head[i].base_hi = LANCE_HI_BASE;
814#else
815 MEM->rx_head[i].flag_base_hi =
816 (TMD1_OWN_CHIP<<8) | LANCE_HI_BASE;
817#endif
818 MEM->rx_head[i].buf_length = -PKT_BUF_SZ;
819 MEM->rx_head[i].msg_length = 0;
820 offset += PKT_BUF_SZ;
821 }
822}
823
824
825static int lance_start_xmit( struct sk_buff *skb, struct net_device *dev )
826
827{ struct lance_private *lp = (struct lance_private *)dev->priv;
828 struct lance_ioreg *IO = lp->iobase;
829 int entry, len;
830 struct lance_tx_head *head;
831 unsigned long flags;
832
833
834 len = (ETH_ZLEN < skb->len) ? skb->len : ETH_ZLEN;
835
836 if (lp->cardtype == PAM_CARD && (len & 1))
837 ++len;
838
839 if (len > skb->len) {
840 skb = skb_padto(skb, len);
841 if (skb == NULL)
842 return 0;
843 }
844
845
846 if (dev->tbusy) {
847 int tickssofar = jiffies - dev->trans_start;
848 if (tickssofar < 20)
849 return( 1 );
850 AREG = CSR0;
851 DPRINTK( 1, ( "%s: transmit timed out, status %04x, resetting.\n",
852 dev->name, DREG ));
853 DREG = CSR0_STOP;
854
855
856
857
858 REGA( CSR3 ) = CSR3_BSWP | (lp->cardtype == PAM_CARD ? CSR3_ACON : 0);
859 lp->stats.tx_errors++;
860#ifndef final_version
861 { int i;
862 DPRINTK( 2, ( "Ring data: dirty_tx %d cur_tx %d%s cur_rx %d\n",
863 lp->dirty_tx, lp->cur_tx,
864 lp->tx_full ? " (full)" : "",
865 lp->cur_rx ));
866 for( i = 0 ; i < RX_RING_SIZE; i++ )
867 DPRINTK( 2, ( "rx #%d: base=%04x blen=%04x mlen=%04x\n",
868 i, MEM->rx_head[i].base,
869 -MEM->rx_head[i].buf_length,
870 MEM->rx_head[i].msg_length ));
871 for( i = 0 ; i < TX_RING_SIZE; i++ )
872 DPRINTK( 2, ( "tx #%d: base=%04x len=%04x misc=%04x\n",
873 i, MEM->tx_head[i].base,
874 -MEM->tx_head[i].length,
875 MEM->tx_head[i].misc ));
876 }
877#endif
878 lance_init_ring(dev);
879 REGA( CSR0 ) = CSR0_INEA | CSR0_INIT | CSR0_STRT;
880
881 dev->tbusy = 0;
882 dev->trans_start = jiffies;
883
884 return( 0 );
885 }
886
887 DPRINTK( 2, ( "%s: lance_start_xmit() called, csr0 %4.4x.\n",
888 dev->name, DREG ));
889
890
891
892 if (test_and_set_bit( 0, (void*)&dev->tbusy ) != 0) {
893 DPRINTK( 0, ( "%s: Transmitter access conflict.\n", dev->name ));
894 return 1;
895 }
896
897 if (test_and_set_bit( 0, (void*)&lp->lock ) != 0) {
898 DPRINTK( 0, ( "%s: tx queue lock!.\n", dev->name ));
899
900 return 1;
901 }
902
903
904 if (lance_debug >= 3) {
905 u_char *p;
906 int i;
907 printk( "%s: TX pkt type 0x%04x from ", dev->name,
908 ((u_short *)skb->data)[6]);
909 for( p = &((u_char *)skb->data)[6], i = 0; i < 6; i++ )
910 printk("%02x%s", *p++, i != 5 ? ":" : "" );
911 printk(" to ");
912 for( p = (u_char *)skb->data, i = 0; i < 6; i++ )
913 printk("%02x%s", *p++, i != 5 ? ":" : "" );
914 printk(" data at 0x%08x len %d\n", (int)skb->data,
915 (int)skb->len );
916 }
917
918
919
920 save_flags(flags);
921 cli();
922
923
924 entry = lp->cur_tx & TX_RING_MOD_MASK;
925 head = &(MEM->tx_head[entry]);
926
927
928
929
930
931 head->length = -len;
932 head->misc = 0;
933 lp->memcpy_f( PKTBUF_ADDR(head), (void *)skb->data, skb->len );
934#ifdef NORMAL_MEM_ACCESS
935 head->flag = TMD1_OWN_CHIP | TMD1_ENP | TMD1_STP;
936#else
937 SET_FLAG(head,(TMD1_OWN_CHIP | TMD1_ENP | TMD1_STP));
938#endif
939 lp->stats.tx_bytes += skb->len;
940 dev_kfree_skb( skb );
941 lp->cur_tx++;
942 while( lp->cur_tx >= TX_RING_SIZE && lp->dirty_tx >= TX_RING_SIZE ) {
943 lp->cur_tx -= TX_RING_SIZE;
944 lp->dirty_tx -= TX_RING_SIZE;
945 }
946
947
948 DREG = CSR0_INEA | CSR0_TDMD;
949 dev->trans_start = jiffies;
950
951 lp->lock = 0;
952#ifdef NORMAL_MEM_ACCESS
953 if ((MEM->tx_head[(entry+1) & TX_RING_MOD_MASK].flag & TMD1_OWN) ==
954#else
955 if ((GET_FLAG(&MEM->tx_head[(entry+1) & TX_RING_MOD_MASK]) & TMD1_OWN) ==
956#endif
957 TMD1_OWN_HOST)
958 dev->tbusy = 0;
959 else
960 lp->tx_full = 1;
961 restore_flags(flags);
962
963 return 0;
964}
965
966
967
968static irqreturn_t lance_interrupt( int irq, void *dev_id, struct pt_regs *fp)
969{
970 struct net_device *dev = dev_id;
971 struct lance_private *lp;
972 struct lance_ioreg *IO;
973 int csr0, boguscnt = 10;
974 int handled = 0;
975
976 if (dev == NULL) {
977 DPRINTK( 1, ( "lance_interrupt(): interrupt for unknown device.\n" ));
978 return IRQ_NONE;
979 }
980
981 lp = (struct lance_private *)dev->priv;
982 IO = lp->iobase;
983 AREG = CSR0;
984
985 if (dev->interrupt) {
986 DPRINTK( 1, ( "Re-entering CAUSE=%08x STATUS=%08x\n",
987 read_32bit_cp0_register(CP0_CAUSE),
988 read_32bit_cp0_register(CP0_STATUS) ));
989 panic("lance: interrupt handler reentered !");
990 }
991
992 dev->interrupt = 1;
993
994 while( ((csr0 = DREG) & (CSR0_ERR | CSR0_TINT | CSR0_RINT)) &&
995 --boguscnt >= 0) {
996 handled = 1;
997
998 DREG = csr0 & ~(CSR0_INIT | CSR0_STRT | CSR0_STOP |
999 CSR0_TDMD | CSR0_INEA);
1000
1001 DPRINTK( 2, ( "%s: interrupt csr0=%04x new csr=%04x.\n",
1002 dev->name, csr0, DREG ));
1003
1004 if (csr0 & CSR0_RINT)
1005 lance_rx( dev );
1006
1007 if (csr0 & CSR0_TINT) {
1008 int dirty_tx = lp->dirty_tx;
1009
1010 while( dirty_tx < lp->cur_tx) {
1011 int entry = dirty_tx & TX_RING_MOD_MASK;
1012#ifdef NORMAL_MEM_ACCESS
1013 int status = MEM->tx_head[entry].flag;
1014#else
1015 int status = GET_FLAG(&MEM->tx_head[entry]);
1016#endif
1017 if (status & TMD1_OWN_CHIP)
1018 break;
1019
1020#ifdef NORMAL_MEM_ACCESS
1021 MEM->tx_head[entry].flag = 0;
1022#else
1023 SET_FLAG(&MEM->tx_head[entry],0);
1024#endif
1025
1026 if (status & TMD1_ERR) {
1027
1028 int err_status = MEM->tx_head[entry].misc;
1029 lp->stats.tx_errors++;
1030 if (err_status & TMD3_RTRY) lp->stats.tx_aborted_errors++;
1031 if (err_status & TMD3_LCAR) lp->stats.tx_carrier_errors++;
1032 if (err_status & TMD3_LCOL) lp->stats.tx_window_errors++;
1033 if (err_status & TMD3_UFLO) {
1034
1035 lp->stats.tx_fifo_errors++;
1036
1037 DPRINTK( 1, ( "%s: Tx FIFO error! Status %04x\n",
1038 dev->name, csr0 ));
1039
1040 DREG = CSR0_STRT;
1041 }
1042 } else {
1043 if (status & (TMD1_MORE | TMD1_ONE | TMD1_DEF))
1044 lp->stats.collisions++;
1045 lp->stats.tx_packets++;
1046 }
1047 dirty_tx++;
1048 }
1049
1050#ifndef final_version
1051 if (lp->cur_tx - dirty_tx >= TX_RING_SIZE) {
1052 DPRINTK( 0, ( "out-of-sync dirty pointer,"
1053 " %d vs. %d, full=%d.\n",
1054 dirty_tx, lp->cur_tx, lp->tx_full ));
1055 dirty_tx += TX_RING_SIZE;
1056 }
1057#endif
1058
1059 if (lp->tx_full && dev->tbusy
1060 && dirty_tx > lp->cur_tx - TX_RING_SIZE + 2) {
1061
1062 lp->tx_full = 0;
1063 dev->tbusy = 0;
1064 mark_bh( NET_BH );
1065 }
1066
1067 lp->dirty_tx = dirty_tx;
1068 }
1069
1070
1071 if (csr0 & CSR0_BABL) lp->stats.tx_errors++;
1072 if (csr0 & CSR0_MISS) lp->stats.rx_errors++;
1073 if (csr0 & CSR0_MERR) {
1074 DPRINTK( 1, ( "%s: Bus master arbitration failure (?!?), "
1075 "status %04x.\n", dev->name, csr0 ));
1076
1077 DREG = CSR0_STRT;
1078 }
1079 }
1080
1081
1082 DREG = CSR0_BABL | CSR0_CERR | CSR0_MISS | CSR0_MERR |
1083 CSR0_IDON | CSR0_INEA;
1084
1085 DPRINTK( 2, ( "%s: exiting interrupt, csr0=%#04x.\n",
1086 dev->name, DREG ));
1087 dev->interrupt = 0;
1088 return IRQ_RETVAL(handled);
1089}
1090
1091
1092static int lance_rx( struct net_device *dev )
1093
1094{ struct lance_private *lp = (struct lance_private *)dev->priv;
1095 int entry = lp->cur_rx & RX_RING_MOD_MASK;
1096 int i;
1097
1098#ifdef NORMAL_MEM_ACCESS
1099 DPRINTK( 2, ( "%s: rx int, flag=%04x\n", dev->name,
1100 MEM->rx_head[entry].flag ));
1101#else
1102 DPRINTK( 2, ( "%s: rx int, flag=%04x\n", dev->name,
1103 GET_FLAG(&MEM->rx_head[entry]) ));
1104#endif
1105
1106
1107#ifdef NORMAL_MEM_ACCESS
1108 while( (MEM->rx_head[entry].flag & RMD1_OWN) == RMD1_OWN_HOST ) {
1109#else
1110 while( (GET_FLAG(&MEM->rx_head[entry]) & RMD1_OWN) == RMD1_OWN_HOST ) {
1111#endif
1112 struct lance_rx_head *head = &(MEM->rx_head[entry]);
1113#ifdef NORMAL_MEM_ACCESS
1114 int status = head->flag;
1115#else
1116 int status = GET_FLAG(head);
1117#endif
1118
1119 if (status != (RMD1_ENP|RMD1_STP)) {
1120
1121
1122
1123
1124 if (status & RMD1_ENP)
1125 lp->stats.rx_errors++;
1126 if (status & RMD1_FRAM) lp->stats.rx_frame_errors++;
1127 if (status & RMD1_OFLO) lp->stats.rx_over_errors++;
1128 if (status & RMD1_CRC) lp->stats.rx_crc_errors++;
1129 if (status & RMD1_BUFF) lp->stats.rx_fifo_errors++;
1130#ifdef NORMAL_MEM_ACCESS
1131 head->flag &= (RMD1_ENP|RMD1_STP);
1132#else
1133 SET_FLAG(head,GET_FLAG(head) & (RMD1_ENP|RMD1_STP));
1134#endif
1135 } else {
1136
1137 short pkt_len = head->msg_length & 0xfff;
1138 struct sk_buff *skb;
1139
1140 if (pkt_len < 60) {
1141 printk( "%s: Runt packet!\n", dev->name );
1142 lp->stats.rx_errors++;
1143 }
1144 else {
1145 skb = dev_alloc_skb( pkt_len+2 );
1146 if (skb == NULL) {
1147 DPRINTK( 1, ( "%s: Memory squeeze, deferring packet.\n",
1148 dev->name ));
1149 for( i = 0; i < RX_RING_SIZE; i++ )
1150#ifdef NORMAL_MEM_ACCESS
1151 if (MEM->rx_head[(entry+i) & RX_RING_MOD_MASK].flag &
1152#else
1153 if (GET_FLAG(&MEM->rx_head[(entry+i) & \
1154 RX_RING_MOD_MASK]) &
1155#endif
1156 RMD1_OWN_CHIP)
1157 break;
1158
1159 if (i > RX_RING_SIZE - 2) {
1160 lp->stats.rx_dropped++;
1161#ifdef NORMAL_MEM_ACCESS
1162 head->flag |= RMD1_OWN_CHIP;
1163#else
1164 SET_FLAG(head,GET_FLAG(head) | RMD1_OWN_CHIP);
1165#endif
1166 lp->cur_rx++;
1167 }
1168 break;
1169 }
1170
1171 if (lance_debug >= 3) {
1172 u_char *data = PKTBUF_ADDR(head), *p;
1173 printk( "%s: RX pkt type 0x%04x from ", dev->name,
1174 ((u_short *)data)[6]);
1175 for( p = &data[6], i = 0; i < 6; i++ )
1176 printk("%02x%s", *p++, i != 5 ? ":" : "" );
1177 printk(" to ");
1178 for( p = data, i = 0; i < 6; i++ )
1179 printk("%02x%s", *p++, i != 5 ? ":" : "" );
1180 printk(" data %02x %02x %02x %02x %02x %02x %02x %02x "
1181 "len %d\n",
1182 data[15], data[16], data[17], data[18],
1183 data[19], data[20], data[21], data[22],
1184 pkt_len );
1185 }
1186
1187 skb->dev = dev;
1188 skb_reserve( skb, 2 );
1189 skb_put( skb, pkt_len );
1190 lp->memcpy_f( skb->data, PKTBUF_ADDR(head), pkt_len );
1191 skb->protocol = eth_type_trans( skb, dev );
1192 netif_rx( skb );
1193 dev->last_rx = jiffies;
1194 lp->stats.rx_packets++;
1195 lp->stats.rx_bytes += pkt_len;
1196 }
1197 }
1198
1199#ifdef NORMAL_MEM_ACCESS
1200 head->flag |= RMD1_OWN_CHIP;
1201#else
1202 SET_FLAG(head,GET_FLAG(head) | RMD1_OWN_CHIP);
1203#endif
1204 entry = (++lp->cur_rx) & RX_RING_MOD_MASK;
1205 }
1206 lp->cur_rx &= RX_RING_MOD_MASK;
1207
1208
1209
1210
1211
1212 return 0;
1213}
1214
1215
1216static int lance_close( struct net_device *dev )
1217
1218{ struct lance_private *lp = (struct lance_private *)dev->priv;
1219 struct lance_ioreg *IO = lp->iobase;
1220
1221 dev->start = 0;
1222 dev->tbusy = 1;
1223
1224 AREG = CSR0;
1225
1226 DPRINTK( 2, ( "%s: Shutting down ethercard, status was %2.2x.\n",
1227 dev->name, DREG ));
1228
1229
1230
1231 DREG = CSR0_STOP;
1232
1233 return 0;
1234}
1235
1236
1237static struct net_device_stats *lance_get_stats( struct net_device *dev )
1238
1239{
1240 struct lance_private *lp = (struct lance_private *)dev->priv;
1241 return &lp->stats;
1242}
1243
1244
1245
1246
1247
1248
1249
1250
1251
1252static void set_multicast_list( struct net_device *dev )
1253
1254{ struct lance_private *lp = (struct lance_private *)dev->priv;
1255 struct lance_ioreg *IO = lp->iobase;
1256
1257 if (!dev->start)
1258
1259 return;
1260
1261
1262 DREG = CSR0_STOP;
1263
1264 if (dev->flags & IFF_PROMISC) {
1265
1266 DPRINTK( 1, ( "%s: Promiscuous mode enabled.\n", dev->name ));
1267 REGA( CSR15 ) = 0x8000;
1268 } else {
1269 short multicast_table[4];
1270 int num_addrs = dev->mc_count;
1271 int i;
1272
1273
1274 memset( multicast_table, (num_addrs == 0) ? 0 : -1,
1275 sizeof(multicast_table) );
1276 for( i = 0; i < 4; i++ )
1277 REGA( CSR8+i ) = multicast_table[i];
1278 REGA( CSR15 ) = 0;
1279 }
1280
1281
1282
1283
1284
1285 REGA( CSR3 ) = CSR3_BSWP | (lp->cardtype == PAM_CARD ? CSR3_ACON : 0);
1286
1287
1288 REGA( CSR0 ) = CSR0_IDON | CSR0_INEA | CSR0_STRT;
1289}
1290
1291
1292
1293
1294static int lance_set_mac_address( struct net_device *dev, void *addr )
1295
1296{ struct lance_private *lp = (struct lance_private *)dev->priv;
1297 struct sockaddr *saddr = addr;
1298 int i;
1299
1300 if (lp->cardtype != OLD_RIEBL && lp->cardtype != NEW_RIEBL)
1301 return( -EOPNOTSUPP );
1302
1303 if (dev->start) {
1304
1305 DPRINTK( 1, ( "%s: hwaddr can be set only while card isn't open.\n",
1306 dev->name ));
1307 return( -EIO );
1308 }
1309
1310 slow_memcpy( dev->dev_addr, saddr->sa_data, dev->addr_len );
1311
1312 {
1313 unsigned char hwaddr[6];
1314 for( i = 0; i < 6; i++ )
1315 hwaddr[i] = dev->dev_addr[i^1];
1316 slow_memcpy(MEM->init.hwaddr, hwaddr, sizeof(hwaddr));
1317 }
1318
1319 lp->memcpy_f( RIEBL_HWADDR_ADDR, dev->dev_addr, 6 );
1320
1321#ifdef NORMAL_MEM_ACCESS
1322 *RIEBL_MAGIC_ADDR = RIEBL_MAGIC;
1323#else
1324 {
1325 unsigned long magic = RIEBL_MAGIC;
1326 slow_memcpy(RIEBL_MAGIC_ADDR, &magic, sizeof(*RIEBL_MAGIC_ADDR));
1327 }
1328#endif
1329 return( 0 );
1330}
1331
1332
1333#ifdef MODULE
1334static struct net_device bagetlance_dev;
1335
1336int init_module(void)
1337
1338{ int err;
1339
1340 bagetlance_dev.init = bagetlance_probe;
1341 if ((err = register_netdev( &bagetlance_dev ))) {
1342 if (err == -EIO) {
1343 printk( "No Vme Lance board found. Module not loaded.\n");
1344 }
1345 return( err );
1346 }
1347 return( 0 );
1348}
1349
1350void cleanup_module(void)
1351
1352{
1353 unregister_netdev( &bagetlance_dev );
1354}
1355
1356#endif
1357
1358
1359
1360
1361
1362
1363
1364