1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45static const char version[] = "atarilance.c: v1.3 04/04/96 "
46 "Roman.Hodek@informatik.uni-erlangen.de\n";
47
48#include <linux/netdevice.h>
49#include <linux/etherdevice.h>
50#include <linux/module.h>
51#include <linux/stddef.h>
52#include <linux/kernel.h>
53#include <linux/string.h>
54#include <linux/errno.h>
55#include <linux/skbuff.h>
56#include <linux/interrupt.h>
57#include <linux/init.h>
58#include <linux/bitops.h>
59
60#include <asm/setup.h>
61#include <asm/irq.h>
62#include <asm/atarihw.h>
63#include <asm/atariints.h>
64#include <asm/io.h>
65
66
67
68
69
70
71
72
73#define LANCE_DEBUG 1
74
75#ifdef LANCE_DEBUG
76static int lance_debug = LANCE_DEBUG;
77#else
78static int lance_debug = 1;
79#endif
80module_param(lance_debug, int, 0);
81MODULE_PARM_DESC(lance_debug, "atarilance debug level (0-3)");
82MODULE_LICENSE("GPL");
83
84
85#undef LANCE_DEBUG_PROBE
86
87#define DPRINTK(n,a) \
88 do { \
89 if (lance_debug >= n) \
90 printk a; \
91 } while( 0 )
92
93#ifdef LANCE_DEBUG_PROBE
94# define PROBE_PRINT(a) printk a
95#else
96# define PROBE_PRINT(a)
97#endif
98
99
100
101
102
103
104
105
106#define TX_LOG_RING_SIZE 3
107#define RX_LOG_RING_SIZE 5
108
109
110
111#define TX_RING_SIZE (1 << TX_LOG_RING_SIZE)
112#define TX_RING_LEN_BITS (TX_LOG_RING_SIZE << 5)
113#define TX_RING_MOD_MASK (TX_RING_SIZE - 1)
114
115#define RX_RING_SIZE (1 << RX_LOG_RING_SIZE)
116#define RX_RING_LEN_BITS (RX_LOG_RING_SIZE << 5)
117#define RX_RING_MOD_MASK (RX_RING_SIZE - 1)
118
119#define TX_TIMEOUT (HZ/5)
120
121
122struct lance_rx_head {
123 unsigned short base;
124 volatile unsigned char flag;
125 unsigned char base_hi;
126 short buf_length;
127 volatile short msg_length;
128};
129
130struct lance_tx_head {
131 unsigned short base;
132 volatile unsigned char flag;
133 unsigned char base_hi;
134 short length;
135 volatile short misc;
136};
137
138struct ringdesc {
139 unsigned short adr_lo;
140 unsigned char len;
141 unsigned char adr_hi;
142};
143
144
145struct lance_init_block {
146 unsigned short mode;
147 unsigned char hwaddr[6];
148 unsigned filter[2];
149
150 struct ringdesc rx_ring;
151 struct ringdesc tx_ring;
152};
153
154
155struct lance_memory {
156 struct lance_init_block init;
157 struct lance_tx_head tx_head[TX_RING_SIZE];
158 struct lance_rx_head rx_head[RX_RING_SIZE];
159 char packet_area[0];
160
161
162
163};
164
165
166
167
168
169
170
171
172#define RIEBL_RSVD_START 0xee70
173#define RIEBL_RSVD_END 0xeec0
174#define RIEBL_MAGIC 0x09051990
175#define RIEBL_MAGIC_ADDR ((unsigned long *)(((char *)MEM) + 0xee8a))
176#define RIEBL_HWADDR_ADDR ((unsigned char *)(((char *)MEM) + 0xee8e))
177#define RIEBL_IVEC_ADDR ((unsigned short *)(((char *)MEM) + 0xfffe))
178
179
180
181
182
183
184static unsigned char OldRieblDefHwaddr[6] = {
185 0x00, 0x00, 0x36, 0x04, 0x00, 0x00
186};
187
188
189
190
191struct lance_ioreg {
192 volatile unsigned short data;
193 volatile unsigned short addr;
194 unsigned char _dummy1[3];
195 volatile unsigned char ivec;
196 unsigned char _dummy2[5];
197 volatile unsigned char eeprom;
198 unsigned char _dummy3;
199 volatile unsigned char mem;
200};
201
202
203
204enum lance_type {
205 OLD_RIEBL,
206 NEW_RIEBL,
207 PAM_CARD
208};
209
210static char *lance_names[] = {
211 "Riebl-Card (without battery)",
212 "Riebl-Card (with battery)",
213 "PAM intern card"
214};
215
216
217
218struct lance_private {
219 enum lance_type cardtype;
220 struct lance_ioreg *iobase;
221 struct lance_memory *mem;
222 int cur_rx, cur_tx;
223 int dirty_tx;
224
225 void *(*memcpy_f)( void *, const void *, size_t );
226
227 long tx_full;
228 spinlock_t devlock;
229};
230
231
232
233#define MEM lp->mem
234#define DREG IO->data
235#define AREG IO->addr
236#define REGA(a) (*( AREG = (a), &DREG ))
237
238
239#define PKT_BUF_SZ 1544
240
241#define PKTBUF_ADDR(head) (((unsigned char *)(MEM)) + (head)->base)
242
243
244
245static struct lance_addr {
246 unsigned long memaddr;
247 unsigned long ioaddr;
248 int slow_flag;
249} lance_addr_list[] = {
250 { 0xfe010000, 0xfe00fff0, 0 },
251 { 0xffc10000, 0xffc0fff0, 0 },
252
253 { 0xffe00000, 0xffff7000, 1 },
254
255 { 0xffd00000, 0xffff7000, 1 },
256
257
258 { 0xffcf0000, 0xffcffff0, 0 },
259
260 { 0xfecf0000, 0xfecffff0, 0 },
261
262};
263
264#define N_LANCE_ADDR ARRAY_SIZE(lance_addr_list)
265
266
267
268
269
270#define TMD1_ENP 0x01
271#define TMD1_STP 0x02
272#define TMD1_DEF 0x04
273#define TMD1_ONE 0x08
274#define TMD1_MORE 0x10
275#define TMD1_ERR 0x40
276#define TMD1_OWN 0x80
277
278#define TMD1_OWN_CHIP TMD1_OWN
279#define TMD1_OWN_HOST 0
280
281
282#define TMD3_TDR 0x03FF
283#define TMD3_RTRY 0x0400
284#define TMD3_LCAR 0x0800
285#define TMD3_LCOL 0x1000
286#define TMD3_UFLO 0x4000
287#define TMD3_BUFF 0x8000
288
289
290#define RMD1_ENP 0x01
291#define RMD1_STP 0x02
292#define RMD1_BUFF 0x04
293#define RMD1_CRC 0x08
294#define RMD1_OFLO 0x10
295#define RMD1_FRAM 0x20
296#define RMD1_ERR 0x40
297#define RMD1_OWN 0x80
298
299#define RMD1_OWN_CHIP RMD1_OWN
300#define RMD1_OWN_HOST 0
301
302
303#define CSR0 0
304#define CSR1 1
305#define CSR2 2
306#define CSR3 3
307#define CSR8 8
308#define CSR15 15
309
310
311
312#define CSR0_INIT 0x0001
313#define CSR0_STRT 0x0002
314#define CSR0_STOP 0x0004
315#define CSR0_TDMD 0x0008
316#define CSR0_TXON 0x0010
317#define CSR0_RXON 0x0020
318#define CSR0_INEA 0x0040
319#define CSR0_INTR 0x0080
320#define CSR0_IDON 0x0100
321#define CSR0_TINT 0x0200
322#define CSR0_RINT 0x0400
323#define CSR0_MERR 0x0800
324#define CSR0_MISS 0x1000
325#define CSR0_CERR 0x2000
326#define CSR0_BABL 0x4000
327#define CSR0_ERR 0x8000
328
329
330#define CSR3_BCON 0x0001
331#define CSR3_ACON 0x0002
332#define CSR3_BSWP 0x0004
333
334
335
336
337
338static unsigned long lance_probe1( struct net_device *dev, struct lance_addr
339 *init_rec );
340static int lance_open( struct net_device *dev );
341static void lance_init_ring( struct net_device *dev );
342static netdev_tx_t lance_start_xmit(struct sk_buff *skb,
343 struct net_device *dev);
344static irqreturn_t lance_interrupt( int irq, void *dev_id );
345static int lance_rx( struct net_device *dev );
346static int lance_close( struct net_device *dev );
347static void set_multicast_list( struct net_device *dev );
348static int lance_set_mac_address( struct net_device *dev, void *addr );
349static void lance_tx_timeout (struct net_device *dev);
350
351
352
353
354
355
356
357static void *slow_memcpy( void *dst, const void *src, size_t len )
358
359{ char *cto = dst;
360 const char *cfrom = src;
361
362 while( len-- ) {
363 *cto++ = *cfrom++;
364 MFPDELAY();
365 }
366 return dst;
367}
368
369
370struct net_device * __init atarilance_probe(int unit)
371{
372 int i;
373 static int found;
374 struct net_device *dev;
375 int err = -ENODEV;
376
377 if (!MACH_IS_ATARI || found)
378
379
380 return ERR_PTR(-ENODEV);
381
382 dev = alloc_etherdev(sizeof(struct lance_private));
383 if (!dev)
384 return ERR_PTR(-ENOMEM);
385 if (unit >= 0) {
386 sprintf(dev->name, "eth%d", unit);
387 netdev_boot_setup_check(dev);
388 }
389
390 for( i = 0; i < N_LANCE_ADDR; ++i ) {
391 if (lance_probe1( dev, &lance_addr_list[i] )) {
392 found = 1;
393 err = register_netdev(dev);
394 if (!err)
395 return dev;
396 free_irq(dev->irq, dev);
397 break;
398 }
399 }
400 free_netdev(dev);
401 return ERR_PTR(err);
402}
403
404
405
406
407static noinline int __init addr_accessible(volatile void *regp, int wordflag,
408 int writeflag)
409{
410 int ret;
411 unsigned long flags;
412 long *vbr, save_berr;
413
414 local_irq_save(flags);
415
416 __asm__ __volatile__ ( "movec %/vbr,%0" : "=r" (vbr) : );
417 save_berr = vbr[2];
418
419 __asm__ __volatile__
420 ( "movel %/sp,%/d1\n\t"
421 "movel #Lberr,%2@\n\t"
422 "moveq #0,%0\n\t"
423 "tstl %3\n\t"
424 "bne 1f\n\t"
425 "moveb %1@,%/d0\n\t"
426 "nop \n\t"
427 "bra 2f\n"
428"1: movew %1@,%/d0\n\t"
429 "nop \n"
430"2: tstl %4\n\t"
431 "beq 2f\n\t"
432 "tstl %3\n\t"
433 "bne 1f\n\t"
434 "clrb %1@\n\t"
435 "nop \n\t"
436 "moveb %/d0,%1@\n\t"
437 "nop \n\t"
438 "bra 2f\n"
439"1: clrw %1@\n\t"
440 "nop \n\t"
441 "movew %/d0,%1@\n\t"
442 "nop \n"
443"2: moveq #1,%0\n"
444"Lberr: movel %/d1,%/sp"
445 : "=&d" (ret)
446 : "a" (regp), "a" (&vbr[2]), "rm" (wordflag), "rm" (writeflag)
447 : "d0", "d1", "memory"
448 );
449
450 vbr[2] = save_berr;
451 local_irq_restore(flags);
452
453 return ret;
454}
455
456static const struct net_device_ops lance_netdev_ops = {
457 .ndo_open = lance_open,
458 .ndo_stop = lance_close,
459 .ndo_start_xmit = lance_start_xmit,
460 .ndo_set_rx_mode = set_multicast_list,
461 .ndo_set_mac_address = lance_set_mac_address,
462 .ndo_tx_timeout = lance_tx_timeout,
463 .ndo_validate_addr = eth_validate_addr,
464};
465
466static unsigned long __init lance_probe1( struct net_device *dev,
467 struct lance_addr *init_rec )
468{
469 volatile unsigned short *memaddr =
470 (volatile unsigned short *)init_rec->memaddr;
471 volatile unsigned short *ioaddr =
472 (volatile unsigned short *)init_rec->ioaddr;
473 struct lance_private *lp;
474 struct lance_ioreg *IO;
475 int i;
476 static int did_version;
477 unsigned short save1, save2;
478
479 PROBE_PRINT(( "Probing for Lance card at mem %#lx io %#lx\n",
480 (long)memaddr, (long)ioaddr ));
481
482
483 PROBE_PRINT(( "lance_probe1: testing memory to be accessible\n" ));
484 if (!addr_accessible( memaddr, 1, 1 )) goto probe_fail;
485
486
487 PROBE_PRINT(( "lance_probe1: testing memory to be writable (1)\n" ));
488 save1 = *memaddr;
489 *memaddr = 0x0001;
490 if (*memaddr != 0x0001) goto probe_fail;
491 PROBE_PRINT(( "lance_probe1: testing memory to be writable (2)\n" ));
492 *memaddr = 0x0000;
493 if (*memaddr != 0x0000) goto probe_fail;
494 *memaddr = save1;
495
496
497 PROBE_PRINT(( "lance_probe1: testing ioport to be accessible\n" ));
498 if (!addr_accessible( ioaddr, 1, 1 )) goto probe_fail;
499
500
501 PROBE_PRINT(( "lance_probe1: testing ioport to be writeable\n" ));
502 save2 = ioaddr[1];
503 ioaddr[1] = 0x0001;
504 if (ioaddr[1] != 0x0001) goto probe_fail;
505
506
507 PROBE_PRINT(( "lance_probe1: testing CSR0 register function (1)\n" ));
508 save1 = ioaddr[0];
509 ioaddr[1] = CSR0;
510 ioaddr[0] = CSR0_INIT | CSR0_STOP;
511 if (ioaddr[0] != CSR0_STOP) {
512 ioaddr[0] = save1;
513 ioaddr[1] = save2;
514 goto probe_fail;
515 }
516 PROBE_PRINT(( "lance_probe1: testing CSR0 register function (2)\n" ));
517 ioaddr[0] = CSR0_STOP;
518 if (ioaddr[0] != CSR0_STOP) {
519 ioaddr[0] = save1;
520 ioaddr[1] = save2;
521 goto probe_fail;
522 }
523
524
525 PROBE_PRINT(( "lance_probe1: Lance card detected\n" ));
526 goto probe_ok;
527
528 probe_fail:
529 return 0;
530
531 probe_ok:
532 lp = netdev_priv(dev);
533 MEM = (struct lance_memory *)memaddr;
534 IO = lp->iobase = (struct lance_ioreg *)ioaddr;
535 dev->base_addr = (unsigned long)ioaddr;
536 lp->memcpy_f = init_rec->slow_flag ? slow_memcpy : memcpy;
537
538 REGA( CSR0 ) = CSR0_STOP;
539
540
541
542 if (addr_accessible( &(IO->eeprom), 0, 0 )) {
543
544 i = IO->mem;
545 lp->cardtype = PAM_CARD;
546 }
547 else if (*RIEBL_MAGIC_ADDR == RIEBL_MAGIC) {
548 lp->cardtype = NEW_RIEBL;
549 }
550 else
551 lp->cardtype = OLD_RIEBL;
552
553 if (lp->cardtype == PAM_CARD ||
554 memaddr == (unsigned short *)0xffe00000) {
555
556 if (request_irq(IRQ_AUTO_5, lance_interrupt, 0,
557 "PAM,Riebl-ST Ethernet", dev)) {
558 printk( "Lance: request for irq %d failed\n", IRQ_AUTO_5 );
559 return 0;
560 }
561 dev->irq = IRQ_AUTO_5;
562 }
563 else {
564
565 unsigned int irq = atari_register_vme_int();
566 if (!irq) {
567 printk( "Lance: request for VME interrupt failed\n" );
568 return 0;
569 }
570 if (request_irq(irq, lance_interrupt, 0, "Riebl-VME Ethernet",
571 dev)) {
572 printk( "Lance: request for irq %u failed\n", irq );
573 return 0;
574 }
575 dev->irq = irq;
576 }
577
578 printk("%s: %s at io %#lx, mem %#lx, irq %d%s, hwaddr ",
579 dev->name, lance_names[lp->cardtype],
580 (unsigned long)ioaddr,
581 (unsigned long)memaddr,
582 dev->irq,
583 init_rec->slow_flag ? " (slow memcpy)" : "" );
584
585
586 switch( lp->cardtype ) {
587 case OLD_RIEBL:
588
589 memcpy(dev->dev_addr, OldRieblDefHwaddr, ETH_ALEN);
590 break;
591 case NEW_RIEBL:
592 lp->memcpy_f(dev->dev_addr, RIEBL_HWADDR_ADDR, ETH_ALEN);
593 break;
594 case PAM_CARD:
595 i = IO->eeprom;
596 for( i = 0; i < 6; ++i )
597 dev->dev_addr[i] =
598 ((((unsigned short *)MEM)[i*2] & 0x0f) << 4) |
599 ((((unsigned short *)MEM)[i*2+1] & 0x0f));
600 i = IO->mem;
601 break;
602 }
603 printk("%pM\n", dev->dev_addr);
604 if (lp->cardtype == OLD_RIEBL) {
605 printk( "%s: Warning: This is a default ethernet address!\n",
606 dev->name );
607 printk( " Use \"ifconfig hw ether ...\" to set the address.\n" );
608 }
609
610 spin_lock_init(&lp->devlock);
611
612 MEM->init.mode = 0x0000;
613 for( i = 0; i < 6; i++ )
614 MEM->init.hwaddr[i] = dev->dev_addr[i^1];
615 MEM->init.filter[0] = 0x00000000;
616 MEM->init.filter[1] = 0x00000000;
617 MEM->init.rx_ring.adr_lo = offsetof( struct lance_memory, rx_head );
618 MEM->init.rx_ring.adr_hi = 0;
619 MEM->init.rx_ring.len = RX_RING_LEN_BITS;
620 MEM->init.tx_ring.adr_lo = offsetof( struct lance_memory, tx_head );
621 MEM->init.tx_ring.adr_hi = 0;
622 MEM->init.tx_ring.len = TX_RING_LEN_BITS;
623
624 if (lp->cardtype == PAM_CARD)
625 IO->ivec = IRQ_SOURCE_TO_VECTOR(dev->irq);
626 else
627 *RIEBL_IVEC_ADDR = IRQ_SOURCE_TO_VECTOR(dev->irq);
628
629 if (did_version++ == 0)
630 DPRINTK( 1, ( version ));
631
632 dev->netdev_ops = &lance_netdev_ops;
633
634
635 dev->watchdog_timeo = TX_TIMEOUT;
636
637 return 1;
638}
639
640
641static int lance_open( struct net_device *dev )
642{
643 struct lance_private *lp = netdev_priv(dev);
644 struct lance_ioreg *IO = lp->iobase;
645 int i;
646
647 DPRINTK( 2, ( "%s: lance_open()\n", dev->name ));
648
649 lance_init_ring(dev);
650
651
652 REGA( CSR3 ) = CSR3_BSWP | (lp->cardtype == PAM_CARD ? CSR3_ACON : 0);
653 REGA( CSR2 ) = 0;
654 REGA( CSR1 ) = 0;
655 REGA( CSR0 ) = CSR0_INIT;
656
657
658 i = 1000000;
659 while (--i > 0)
660 if (DREG & CSR0_IDON)
661 break;
662 if (i <= 0 || (DREG & CSR0_ERR)) {
663 DPRINTK( 2, ( "lance_open(): opening %s failed, i=%d, csr0=%04x\n",
664 dev->name, i, DREG ));
665 DREG = CSR0_STOP;
666 return -EIO;
667 }
668 DREG = CSR0_IDON;
669 DREG = CSR0_STRT;
670 DREG = CSR0_INEA;
671
672 netif_start_queue (dev);
673
674 DPRINTK( 2, ( "%s: LANCE is open, csr0 %04x\n", dev->name, DREG ));
675
676 return 0;
677}
678
679
680
681
682static void lance_init_ring( struct net_device *dev )
683{
684 struct lance_private *lp = netdev_priv(dev);
685 int i;
686 unsigned offset;
687
688 lp->tx_full = 0;
689 lp->cur_rx = lp->cur_tx = 0;
690 lp->dirty_tx = 0;
691
692 offset = offsetof( struct lance_memory, packet_area );
693
694
695
696#define CHECK_OFFSET(o) \
697 do { \
698 if (lp->cardtype == OLD_RIEBL || lp->cardtype == NEW_RIEBL) { \
699 if (((o) < RIEBL_RSVD_START) ? (o)+PKT_BUF_SZ > RIEBL_RSVD_START \
700 : (o) < RIEBL_RSVD_END) \
701 (o) = RIEBL_RSVD_END; \
702 } \
703 } while(0)
704
705 for( i = 0; i < TX_RING_SIZE; i++ ) {
706 CHECK_OFFSET(offset);
707 MEM->tx_head[i].base = offset;
708 MEM->tx_head[i].flag = TMD1_OWN_HOST;
709 MEM->tx_head[i].base_hi = 0;
710 MEM->tx_head[i].length = 0;
711 MEM->tx_head[i].misc = 0;
712 offset += PKT_BUF_SZ;
713 }
714
715 for( i = 0; i < RX_RING_SIZE; i++ ) {
716 CHECK_OFFSET(offset);
717 MEM->rx_head[i].base = offset;
718 MEM->rx_head[i].flag = TMD1_OWN_CHIP;
719 MEM->rx_head[i].base_hi = 0;
720 MEM->rx_head[i].buf_length = -PKT_BUF_SZ;
721 MEM->rx_head[i].msg_length = 0;
722 offset += PKT_BUF_SZ;
723 }
724}
725
726
727
728
729
730static void lance_tx_timeout (struct net_device *dev)
731{
732 struct lance_private *lp = netdev_priv(dev);
733 struct lance_ioreg *IO = lp->iobase;
734
735 AREG = CSR0;
736 DPRINTK( 1, ( "%s: transmit timed out, status %04x, resetting.\n",
737 dev->name, DREG ));
738 DREG = CSR0_STOP;
739
740
741
742
743 REGA( CSR3 ) = CSR3_BSWP | (lp->cardtype == PAM_CARD ? CSR3_ACON : 0);
744 dev->stats.tx_errors++;
745#ifndef final_version
746 { int i;
747 DPRINTK( 2, ( "Ring data: dirty_tx %d cur_tx %d%s cur_rx %d\n",
748 lp->dirty_tx, lp->cur_tx,
749 lp->tx_full ? " (full)" : "",
750 lp->cur_rx ));
751 for( i = 0 ; i < RX_RING_SIZE; i++ )
752 DPRINTK( 2, ( "rx #%d: base=%04x blen=%04x mlen=%04x\n",
753 i, MEM->rx_head[i].base,
754 -MEM->rx_head[i].buf_length,
755 MEM->rx_head[i].msg_length ));
756 for( i = 0 ; i < TX_RING_SIZE; i++ )
757 DPRINTK( 2, ( "tx #%d: base=%04x len=%04x misc=%04x\n",
758 i, MEM->tx_head[i].base,
759 -MEM->tx_head[i].length,
760 MEM->tx_head[i].misc ));
761 }
762#endif
763
764
765 lance_init_ring(dev);
766 REGA( CSR0 ) = CSR0_INEA | CSR0_INIT | CSR0_STRT;
767 netif_trans_update(dev);
768 netif_wake_queue(dev);
769}
770
771
772
773static netdev_tx_t
774lance_start_xmit(struct sk_buff *skb, struct net_device *dev)
775{
776 struct lance_private *lp = netdev_priv(dev);
777 struct lance_ioreg *IO = lp->iobase;
778 int entry, len;
779 struct lance_tx_head *head;
780 unsigned long flags;
781
782 DPRINTK( 2, ( "%s: lance_start_xmit() called, csr0 %4.4x.\n",
783 dev->name, DREG ));
784
785
786
787 len = skb->len;
788 if (len < ETH_ZLEN)
789 len = ETH_ZLEN;
790
791 else if (lp->cardtype == PAM_CARD && (len & 1))
792 ++len;
793
794 if (len > skb->len) {
795 if (skb_padto(skb, len))
796 return NETDEV_TX_OK;
797 }
798
799 netif_stop_queue (dev);
800
801
802 if (lance_debug >= 3) {
803 printk( "%s: TX pkt type 0x%04x from %pM to %pM"
804 " data at 0x%08x len %d\n",
805 dev->name, ((u_short *)skb->data)[6],
806 &skb->data[6], skb->data,
807 (int)skb->data, (int)skb->len );
808 }
809
810
811
812 spin_lock_irqsave (&lp->devlock, flags);
813
814
815 entry = lp->cur_tx & TX_RING_MOD_MASK;
816 head = &(MEM->tx_head[entry]);
817
818
819
820
821
822
823 head->length = -len;
824 head->misc = 0;
825 lp->memcpy_f( PKTBUF_ADDR(head), (void *)skb->data, skb->len );
826 head->flag = TMD1_OWN_CHIP | TMD1_ENP | TMD1_STP;
827 dev->stats.tx_bytes += skb->len;
828 dev_kfree_skb( skb );
829 lp->cur_tx++;
830 while( lp->cur_tx >= TX_RING_SIZE && lp->dirty_tx >= TX_RING_SIZE ) {
831 lp->cur_tx -= TX_RING_SIZE;
832 lp->dirty_tx -= TX_RING_SIZE;
833 }
834
835
836 DREG = CSR0_INEA | CSR0_TDMD;
837
838 if ((MEM->tx_head[(entry+1) & TX_RING_MOD_MASK].flag & TMD1_OWN) ==
839 TMD1_OWN_HOST)
840 netif_start_queue (dev);
841 else
842 lp->tx_full = 1;
843 spin_unlock_irqrestore (&lp->devlock, flags);
844
845 return NETDEV_TX_OK;
846}
847
848
849
850static irqreturn_t lance_interrupt( int irq, void *dev_id )
851{
852 struct net_device *dev = dev_id;
853 struct lance_private *lp;
854 struct lance_ioreg *IO;
855 int csr0, boguscnt = 10;
856 int handled = 0;
857
858 if (dev == NULL) {
859 DPRINTK( 1, ( "lance_interrupt(): interrupt for unknown device.\n" ));
860 return IRQ_NONE;
861 }
862
863 lp = netdev_priv(dev);
864 IO = lp->iobase;
865 spin_lock (&lp->devlock);
866
867 AREG = CSR0;
868
869 while( ((csr0 = DREG) & (CSR0_ERR | CSR0_TINT | CSR0_RINT)) &&
870 --boguscnt >= 0) {
871 handled = 1;
872
873 DREG = csr0 & ~(CSR0_INIT | CSR0_STRT | CSR0_STOP |
874 CSR0_TDMD | CSR0_INEA);
875
876 DPRINTK( 2, ( "%s: interrupt csr0=%04x new csr=%04x.\n",
877 dev->name, csr0, DREG ));
878
879 if (csr0 & CSR0_RINT)
880 lance_rx( dev );
881
882 if (csr0 & CSR0_TINT) {
883 int dirty_tx = lp->dirty_tx;
884
885 while( dirty_tx < lp->cur_tx) {
886 int entry = dirty_tx & TX_RING_MOD_MASK;
887 int status = MEM->tx_head[entry].flag;
888
889 if (status & TMD1_OWN_CHIP)
890 break;
891
892 MEM->tx_head[entry].flag = 0;
893
894 if (status & TMD1_ERR) {
895
896 int err_status = MEM->tx_head[entry].misc;
897 dev->stats.tx_errors++;
898 if (err_status & TMD3_RTRY) dev->stats.tx_aborted_errors++;
899 if (err_status & TMD3_LCAR) dev->stats.tx_carrier_errors++;
900 if (err_status & TMD3_LCOL) dev->stats.tx_window_errors++;
901 if (err_status & TMD3_UFLO) {
902
903 dev->stats.tx_fifo_errors++;
904
905 DPRINTK( 1, ( "%s: Tx FIFO error! Status %04x\n",
906 dev->name, csr0 ));
907
908 DREG = CSR0_STRT;
909 }
910 } else {
911 if (status & (TMD1_MORE | TMD1_ONE | TMD1_DEF))
912 dev->stats.collisions++;
913 dev->stats.tx_packets++;
914 }
915
916
917 dirty_tx++;
918 }
919
920#ifndef final_version
921 if (lp->cur_tx - dirty_tx >= TX_RING_SIZE) {
922 DPRINTK( 0, ( "out-of-sync dirty pointer,"
923 " %d vs. %d, full=%ld.\n",
924 dirty_tx, lp->cur_tx, lp->tx_full ));
925 dirty_tx += TX_RING_SIZE;
926 }
927#endif
928
929 if (lp->tx_full && (netif_queue_stopped(dev)) &&
930 dirty_tx > lp->cur_tx - TX_RING_SIZE + 2) {
931
932 lp->tx_full = 0;
933 netif_wake_queue (dev);
934 }
935
936 lp->dirty_tx = dirty_tx;
937 }
938
939
940 if (csr0 & CSR0_BABL) dev->stats.tx_errors++;
941 if (csr0 & CSR0_MISS) dev->stats.rx_errors++;
942 if (csr0 & CSR0_MERR) {
943 DPRINTK( 1, ( "%s: Bus master arbitration failure (?!?), "
944 "status %04x.\n", dev->name, csr0 ));
945
946 DREG = CSR0_STRT;
947 }
948 }
949
950
951 DREG = CSR0_BABL | CSR0_CERR | CSR0_MISS | CSR0_MERR |
952 CSR0_IDON | CSR0_INEA;
953
954 DPRINTK( 2, ( "%s: exiting interrupt, csr0=%#04x.\n",
955 dev->name, DREG ));
956
957 spin_unlock (&lp->devlock);
958 return IRQ_RETVAL(handled);
959}
960
961
962static int lance_rx( struct net_device *dev )
963{
964 struct lance_private *lp = netdev_priv(dev);
965 int entry = lp->cur_rx & RX_RING_MOD_MASK;
966 int i;
967
968 DPRINTK( 2, ( "%s: rx int, flag=%04x\n", dev->name,
969 MEM->rx_head[entry].flag ));
970
971
972 while( (MEM->rx_head[entry].flag & RMD1_OWN) == RMD1_OWN_HOST ) {
973 struct lance_rx_head *head = &(MEM->rx_head[entry]);
974 int status = head->flag;
975
976 if (status != (RMD1_ENP|RMD1_STP)) {
977
978
979
980
981 if (status & RMD1_ENP)
982 dev->stats.rx_errors++;
983 if (status & RMD1_FRAM) dev->stats.rx_frame_errors++;
984 if (status & RMD1_OFLO) dev->stats.rx_over_errors++;
985 if (status & RMD1_CRC) dev->stats.rx_crc_errors++;
986 if (status & RMD1_BUFF) dev->stats.rx_fifo_errors++;
987 head->flag &= (RMD1_ENP|RMD1_STP);
988 } else {
989
990 short pkt_len = head->msg_length & 0xfff;
991 struct sk_buff *skb;
992
993 if (pkt_len < 60) {
994 printk( "%s: Runt packet!\n", dev->name );
995 dev->stats.rx_errors++;
996 }
997 else {
998 skb = netdev_alloc_skb(dev, pkt_len + 2);
999 if (skb == NULL) {
1000 for( i = 0; i < RX_RING_SIZE; i++ )
1001 if (MEM->rx_head[(entry+i) & RX_RING_MOD_MASK].flag &
1002 RMD1_OWN_CHIP)
1003 break;
1004
1005 if (i > RX_RING_SIZE - 2) {
1006 dev->stats.rx_dropped++;
1007 head->flag |= RMD1_OWN_CHIP;
1008 lp->cur_rx++;
1009 }
1010 break;
1011 }
1012
1013 if (lance_debug >= 3) {
1014 u_char *data = PKTBUF_ADDR(head);
1015
1016 printk(KERN_DEBUG "%s: RX pkt type 0x%04x from %pM to %pM "
1017 "data %8ph len %d\n",
1018 dev->name, ((u_short *)data)[6],
1019 &data[6], data, &data[15], pkt_len);
1020 }
1021
1022 skb_reserve( skb, 2 );
1023 skb_put( skb, pkt_len );
1024 lp->memcpy_f( skb->data, PKTBUF_ADDR(head), pkt_len );
1025 skb->protocol = eth_type_trans( skb, dev );
1026 netif_rx( skb );
1027 dev->stats.rx_packets++;
1028 dev->stats.rx_bytes += pkt_len;
1029 }
1030 }
1031
1032 head->flag |= RMD1_OWN_CHIP;
1033 entry = (++lp->cur_rx) & RX_RING_MOD_MASK;
1034 }
1035 lp->cur_rx &= RX_RING_MOD_MASK;
1036
1037
1038
1039
1040
1041 return 0;
1042}
1043
1044
1045static int lance_close( struct net_device *dev )
1046{
1047 struct lance_private *lp = netdev_priv(dev);
1048 struct lance_ioreg *IO = lp->iobase;
1049
1050 netif_stop_queue (dev);
1051
1052 AREG = CSR0;
1053
1054 DPRINTK( 2, ( "%s: Shutting down ethercard, status was %2.2x.\n",
1055 dev->name, DREG ));
1056
1057
1058
1059 DREG = CSR0_STOP;
1060
1061 return 0;
1062}
1063
1064
1065
1066
1067
1068
1069
1070
1071
1072static void set_multicast_list( struct net_device *dev )
1073{
1074 struct lance_private *lp = netdev_priv(dev);
1075 struct lance_ioreg *IO = lp->iobase;
1076
1077 if (netif_running(dev))
1078
1079 return;
1080
1081
1082 DREG = CSR0_STOP;
1083
1084 if (dev->flags & IFF_PROMISC) {
1085
1086 DPRINTK( 2, ( "%s: Promiscuous mode enabled.\n", dev->name ));
1087 REGA( CSR15 ) = 0x8000;
1088 } else {
1089 short multicast_table[4];
1090 int num_addrs = netdev_mc_count(dev);
1091 int i;
1092
1093
1094 memset( multicast_table, (num_addrs == 0) ? 0 : -1,
1095 sizeof(multicast_table) );
1096 for( i = 0; i < 4; i++ )
1097 REGA( CSR8+i ) = multicast_table[i];
1098 REGA( CSR15 ) = 0;
1099 }
1100
1101
1102
1103
1104
1105 REGA( CSR3 ) = CSR3_BSWP | (lp->cardtype == PAM_CARD ? CSR3_ACON : 0);
1106
1107
1108 REGA( CSR0 ) = CSR0_IDON | CSR0_INEA | CSR0_STRT;
1109}
1110
1111
1112
1113
1114static int lance_set_mac_address( struct net_device *dev, void *addr )
1115{
1116 struct lance_private *lp = netdev_priv(dev);
1117 struct sockaddr *saddr = addr;
1118 int i;
1119
1120 if (lp->cardtype != OLD_RIEBL && lp->cardtype != NEW_RIEBL)
1121 return -EOPNOTSUPP;
1122
1123 if (netif_running(dev)) {
1124
1125 DPRINTK( 1, ( "%s: hwaddr can be set only while card isn't open.\n",
1126 dev->name ));
1127 return -EIO;
1128 }
1129
1130 memcpy( dev->dev_addr, saddr->sa_data, dev->addr_len );
1131 for( i = 0; i < 6; i++ )
1132 MEM->init.hwaddr[i] = dev->dev_addr[i^1];
1133 lp->memcpy_f( RIEBL_HWADDR_ADDR, dev->dev_addr, 6 );
1134
1135 *RIEBL_MAGIC_ADDR = RIEBL_MAGIC;
1136
1137 return 0;
1138}
1139
1140
1141#ifdef MODULE
1142static struct net_device *atarilance_dev;
1143
1144static int __init atarilance_module_init(void)
1145{
1146 atarilance_dev = atarilance_probe(-1);
1147 return PTR_ERR_OR_ZERO(atarilance_dev);
1148}
1149
1150static void __exit atarilance_module_exit(void)
1151{
1152 unregister_netdev(atarilance_dev);
1153 free_irq(atarilance_dev->irq, atarilance_dev);
1154 free_netdev(atarilance_dev);
1155}
1156module_init(atarilance_module_init);
1157module_exit(atarilance_module_exit);
1158#endif
1159
1160
1161
1162
1163
1164
1165
1166
1167