Gitiles
Code Review Sign In
gerrit-public.fairphone.software / kernel / msm-4.9 / 1da177e4c3f41524e886b7f1b8a0c1fc7321cac2 / . / drivers / net / wan / sbni.c
blob: db2c798ba89efef1469e7005849e1507eb41a010 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame^]1/* sbni.c: Granch SBNI12 leased line adapters driver for linux
2 *
3 * Written 2001 by Denis I.Timofeev (timofeev@granch.ru)
4 *
5 * Previous versions were written by Yaroslav Polyakov,
6 * Alexey Zverev and Max Khon.
7 *
8 * Driver supports SBNI12-02,-04,-05,-10,-11 cards, single and
9 * double-channel, PCI and ISA modifications.
10 * More info and useful utilities to work with SBNI12 cards you can find
11 * at http://www.granch.com (English) or http://www.granch.ru (Russian)
12 *
13 * This software may be used and distributed according to the terms
14 * of the GNU General Public License.
15 *
16 *
17 * 5.0.1 Jun 22 2001
18 * - Fixed bug in probe
19 * 5.0.0 Jun 06 2001
20 * - Driver was completely redesigned by Denis I.Timofeev,
21 * - now PCI/Dual, ISA/Dual (with single interrupt line) models are
22 * - supported
23 * 3.3.0 Thu Feb 24 21:30:28 NOVT 2000
24 * - PCI cards support
25 * 3.2.0 Mon Dec 13 22:26:53 NOVT 1999
26 * - Completely rebuilt all the packet storage system
27 * - to work in Ethernet-like style.
28 * 3.1.1 just fixed some bugs (5 aug 1999)
29 * 3.1.0 added balancing feature (26 apr 1999)
30 * 3.0.1 just fixed some bugs (14 apr 1999).
31 * 3.0.0 Initial Revision, Yaroslav Polyakov (24 Feb 1999)
32 * - added pre-calculation for CRC, fixed bug with "len-2" frames,
33 * - removed outbound fragmentation (MTU=1000), written CRC-calculation
34 * - on asm, added work with hard_headers and now we have our own cache
35 * - for them, optionally supported word-interchange on some chipsets,
36 *
37 * Known problem: this driver wasn't tested on multiprocessor machine.
38 */
39
40#include <linux/config.h>
41#include <linux/module.h>
42#include <linux/kernel.h>
43#include <linux/ptrace.h>
44#include <linux/fcntl.h>
45#include <linux/ioport.h>
46#include <linux/interrupt.h>
47#include <linux/slab.h>
48#include <linux/string.h>
49#include <linux/errno.h>
50#include <linux/netdevice.h>
51#include <linux/etherdevice.h>
52#include <linux/pci.h>
53#include <linux/skbuff.h>
54#include <linux/timer.h>
55#include <linux/init.h>
56#include <linux/delay.h>
57
58#include <net/arp.h>
59
60#include <asm/io.h>
61#include <asm/types.h>
62#include <asm/byteorder.h>
63#include <asm/irq.h>
64#include <asm/uaccess.h>
65
66#include "sbni.h"
67
68/* device private data */
69
70struct net_local {
71 struct net_device_stats stats;
72 struct timer_list watchdog;
73
74 spinlock_t lock;
75 struct sk_buff *rx_buf_p; /* receive buffer ptr */
76 struct sk_buff *tx_buf_p; /* transmit buffer ptr */
77
78 unsigned int framelen; /* current frame length */
79 unsigned int maxframe; /* maximum valid frame length */
80 unsigned int state;
81 unsigned int inppos, outpos; /* positions in rx/tx buffers */
82
83 /* transmitting frame number - from frames qty to 1 */
84 unsigned int tx_frameno;
85
86 /* expected number of next receiving frame */
87 unsigned int wait_frameno;
88
89 /* count of failed attempts to frame send - 32 attempts do before
90 error - while receiver tunes on opposite side of wire */
91 unsigned int trans_errors;
92
93 /* idle time; send pong when limit exceeded */
94 unsigned int timer_ticks;
95
96 /* fields used for receive level autoselection */
97 int delta_rxl;
98 unsigned int cur_rxl_index, timeout_rxl;
99 unsigned long cur_rxl_rcvd, prev_rxl_rcvd;
100
101 struct sbni_csr1 csr1; /* current value of CSR1 */
102 struct sbni_in_stats in_stats; /* internal statistics */
103
104 struct net_device *second; /* for ISA/dual cards */
105
106#ifdef CONFIG_SBNI_MULTILINE
107 struct net_device *master;
108 struct net_device *link;
109#endif
110};
111
112
113static int sbni_card_probe( unsigned long );
114static int sbni_pci_probe( struct net_device * );
115static struct net_device *sbni_probe1(struct net_device *, unsigned long, int);
116static int sbni_open( struct net_device * );
117static int sbni_close( struct net_device * );
118static int sbni_start_xmit( struct sk_buff *, struct net_device * );
119static int sbni_ioctl( struct net_device *, struct ifreq *, int );
120static struct net_device_stats *sbni_get_stats( struct net_device * );
121static void set_multicast_list( struct net_device * );
122
123static irqreturn_t sbni_interrupt( int, void *, struct pt_regs * );
124static void handle_channel( struct net_device * );
125static int recv_frame( struct net_device * );
126static void send_frame( struct net_device * );
127static int upload_data( struct net_device *,
128 unsigned, unsigned, unsigned, u32 );
129static void download_data( struct net_device *, u32 * );
130static void sbni_watchdog( unsigned long );
131static void interpret_ack( struct net_device *, unsigned );
132static int append_frame_to_pkt( struct net_device *, unsigned, u32 );
133static void indicate_pkt( struct net_device * );
134static void card_start( struct net_device * );
135static void prepare_to_send( struct sk_buff *, struct net_device * );
136static void drop_xmit_queue( struct net_device * );
137static void send_frame_header( struct net_device *, u32 * );
138static int skip_tail( unsigned int, unsigned int, u32 );
139static int check_fhdr( u32, u32 *, u32 *, u32 *, u32 *, u32 * );
140static void change_level( struct net_device * );
141static void timeout_change_level( struct net_device * );
142static u32 calc_crc32( u32, u8 *, u32 );
143static struct sk_buff * get_rx_buf( struct net_device * );
144static int sbni_init( struct net_device * );
145
146#ifdef CONFIG_SBNI_MULTILINE
147static int enslave( struct net_device *, struct net_device * );
148static int emancipate( struct net_device * );
149#endif
150
151#ifdef __i386__
152#define ASM_CRC 1
153#endif
154
155static const char version[] =
156 "Granch SBNI12 driver ver 5.0.1 Jun 22 2001 Denis I.Timofeev.\n";
157
158static int skip_pci_probe __initdata = 0;
159static int scandone __initdata = 0;
160static int num __initdata = 0;
161
162static unsigned char rxl_tab[];
163static u32 crc32tab[];
164
165/* A list of all installed devices, for removing the driver module. */
166static struct net_device *sbni_cards[ SBNI_MAX_NUM_CARDS ];
167
168/* Lists of device's parameters */
169static u32 io[ SBNI_MAX_NUM_CARDS ] __initdata =
170 { [0 ... SBNI_MAX_NUM_CARDS-1] = -1 };
171static u32 irq[ SBNI_MAX_NUM_CARDS ] __initdata;
172static u32 baud[ SBNI_MAX_NUM_CARDS ] __initdata;
173static u32 rxl[ SBNI_MAX_NUM_CARDS ] __initdata =
174 { [0 ... SBNI_MAX_NUM_CARDS-1] = -1 };
175static u32 mac[ SBNI_MAX_NUM_CARDS ] __initdata;
176
177#ifndef MODULE
178typedef u32 iarr[];
179static iarr __initdata *dest[5] = { &io, &irq, &baud, &rxl, &mac };
180#endif
181
182/* A zero-terminated list of I/O addresses to be probed on ISA bus */
183static unsigned int netcard_portlist[ ] __initdata = {
184 0x210, 0x214, 0x220, 0x224, 0x230, 0x234, 0x240, 0x244, 0x250, 0x254,
185 0x260, 0x264, 0x270, 0x274, 0x280, 0x284, 0x290, 0x294, 0x2a0, 0x2a4,
186 0x2b0, 0x2b4, 0x2c0, 0x2c4, 0x2d0, 0x2d4, 0x2e0, 0x2e4, 0x2f0, 0x2f4,
187 0 };
188
189
190/*
191 * Look for SBNI card which addr stored in dev->base_addr, if nonzero.
192 * Otherwise, look through PCI bus. If none PCI-card was found, scan ISA.
193 */
194
195static inline int __init
196sbni_isa_probe( struct net_device *dev )
197{
198 if( dev->base_addr > 0x1ff
199 && request_region( dev->base_addr, SBNI_IO_EXTENT, dev->name )
200 && sbni_probe1( dev, dev->base_addr, dev->irq ) )
201
202 return 0;
203 else {
204 printk( KERN_ERR "sbni: base address 0x%lx is busy, or adapter "
205 "is malfunctional!\n", dev->base_addr );
206 return -ENODEV;
207 }
208}
209
210static void __init sbni_devsetup(struct net_device *dev)
211{
212 ether_setup( dev );
213 dev->open = &sbni_open;
214 dev->stop = &sbni_close;
215 dev->hard_start_xmit = &sbni_start_xmit;
216 dev->get_stats = &sbni_get_stats;
217 dev->set_multicast_list = &set_multicast_list;
218 dev->do_ioctl = &sbni_ioctl;
219
220 SET_MODULE_OWNER( dev );
221}
222
223int __init sbni_probe(int unit)
224{
225 struct net_device *dev;
226 static unsigned version_printed __initdata = 0;
227 int err;
228
229 dev = alloc_netdev(sizeof(struct net_local), "sbni", sbni_devsetup);
230 if (!dev)
231 return -ENOMEM;
232
233 sprintf(dev->name, "sbni%d", unit);
234 netdev_boot_setup_check(dev);
235
236 err = sbni_init(dev);
237 if (err) {
238 free_netdev(dev);
239 return err;
240 }
241
242 err = register_netdev(dev);
243 if (err) {
244 release_region( dev->base_addr, SBNI_IO_EXTENT );
245 free_netdev(dev);
246 return err;
247 }
248 if( version_printed++ == 0 )
249 printk( KERN_INFO "%s", version );
250 return 0;
251}
252
253static int __init sbni_init(struct net_device *dev)
254{
255 int i;
256 if( dev->base_addr )
257 return sbni_isa_probe( dev );
258 /* otherwise we have to perform search our adapter */
259
260 if( io[ num ] != -1 )
261 dev->base_addr = io[ num ],
262 dev->irq = irq[ num ];
263 else if( scandone || io[ 0 ] != -1 )
264 return -ENODEV;
265
266 /* if io[ num ] contains non-zero address, then that is on ISA bus */
267 if( dev->base_addr )
268 return sbni_isa_probe( dev );
269
270 /* ...otherwise - scan PCI first */
271 if( !skip_pci_probe && !sbni_pci_probe( dev ) )
272 return 0;
273
274 if( io[ num ] == -1 ) {
275 /* Auto-scan will be stopped when first ISA card were found */
276 scandone = 1;
277 if( num > 0 )
278 return -ENODEV;
279 }
280
281 for( i = 0; netcard_portlist[ i ]; ++i ) {
282 int ioaddr = netcard_portlist[ i ];
283 if( request_region( ioaddr, SBNI_IO_EXTENT, dev->name )
284 && sbni_probe1( dev, ioaddr, 0 ))
285 return 0;
286 }
287
288 return -ENODEV;
289}
290
291
292int __init
293sbni_pci_probe( struct net_device *dev )
294{
295 struct pci_dev *pdev = NULL;
296
297 while( (pdev = pci_get_class( PCI_CLASS_NETWORK_OTHER << 8, pdev ))
298 != NULL ) {
299 int pci_irq_line;
300 unsigned long pci_ioaddr;
301 u16 subsys;
302
303 if( pdev->vendor != SBNI_PCI_VENDOR
304 && pdev->device != SBNI_PCI_DEVICE )
305 continue;
306
307 pci_ioaddr = pci_resource_start( pdev, 0 );
308 pci_irq_line = pdev->irq;
309
310 /* Avoid already found cards from previous calls */
311 if( !request_region( pci_ioaddr, SBNI_IO_EXTENT, dev->name ) ) {
312 pci_read_config_word( pdev, PCI_SUBSYSTEM_ID, &subsys );
313
314 if (subsys != 2)
315 continue;
316
317 /* Dual adapter is present */
318 if (!request_region(pci_ioaddr += 4, SBNI_IO_EXTENT,
319 dev->name ) )
320 continue;
321 }
322
323 if( pci_irq_line <= 0 || pci_irq_line >= NR_IRQS )
324 printk( KERN_WARNING " WARNING: The PCI BIOS assigned "
325 "this PCI card to IRQ %d, which is unlikely "
326 "to work!.\n"
327 KERN_WARNING " You should use the PCI BIOS "
328 "setup to assign a valid IRQ line.\n",
329 pci_irq_line );
330
331 /* avoiding re-enable dual adapters */
332 if( (pci_ioaddr & 7) == 0 && pci_enable_device( pdev ) ) {
333 release_region( pci_ioaddr, SBNI_IO_EXTENT );
334 pci_dev_put( pdev );
335 return -EIO;
336 }
337 if( sbni_probe1( dev, pci_ioaddr, pci_irq_line ) ) {
338 SET_NETDEV_DEV(dev, &pdev->dev);
339 /* not the best thing to do, but this is all messed up
340 for hotplug systems anyway... */
341 pci_dev_put( pdev );
342 return 0;
343 }
344 }
345 return -ENODEV;
346}
347
348
349static struct net_device * __init
350sbni_probe1( struct net_device *dev, unsigned long ioaddr, int irq )
351{
352 struct net_local *nl;
353
354 if( sbni_card_probe( ioaddr ) ) {
355 release_region( ioaddr, SBNI_IO_EXTENT );
356 return NULL;
357 }
358
359 outb( 0, ioaddr + CSR0 );
360
361 if( irq < 2 ) {
362 unsigned long irq_mask;
363
364 irq_mask = probe_irq_on();
365 outb( EN_INT | TR_REQ, ioaddr + CSR0 );
366 outb( PR_RES, ioaddr + CSR1 );
367 mdelay(50);
368 irq = probe_irq_off(irq_mask);
369 outb( 0, ioaddr + CSR0 );
370
371 if( !irq ) {
372 printk( KERN_ERR "%s: can't detect device irq!\n",
373 dev->name );
374 release_region( ioaddr, SBNI_IO_EXTENT );
375 return NULL;
376 }
377 } else if( irq == 2 )
378 irq = 9;
379
380 dev->irq = irq;
381 dev->base_addr = ioaddr;
382
383 /* Allocate dev->priv and fill in sbni-specific dev fields. */
384 nl = dev->priv;
385 if( !nl ) {
386 printk( KERN_ERR "%s: unable to get memory!\n", dev->name );
387 release_region( ioaddr, SBNI_IO_EXTENT );
388 return NULL;
389 }
390
391 dev->priv = nl;
392 memset( nl, 0, sizeof(struct net_local) );
393 spin_lock_init( &nl->lock );
394
395 /* store MAC address (generate if that isn't known) */
396 *(u16 *)dev->dev_addr = htons( 0x00ff );
397 *(u32 *)(dev->dev_addr + 2) = htonl( 0x01000000 |
398 ( (mac[num] ? mac[num] : (u32)((long)dev->priv)) & 0x00ffffff) );
399
400 /* store link settings (speed, receive level ) */
401 nl->maxframe = DEFAULT_FRAME_LEN;
402 nl->csr1.rate = baud[ num ];
403
404 if( (nl->cur_rxl_index = rxl[ num ]) == -1 )
405 /* autotune rxl */
406 nl->cur_rxl_index = DEF_RXL,
407 nl->delta_rxl = DEF_RXL_DELTA;
408 else
409 nl->delta_rxl = 0;
410 nl->csr1.rxl = rxl_tab[ nl->cur_rxl_index ];
411 if( inb( ioaddr + CSR0 ) & 0x01 )
412 nl->state |= FL_SLOW_MODE;
413
414 printk( KERN_NOTICE "%s: ioaddr %#lx, irq %d, "
415 "MAC: 00:ff:01:%02x:%02x:%02x\n",
416 dev->name, dev->base_addr, dev->irq,
417 ((u8 *) dev->dev_addr) [3],
418 ((u8 *) dev->dev_addr) [4],
419 ((u8 *) dev->dev_addr) [5] );
420
421 printk( KERN_NOTICE "%s: speed %d, receive level ", dev->name,
422 ( (nl->state & FL_SLOW_MODE) ? 500000 : 2000000)
423 / (1 << nl->csr1.rate) );
424
425 if( nl->delta_rxl == 0 )
426 printk( "0x%x (fixed)\n", nl->cur_rxl_index );
427 else
428 printk( "(auto)\n");
429
430#ifdef CONFIG_SBNI_MULTILINE
431 nl->master = dev;
432 nl->link = NULL;
433#endif
434
435 sbni_cards[ num++ ] = dev;
436 return dev;
437}
438
439/* -------------------------------------------------------------------------- */
440
441#ifdef CONFIG_SBNI_MULTILINE
442
443static int
444sbni_start_xmit( struct sk_buff *skb, struct net_device *dev )
445{
446 struct net_device *p;
447
448 netif_stop_queue( dev );
449
450 /* Looking for idle device in the list */
451 for( p = dev; p; ) {
452 struct net_local *nl = (struct net_local *) p->priv;
453 spin_lock( &nl->lock );
454 if( nl->tx_buf_p || (nl->state & FL_LINE_DOWN) ) {
455 p = nl->link;
456 spin_unlock( &nl->lock );
457 } else {
458 /* Idle dev is found */
459 prepare_to_send( skb, p );
460 spin_unlock( &nl->lock );
461 netif_start_queue( dev );
462 return 0;
463 }
464 }
465
466 return 1;
467}
468
469#else /* CONFIG_SBNI_MULTILINE */
470
471static int
472sbni_start_xmit( struct sk_buff *skb, struct net_device *dev )
473{
474 struct net_local *nl = (struct net_local *) dev->priv;
475
476 netif_stop_queue( dev );
477 spin_lock( &nl->lock );
478
479 prepare_to_send( skb, dev );
480
481 spin_unlock( &nl->lock );
482 return 0;
483}
484
485#endif /* CONFIG_SBNI_MULTILINE */
486
487/* -------------------------------------------------------------------------- */
488
489/* interrupt handler */
490
491/*
492 * SBNI12D-10, -11/ISA boards within "common interrupt" mode could not
493 * be looked as two independent single-channel devices. Every channel seems
494 * as Ethernet interface but interrupt handler must be common. Really, first
495 * channel ("master") driver only registers the handler. In its struct net_local
496 * it has got pointer to "slave" channel's struct net_local and handles that's
497 * interrupts too.
498 * dev of successfully attached ISA SBNI boards is linked to list.
499 * While next board driver is initialized, it scans this list. If one
500 * has found dev with same irq and ioaddr different by 4 then it assumes
501 * this board to be "master".
502 */
503
504static irqreturn_t
505sbni_interrupt( int irq, void *dev_id, struct pt_regs *regs )
506{
507 struct net_device *dev = (struct net_device *) dev_id;
508 struct net_local *nl = (struct net_local *) dev->priv;
509 int repeat;
510
511 spin_lock( &nl->lock );
512 if( nl->second )
513 spin_lock( &((struct net_local *) nl->second->priv)->lock );
514
515 do {
516 repeat = 0;
517 if( inb( dev->base_addr + CSR0 ) & (RC_RDY | TR_RDY) )
518 handle_channel( dev ),
519 repeat = 1;
520 if( nl->second && /* second channel present */
521 (inb( nl->second->base_addr+CSR0 ) & (RC_RDY | TR_RDY)) )
522 handle_channel( nl->second ),
523 repeat = 1;
524 } while( repeat );
525
526 if( nl->second )
527 spin_unlock( &((struct net_local *)nl->second->priv)->lock );
528 spin_unlock( &nl->lock );
529 return IRQ_HANDLED;
530}
531
532
533static void
534handle_channel( struct net_device *dev )
535{
536 struct net_local *nl = (struct net_local *) dev->priv;
537 unsigned long ioaddr = dev->base_addr;
538
539 int req_ans;
540 unsigned char csr0;
541
542#ifdef CONFIG_SBNI_MULTILINE
543 /* Lock the master device because we going to change its local data */
544 if( nl->state & FL_SLAVE )
545 spin_lock( &((struct net_local *) nl->master->priv)->lock );
546#endif
547
548 outb( (inb( ioaddr + CSR0 ) & ~EN_INT) | TR_REQ, ioaddr + CSR0 );
549
550 nl->timer_ticks = CHANGE_LEVEL_START_TICKS;
551 for(;;) {
552 csr0 = inb( ioaddr + CSR0 );
553 if( ( csr0 & (RC_RDY | TR_RDY) ) == 0 )
554 break;
555
556 req_ans = !(nl->state & FL_PREV_OK);
557
558 if( csr0 & RC_RDY )
559 req_ans = recv_frame( dev );
560
561 /*
562 * TR_RDY always equals 1 here because we have owned the marker,
563 * and we set TR_REQ when disabled interrupts
564 */
565 csr0 = inb( ioaddr + CSR0 );
566 if( !(csr0 & TR_RDY) || (csr0 & RC_RDY) )
567 printk( KERN_ERR "%s: internal error!\n", dev->name );
568
569 /* if state & FL_NEED_RESEND != 0 then tx_frameno != 0 */
570 if( req_ans || nl->tx_frameno != 0 )
571 send_frame( dev );
572 else
573 /* send marker without any data */
574 outb( inb( ioaddr + CSR0 ) & ~TR_REQ, ioaddr + CSR0 );
575 }
576
577 outb( inb( ioaddr + CSR0 ) | EN_INT, ioaddr + CSR0 );
578
579#ifdef CONFIG_SBNI_MULTILINE
580 if( nl->state & FL_SLAVE )
581 spin_unlock( &((struct net_local *) nl->master->priv)->lock );
582#endif
583}
584
585
586/*
587 * Routine returns 1 if it need to acknoweledge received frame.
588 * Empty frame received without errors won't be acknoweledged.
589 */
590
591static int
592recv_frame( struct net_device *dev )
593{
594 struct net_local *nl = (struct net_local *) dev->priv;
595 unsigned long ioaddr = dev->base_addr;
596
597 u32 crc = CRC32_INITIAL;
598
599 unsigned framelen, frameno, ack;
600 unsigned is_first, frame_ok;
601
602 if( check_fhdr( ioaddr, &framelen, &frameno, &ack, &is_first, &crc ) ) {
603 frame_ok = framelen > 4
604 ? upload_data( dev, framelen, frameno, is_first, crc )
605 : skip_tail( ioaddr, framelen, crc );
606 if( frame_ok )
607 interpret_ack( dev, ack );
608 } else
609 frame_ok = 0;
610
611 outb( inb( ioaddr + CSR0 ) ^ CT_ZER, ioaddr + CSR0 );
612 if( frame_ok ) {
613 nl->state |= FL_PREV_OK;
614 if( framelen > 4 )
615 nl->in_stats.all_rx_number++;
616 } else
617 nl->state &= ~FL_PREV_OK,
618 change_level( dev ),
619 nl->in_stats.all_rx_number++,
620 nl->in_stats.bad_rx_number++;
621
622 return !frame_ok || framelen > 4;
623}
624
625
626static void
627send_frame( struct net_device *dev )
628{
629 struct net_local *nl = (struct net_local *) dev->priv;
630
631 u32 crc = CRC32_INITIAL;
632
633 if( nl->state & FL_NEED_RESEND ) {
634
635 /* if frame was sended but not ACK'ed - resend it */
636 if( nl->trans_errors ) {
637 --nl->trans_errors;
638 if( nl->framelen != 0 )
639 nl->in_stats.resend_tx_number++;
640 } else {
641 /* cannot xmit with many attempts */
642#ifdef CONFIG_SBNI_MULTILINE
643 if( (nl->state & FL_SLAVE) || nl->link )
644#endif
645 nl->state |= FL_LINE_DOWN;
646 drop_xmit_queue( dev );
647 goto do_send;
648 }
649 } else
650 nl->trans_errors = TR_ERROR_COUNT;
651
652 send_frame_header( dev, &crc );
653 nl->state |= FL_NEED_RESEND;
654 /*
655 * FL_NEED_RESEND will be cleared after ACK, but if empty
656 * frame sended then in prepare_to_send next frame
657 */
658
659
660 if( nl->framelen ) {
661 download_data( dev, &crc );
662 nl->in_stats.all_tx_number++;
663 nl->state |= FL_WAIT_ACK;
664 }
665
666 outsb( dev->base_addr + DAT, (u8 *)&crc, sizeof crc );
667
668do_send:
669 outb( inb( dev->base_addr + CSR0 ) & ~TR_REQ, dev->base_addr + CSR0 );
670
671 if( nl->tx_frameno )
672 /* next frame exists - we request card to send it */
673 outb( inb( dev->base_addr + CSR0 ) | TR_REQ,
674 dev->base_addr + CSR0 );
675}
676
677
678/*
679 * Write the frame data into adapter's buffer memory, and calculate CRC.
680 * Do padding if necessary.
681 */
682
683static void
684download_data( struct net_device *dev, u32 *crc_p )
685{
686 struct net_local *nl = (struct net_local *) dev->priv;
687 struct sk_buff *skb = nl->tx_buf_p;
688
689 unsigned len = min_t(unsigned int, skb->len - nl->outpos, nl->framelen);
690
691 outsb( dev->base_addr + DAT, skb->data + nl->outpos, len );
692 *crc_p = calc_crc32( *crc_p, skb->data + nl->outpos, len );
693
694 /* if packet too short we should write some more bytes to pad */
695 for( len = nl->framelen - len; len--; )
696 outb( 0, dev->base_addr + DAT ),
697 *crc_p = CRC32( 0, *crc_p );
698}
699
700
701static int
702upload_data( struct net_device *dev, unsigned framelen, unsigned frameno,
703 unsigned is_first, u32 crc )
704{
705 struct net_local *nl = (struct net_local *) dev->priv;
706
707 int frame_ok;
708
709 if( is_first )
710 nl->wait_frameno = frameno,
711 nl->inppos = 0;
712
713 if( nl->wait_frameno == frameno ) {
714
715 if( nl->inppos + framelen <= ETHER_MAX_LEN )
716 frame_ok = append_frame_to_pkt( dev, framelen, crc );
717
718 /*
719 * if CRC is right but framelen incorrect then transmitter
720 * error was occurred... drop entire packet
721 */
722 else if( (frame_ok = skip_tail( dev->base_addr, framelen, crc ))
723 != 0 )
724 nl->wait_frameno = 0,
725 nl->inppos = 0,
726#ifdef CONFIG_SBNI_MULTILINE
727 ((struct net_local *) nl->master->priv)
728 ->stats.rx_errors++,
729 ((struct net_local *) nl->master->priv)
730 ->stats.rx_missed_errors++;
731#else
732 nl->stats.rx_errors++,
733 nl->stats.rx_missed_errors++;
734#endif
735 /* now skip all frames until is_first != 0 */
736 } else
737 frame_ok = skip_tail( dev->base_addr, framelen, crc );
738
739 if( is_first && !frame_ok )
740 /*
741 * Frame has been broken, but we had already stored
742 * is_first... Drop entire packet.
743 */
744 nl->wait_frameno = 0,
745#ifdef CONFIG_SBNI_MULTILINE
746 ((struct net_local *) nl->master->priv)->stats.rx_errors++,
747 ((struct net_local *) nl->master->priv)->stats.rx_crc_errors++;
748#else
749 nl->stats.rx_errors++,
750 nl->stats.rx_crc_errors++;
751#endif
752
753 return frame_ok;
754}
755
756
757static __inline void
758send_complete( struct net_local *nl )
759{
760#ifdef CONFIG_SBNI_MULTILINE
761 ((struct net_local *) nl->master->priv)->stats.tx_packets++;
762 ((struct net_local *) nl->master->priv)->stats.tx_bytes
763 += nl->tx_buf_p->len;
764#else
765 nl->stats.tx_packets++;
766 nl->stats.tx_bytes += nl->tx_buf_p->len;
767#endif
768 dev_kfree_skb_irq( nl->tx_buf_p );
769
770 nl->tx_buf_p = NULL;
771
772 nl->outpos = 0;
773 nl->state &= ~(FL_WAIT_ACK | FL_NEED_RESEND);
774 nl->framelen = 0;
775}
776
777
778static void
779interpret_ack( struct net_device *dev, unsigned ack )
780{
781 struct net_local *nl = (struct net_local *) dev->priv;
782
783 if( ack == FRAME_SENT_OK ) {
784 nl->state &= ~FL_NEED_RESEND;
785
786 if( nl->state & FL_WAIT_ACK ) {
787 nl->outpos += nl->framelen;
788
789 if( --nl->tx_frameno )
790 nl->framelen = min_t(unsigned int,
791 nl->maxframe,
792 nl->tx_buf_p->len - nl->outpos);
793 else
794 send_complete( nl ),
795#ifdef CONFIG_SBNI_MULTILINE
796 netif_wake_queue( nl->master );
797#else
798 netif_wake_queue( dev );
799#endif
800 }
801 }
802
803 nl->state &= ~FL_WAIT_ACK;
804}
805
806
807/*
808 * Glue received frame with previous fragments of packet.
809 * Indicate packet when last frame would be accepted.
810 */
811
812static int
813append_frame_to_pkt( struct net_device *dev, unsigned framelen, u32 crc )
814{
815 struct net_local *nl = (struct net_local *) dev->priv;
816
817 u8 *p;
818
819 if( nl->inppos + framelen > ETHER_MAX_LEN )
820 return 0;
821
822 if( !nl->rx_buf_p && !(nl->rx_buf_p = get_rx_buf( dev )) )
823 return 0;
824
825 p = nl->rx_buf_p->data + nl->inppos;
826 insb( dev->base_addr + DAT, p, framelen );
827 if( calc_crc32( crc, p, framelen ) != CRC32_REMAINDER )
828 return 0;
829
830 nl->inppos += framelen - 4;
831 if( --nl->wait_frameno == 0 ) /* last frame received */
832 indicate_pkt( dev );
833
834 return 1;
835}
836
837
838/*
839 * Prepare to start output on adapter.
840 * Transmitter will be actually activated when marker is accepted.
841 */
842
843static void
844prepare_to_send( struct sk_buff *skb, struct net_device *dev )
845{
846 struct net_local *nl = (struct net_local *) dev->priv;
847
848 unsigned int len;
849
850 /* nl->tx_buf_p == NULL here! */
851 if( nl->tx_buf_p )
852 printk( KERN_ERR "%s: memory leak!\n", dev->name );
853
854 nl->outpos = 0;
855 nl->state &= ~(FL_WAIT_ACK | FL_NEED_RESEND);
856
857 len = skb->len;
858 if( len < SBNI_MIN_LEN )
859 len = SBNI_MIN_LEN;
860
861 nl->tx_buf_p = skb;
862 nl->tx_frameno = (len + nl->maxframe - 1) / nl->maxframe;
863 nl->framelen = len < nl->maxframe ? len : nl->maxframe;
864
865 outb( inb( dev->base_addr + CSR0 ) | TR_REQ, dev->base_addr + CSR0 );
866#ifdef CONFIG_SBNI_MULTILINE
867 nl->master->trans_start = jiffies;
868#else
869 dev->trans_start = jiffies;
870#endif
871}
872
873
874static void
875drop_xmit_queue( struct net_device *dev )
876{
877 struct net_local *nl = (struct net_local *) dev->priv;
878
879 if( nl->tx_buf_p )
880 dev_kfree_skb_any( nl->tx_buf_p ),
881 nl->tx_buf_p = NULL,
882#ifdef CONFIG_SBNI_MULTILINE
883 ((struct net_local *) nl->master->priv)
884 ->stats.tx_errors++,
885 ((struct net_local *) nl->master->priv)
886 ->stats.tx_carrier_errors++;
887#else
888 nl->stats.tx_errors++,
889 nl->stats.tx_carrier_errors++;
890#endif
891
892 nl->tx_frameno = 0;
893 nl->framelen = 0;
894 nl->outpos = 0;
895 nl->state &= ~(FL_WAIT_ACK | FL_NEED_RESEND);
896#ifdef CONFIG_SBNI_MULTILINE
897 netif_start_queue( nl->master );
898 nl->master->trans_start = jiffies;
899#else
900 netif_start_queue( dev );
901 dev->trans_start = jiffies;
902#endif
903}
904
905
906static void
907send_frame_header( struct net_device *dev, u32 *crc_p )
908{
909 struct net_local *nl = (struct net_local *) dev->priv;
910
911 u32 crc = *crc_p;
912 u32 len_field = nl->framelen + 6; /* CRC + frameno + reserved */
913 u8 value;
914
915 if( nl->state & FL_NEED_RESEND )
916 len_field |= FRAME_RETRY; /* non-first attempt... */
917
918 if( nl->outpos == 0 )
919 len_field |= FRAME_FIRST;
920
921 len_field |= (nl->state & FL_PREV_OK) ? FRAME_SENT_OK : FRAME_SENT_BAD;
922 outb( SBNI_SIG, dev->base_addr + DAT );
923
924 value = (u8) len_field;
925 outb( value, dev->base_addr + DAT );
926 crc = CRC32( value, crc );
927 value = (u8) (len_field >> 8);
928 outb( value, dev->base_addr + DAT );
929 crc = CRC32( value, crc );
930
931 outb( nl->tx_frameno, dev->base_addr + DAT );
932 crc = CRC32( nl->tx_frameno, crc );
933 outb( 0, dev->base_addr + DAT );
934 crc = CRC32( 0, crc );
935 *crc_p = crc;
936}
937
938
939/*
940 * if frame tail not needed (incorrect number or received twice),
941 * it won't store, but CRC will be calculated
942 */
943
944static int
945skip_tail( unsigned int ioaddr, unsigned int tail_len, u32 crc )
946{
947 while( tail_len-- )
948 crc = CRC32( inb( ioaddr + DAT ), crc );
949
950 return crc == CRC32_REMAINDER;
951}
952
953
954/*
955 * Preliminary checks if frame header is correct, calculates its CRC
956 * and split it to simple fields
957 */
958
959static int
960check_fhdr( u32 ioaddr, u32 *framelen, u32 *frameno, u32 *ack,
961 u32 *is_first, u32 *crc_p )
962{
963 u32 crc = *crc_p;
964 u8 value;
965
966 if( inb( ioaddr + DAT ) != SBNI_SIG )
967 return 0;
968
969 value = inb( ioaddr + DAT );
970 *framelen = (u32)value;
971 crc = CRC32( value, crc );
972 value = inb( ioaddr + DAT );
973 *framelen |= ((u32)value) << 8;
974 crc = CRC32( value, crc );
975
976 *ack = *framelen & FRAME_ACK_MASK;
977 *is_first = (*framelen & FRAME_FIRST) != 0;
978
979 if( (*framelen &= FRAME_LEN_MASK) < 6
980 || *framelen > SBNI_MAX_FRAME - 3 )
981 return 0;
982
983 value = inb( ioaddr + DAT );
984 *frameno = (u32)value;
985 crc = CRC32( value, crc );
986
987 crc = CRC32( inb( ioaddr + DAT ), crc ); /* reserved byte */
988 *framelen -= 2;
989
990 *crc_p = crc;
991 return 1;
992}
993
994
995static struct sk_buff *
996get_rx_buf( struct net_device *dev )
997{
998 /* +2 is to compensate for the alignment fixup below */
999 struct sk_buff *skb = dev_alloc_skb( ETHER_MAX_LEN + 2 );
1000 if( !skb )
1001 return NULL;
1002
1003#ifdef CONFIG_SBNI_MULTILINE
1004 skb->dev = ((struct net_local *) dev->priv)->master;
1005#else
1006 skb->dev = dev;
1007#endif
1008 skb_reserve( skb, 2 ); /* Align IP on longword boundaries */
1009 return skb;
1010}
1011
1012
1013static void
1014indicate_pkt( struct net_device *dev )
1015{
1016 struct net_local *nl = (struct net_local *) dev->priv;
1017 struct sk_buff *skb = nl->rx_buf_p;
1018
1019 skb_put( skb, nl->inppos );
1020
1021#ifdef CONFIG_SBNI_MULTILINE
1022 skb->protocol = eth_type_trans( skb, nl->master );
1023 netif_rx( skb );
1024 dev->last_rx = jiffies;
1025 ++((struct net_local *) nl->master->priv)->stats.rx_packets;
1026 ((struct net_local *) nl->master->priv)->stats.rx_bytes += nl->inppos;
1027#else
1028 skb->protocol = eth_type_trans( skb, dev );
1029 netif_rx( skb );
1030 dev->last_rx = jiffies;
1031 ++nl->stats.rx_packets;
1032 nl->stats.rx_bytes += nl->inppos;
1033#endif
1034 nl->rx_buf_p = NULL; /* protocol driver will clear this sk_buff */
1035}
1036
1037
1038/* -------------------------------------------------------------------------- */
1039
1040/*
1041 * Routine checks periodically wire activity and regenerates marker if
1042 * connect was inactive for a long time.
1043 */
1044
1045static void
1046sbni_watchdog( unsigned long arg )
1047{
1048 struct net_device *dev = (struct net_device *) arg;
1049 struct net_local *nl = (struct net_local *) dev->priv;
1050 struct timer_list *w = &nl->watchdog;
1051 unsigned long flags;
1052 unsigned char csr0;
1053
1054 spin_lock_irqsave( &nl->lock, flags );
1055
1056 csr0 = inb( dev->base_addr + CSR0 );
1057 if( csr0 & RC_CHK ) {
1058
1059 if( nl->timer_ticks ) {
1060 if( csr0 & (RC_RDY | BU_EMP) )
1061 /* receiving not active */
1062 nl->timer_ticks--;
1063 } else {
1064 nl->in_stats.timeout_number++;
1065 if( nl->delta_rxl )
1066 timeout_change_level( dev );
1067
1068 outb( *(u_char *)&nl->csr1 | PR_RES,
1069 dev->base_addr + CSR1 );
1070 csr0 = inb( dev->base_addr + CSR0 );
1071 }
1072 } else
1073 nl->state &= ~FL_LINE_DOWN;
1074
1075 outb( csr0 | RC_CHK, dev->base_addr + CSR0 );
1076
1077 init_timer( w );
1078 w->expires = jiffies + SBNI_TIMEOUT;
1079 w->data = arg;
1080 w->function = sbni_watchdog;
1081 add_timer( w );
1082
1083 spin_unlock_irqrestore( &nl->lock, flags );
1084}
1085
1086
1087static unsigned char rxl_tab[] = {
1088 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x08,
1089 0x0a, 0x0c, 0x0f, 0x16, 0x18, 0x1a, 0x1c, 0x1f
1090};
1091
1092#define SIZE_OF_TIMEOUT_RXL_TAB 4
1093static unsigned char timeout_rxl_tab[] = {
1094 0x03, 0x05, 0x08, 0x0b
1095};
1096
1097/* -------------------------------------------------------------------------- */
1098
1099static void
1100card_start( struct net_device *dev )
1101{
1102 struct net_local *nl = (struct net_local *) dev->priv;
1103
1104 nl->timer_ticks = CHANGE_LEVEL_START_TICKS;
1105 nl->state &= ~(FL_WAIT_ACK | FL_NEED_RESEND);
1106 nl->state |= FL_PREV_OK;
1107
1108 nl->inppos = nl->outpos = 0;
1109 nl->wait_frameno = 0;
1110 nl->tx_frameno = 0;
1111 nl->framelen = 0;
1112
1113 outb( *(u_char *)&nl->csr1 | PR_RES, dev->base_addr + CSR1 );
1114 outb( EN_INT, dev->base_addr + CSR0 );
1115}
1116
1117/* -------------------------------------------------------------------------- */
1118
1119/* Receive level auto-selection */
1120
1121static void
1122change_level( struct net_device *dev )
1123{
1124 struct net_local *nl = (struct net_local *) dev->priv;
1125
1126 if( nl->delta_rxl == 0 ) /* do not auto-negotiate RxL */
1127 return;
1128
1129 if( nl->cur_rxl_index == 0 )
1130 nl->delta_rxl = 1;
1131 else if( nl->cur_rxl_index == 15 )
1132 nl->delta_rxl = -1;
1133 else if( nl->cur_rxl_rcvd < nl->prev_rxl_rcvd )
1134 nl->delta_rxl = -nl->delta_rxl;
1135
1136 nl->csr1.rxl = rxl_tab[ nl->cur_rxl_index += nl->delta_rxl ];
1137 inb( dev->base_addr + CSR0 ); /* needs for PCI cards */
1138 outb( *(u8 *)&nl->csr1, dev->base_addr + CSR1 );
1139
1140 nl->prev_rxl_rcvd = nl->cur_rxl_rcvd;
1141 nl->cur_rxl_rcvd = 0;
1142}
1143
1144
1145static void
1146timeout_change_level( struct net_device *dev )
1147{
1148 struct net_local *nl = (struct net_local *) dev->priv;
1149
1150 nl->cur_rxl_index = timeout_rxl_tab[ nl->timeout_rxl ];
1151 if( ++nl->timeout_rxl >= 4 )
1152 nl->timeout_rxl = 0;
1153
1154 nl->csr1.rxl = rxl_tab[ nl->cur_rxl_index ];
1155 inb( dev->base_addr + CSR0 );
1156 outb( *(unsigned char *)&nl->csr1, dev->base_addr + CSR1 );
1157
1158 nl->prev_rxl_rcvd = nl->cur_rxl_rcvd;
1159 nl->cur_rxl_rcvd = 0;
1160}
1161
1162/* -------------------------------------------------------------------------- */
1163
1164/*
1165 * Open/initialize the board.
1166 */
1167
1168static int
1169sbni_open( struct net_device *dev )
1170{
1171 struct net_local *nl = (struct net_local *) dev->priv;
1172 struct timer_list *w = &nl->watchdog;
1173
1174 /*
1175 * For double ISA adapters within "common irq" mode, we have to
1176 * determine whether primary or secondary channel is initialized,
1177 * and set the irq handler only in first case.
1178 */
1179 if( dev->base_addr < 0x400 ) { /* ISA only */
1180 struct net_device **p = sbni_cards;
1181 for( ; *p && p < sbni_cards + SBNI_MAX_NUM_CARDS; ++p )
1182 if( (*p)->irq == dev->irq
1183 && ((*p)->base_addr == dev->base_addr + 4
1184 || (*p)->base_addr == dev->base_addr - 4)
1185 && (*p)->flags & IFF_UP ) {
1186
1187 ((struct net_local *) ((*p)->priv))
1188 ->second = dev;
1189 printk( KERN_NOTICE "%s: using shared irq "
1190 "with %s\n", dev->name, (*p)->name );
1191 nl->state |= FL_SECONDARY;
1192 goto handler_attached;
1193 }
1194 }
1195
1196 if( request_irq(dev->irq, sbni_interrupt, SA_SHIRQ, dev->name, dev) ) {
1197 printk( KERN_ERR "%s: unable to get IRQ %d.\n",
1198 dev->name, dev->irq );
1199 return -EAGAIN;
1200 }
1201
1202handler_attached:
1203
1204 spin_lock( &nl->lock );
1205 memset( &nl->stats, 0, sizeof(struct net_device_stats) );
1206 memset( &nl->in_stats, 0, sizeof(struct sbni_in_stats) );
1207
1208 card_start( dev );
1209
1210 netif_start_queue( dev );
1211
1212 /* set timer watchdog */
1213 init_timer( w );
1214 w->expires = jiffies + SBNI_TIMEOUT;
1215 w->data = (unsigned long) dev;
1216 w->function = sbni_watchdog;
1217 add_timer( w );
1218
1219 spin_unlock( &nl->lock );
1220 return 0;
1221}
1222
1223
1224static int
1225sbni_close( struct net_device *dev )
1226{
1227 struct net_local *nl = (struct net_local *) dev->priv;
1228
1229 if( nl->second && nl->second->flags & IFF_UP ) {
1230 printk( KERN_NOTICE "Secondary channel (%s) is active!\n",
1231 nl->second->name );
1232 return -EBUSY;
1233 }
1234
1235#ifdef CONFIG_SBNI_MULTILINE
1236 if( nl->state & FL_SLAVE )
1237 emancipate( dev );
1238 else
1239 while( nl->link ) /* it's master device! */
1240 emancipate( nl->link );
1241#endif
1242
1243 spin_lock( &nl->lock );
1244
1245 nl->second = NULL;
1246 drop_xmit_queue( dev );
1247 netif_stop_queue( dev );
1248
1249 del_timer( &nl->watchdog );
1250
1251 outb( 0, dev->base_addr + CSR0 );
1252
1253 if( !(nl->state & FL_SECONDARY) )
1254 free_irq( dev->irq, dev );
1255 nl->state &= FL_SECONDARY;
1256
1257 spin_unlock( &nl->lock );
1258 return 0;
1259}
1260
1261
1262/*
1263 Valid combinations in CSR0 (for probing):
1264
1265 VALID_DECODER 0000,0011,1011,1010
1266
1267 ; 0 ; -
1268 TR_REQ ; 1 ; +
1269 TR_RDY ; 2 ; -
1270 TR_RDY TR_REQ ; 3 ; +
1271 BU_EMP ; 4 ; +
1272 BU_EMP TR_REQ ; 5 ; +
1273 BU_EMP TR_RDY ; 6 ; -
1274 BU_EMP TR_RDY TR_REQ ; 7 ; +
1275 RC_RDY ; 8 ; +
1276 RC_RDY TR_REQ ; 9 ; +
1277 RC_RDY TR_RDY ; 10 ; -
1278 RC_RDY TR_RDY TR_REQ ; 11 ; -
1279 RC_RDY BU_EMP ; 12 ; -
1280 RC_RDY BU_EMP TR_REQ ; 13 ; -
1281 RC_RDY BU_EMP TR_RDY ; 14 ; -
1282 RC_RDY BU_EMP TR_RDY TR_REQ ; 15 ; -
1283*/
1284
1285#define VALID_DECODER (2 + 8 + 0x10 + 0x20 + 0x80 + 0x100 + 0x200)
1286
1287
1288static int
1289sbni_card_probe( unsigned long ioaddr )
1290{
1291 unsigned char csr0;
1292
1293 csr0 = inb( ioaddr + CSR0 );
1294 if( csr0 != 0xff && csr0 != 0x00 ) {
1295 csr0 &= ~EN_INT;
1296 if( csr0 & BU_EMP )
1297 csr0 |= EN_INT;
1298
1299 if( VALID_DECODER & (1 << (csr0 >> 4)) )
1300 return 0;
1301 }
1302
1303 return -ENODEV;
1304}
1305
1306/* -------------------------------------------------------------------------- */
1307
1308static int
1309sbni_ioctl( struct net_device *dev, struct ifreq *ifr, int cmd )
1310{
1311 struct net_local *nl = (struct net_local *) dev->priv;
1312 struct sbni_flags flags;
1313 int error = 0;
1314
1315#ifdef CONFIG_SBNI_MULTILINE
1316 struct net_device *slave_dev;
1317 char slave_name[ 8 ];
1318#endif
1319
1320 switch( cmd ) {
1321 case SIOCDEVGETINSTATS :
1322 if (copy_to_user( ifr->ifr_data, &nl->in_stats,
1323 sizeof(struct sbni_in_stats) ))
1324 error = -EFAULT;
1325 break;
1326
1327 case SIOCDEVRESINSTATS :
1328 if( current->euid != 0 ) /* root only */
1329 return -EPERM;
1330 memset( &nl->in_stats, 0, sizeof(struct sbni_in_stats) );
1331 break;
1332
1333 case SIOCDEVGHWSTATE :
1334 flags.mac_addr = *(u32 *)(dev->dev_addr + 3);
1335 flags.rate = nl->csr1.rate;
1336 flags.slow_mode = (nl->state & FL_SLOW_MODE) != 0;
1337 flags.rxl = nl->cur_rxl_index;
1338 flags.fixed_rxl = nl->delta_rxl == 0;
1339
1340 if (copy_to_user( ifr->ifr_data, &flags, sizeof flags ))
1341 error = -EFAULT;
1342 break;
1343
1344 case SIOCDEVSHWSTATE :
1345 if( current->euid != 0 ) /* root only */
1346 return -EPERM;
1347
1348 spin_lock( &nl->lock );
1349 flags = *(struct sbni_flags*) &ifr->ifr_ifru;
1350 if( flags.fixed_rxl )
1351 nl->delta_rxl = 0,
1352 nl->cur_rxl_index = flags.rxl;
1353 else
1354 nl->delta_rxl = DEF_RXL_DELTA,
1355 nl->cur_rxl_index = DEF_RXL;
1356
1357 nl->csr1.rxl = rxl_tab[ nl->cur_rxl_index ];
1358 nl->csr1.rate = flags.rate;
1359 outb( *(u8 *)&nl->csr1 | PR_RES, dev->base_addr + CSR1 );
1360 spin_unlock( &nl->lock );
1361 break;
1362
1363#ifdef CONFIG_SBNI_MULTILINE
1364
1365 case SIOCDEVENSLAVE :
1366 if( current->euid != 0 ) /* root only */
1367 return -EPERM;
1368
1369 if (copy_from_user( slave_name, ifr->ifr_data, sizeof slave_name ))
1370 return -EFAULT;
1371 slave_dev = dev_get_by_name( slave_name );
1372 if( !slave_dev || !(slave_dev->flags & IFF_UP) ) {
1373 printk( KERN_ERR "%s: trying to enslave non-active "
1374 "device %s\n", dev->name, slave_name );
1375 return -EPERM;
1376 }
1377
1378 return enslave( dev, slave_dev );
1379
1380 case SIOCDEVEMANSIPATE :
1381 if( current->euid != 0 ) /* root only */
1382 return -EPERM;
1383
1384 return emancipate( dev );
1385
1386#endif /* CONFIG_SBNI_MULTILINE */
1387
1388 default :
1389 return -EOPNOTSUPP;
1390 }
1391
1392 return error;
1393}
1394
1395
1396#ifdef CONFIG_SBNI_MULTILINE
1397
1398static int
1399enslave( struct net_device *dev, struct net_device *slave_dev )
1400{
1401 struct net_local *nl = (struct net_local *) dev->priv;
1402 struct net_local *snl = (struct net_local *) slave_dev->priv;
1403
1404 if( nl->state & FL_SLAVE ) /* This isn't master or free device */
1405 return -EBUSY;
1406
1407 if( snl->state & FL_SLAVE ) /* That was already enslaved */
1408 return -EBUSY;
1409
1410 spin_lock( &nl->lock );
1411 spin_lock( &snl->lock );
1412
1413 /* append to list */
1414 snl->link = nl->link;
1415 nl->link = slave_dev;
1416 snl->master = dev;
1417 snl->state |= FL_SLAVE;
1418
1419 /* Summary statistics of MultiLine operation will be stored
1420 in master's counters */
1421 memset( &snl->stats, 0, sizeof(struct net_device_stats) );
1422 netif_stop_queue( slave_dev );
1423 netif_wake_queue( dev ); /* Now we are able to transmit */
1424
1425 spin_unlock( &snl->lock );
1426 spin_unlock( &nl->lock );
1427 printk( KERN_NOTICE "%s: slave device (%s) attached.\n",
1428 dev->name, slave_dev->name );
1429 return 0;
1430}
1431
1432
1433static int
1434emancipate( struct net_device *dev )
1435{
1436 struct net_local *snl = (struct net_local *) dev->priv;
1437 struct net_device *p = snl->master;
1438 struct net_local *nl = (struct net_local *) p->priv;
1439
1440 if( !(snl->state & FL_SLAVE) )
1441 return -EINVAL;
1442
1443 spin_lock( &nl->lock );
1444 spin_lock( &snl->lock );
1445 drop_xmit_queue( dev );
1446
1447 /* exclude from list */
1448 for(;;) { /* must be in list */
1449 struct net_local *t = (struct net_local *) p->priv;
1450 if( t->link == dev ) {
1451 t->link = snl->link;
1452 break;
1453 }
1454 p = t->link;
1455 }
1456
1457 snl->link = NULL;
1458 snl->master = dev;
1459 snl->state &= ~FL_SLAVE;
1460
1461 netif_start_queue( dev );
1462
1463 spin_unlock( &snl->lock );
1464 spin_unlock( &nl->lock );
1465
1466 dev_put( dev );
1467 return 0;
1468}
1469
1470#endif
1471
1472
1473static struct net_device_stats *
1474sbni_get_stats( struct net_device *dev )
1475{
1476 return &((struct net_local *) dev->priv)->stats;
1477}
1478
1479
1480static void
1481set_multicast_list( struct net_device *dev )
1482{
1483 return; /* sbni always operate in promiscuos mode */
1484}
1485
1486
1487#ifdef MODULE
1488module_param_array(io, int, NULL, 0);
1489module_param_array(irq, int, NULL, 0);
1490module_param_array(baud, int, NULL, 0);
1491module_param_array(rxl, int, NULL, 0);
1492module_param_array(mac, int, NULL, 0);
1493module_param(skip_pci_probe, bool, 0);
1494
1495MODULE_LICENSE("GPL");
1496
1497
1498int
1499init_module( void )
1500{
1501 struct net_device *dev;
1502 int err;
1503
1504 while( num < SBNI_MAX_NUM_CARDS ) {
1505 dev = alloc_netdev(sizeof(struct net_local),
1506 "sbni%d", sbni_devsetup);
1507 if( !dev)
1508 break;
1509
1510 sprintf( dev->name, "sbni%d", num );
1511
1512 err = sbni_init(dev);
1513 if (err) {
1514 free_netdev(dev);
1515 break;
1516 }
1517
1518 if( register_netdev( dev ) ) {
1519 release_region( dev->base_addr, SBNI_IO_EXTENT );
1520 free_netdev( dev );
1521 break;
1522 }
1523 }
1524
1525 return *sbni_cards ? 0 : -ENODEV;
1526}
1527
1528void
1529cleanup_module( void )
1530{
1531 struct net_device *dev;
1532 int num;
1533
1534 for( num = 0; num < SBNI_MAX_NUM_CARDS; ++num )
1535 if( (dev = sbni_cards[ num ]) != NULL ) {
1536 unregister_netdev( dev );
1537 release_region( dev->base_addr, SBNI_IO_EXTENT );
1538 free_netdev( dev );
1539 }
1540}
1541
1542#else /* MODULE */
1543
1544static int __init
1545sbni_setup( char *p )
1546{
1547 int n, parm;
1548
1549 if( *p++ != '(' )
1550 goto bad_param;
1551
1552 for( n = 0, parm = 0; *p && n < 8; ) {
1553 (*dest[ parm ])[ n ] = simple_strtol( p, &p, 0 );
1554 if( !*p || *p == ')' )
1555 return 1;
1556 if( *p == ';' )
1557 ++p, ++n, parm = 0;
1558 else if( *p++ != ',' )
1559 break;
1560 else
1561 if( ++parm >= 5 )
1562 break;
1563 }
1564bad_param:
1565 printk( KERN_ERR "Error in sbni kernel parameter!\n" );
1566 return 0;
1567}
1568
1569__setup( "sbni=", sbni_setup );
1570
1571#endif /* MODULE */
1572
1573/* -------------------------------------------------------------------------- */
1574
1575#ifdef ASM_CRC
1576
1577static u32
1578calc_crc32( u32 crc, u8 *p, u32 len )
1579{
1580 register u32 _crc;
1581 _crc = crc;
1582
1583 __asm__ __volatile__ (
1584 "xorl %%ebx, %%ebx\n"
1585 "movl %2, %%esi\n"
1586 "movl %3, %%ecx\n"
1587 "movl $crc32tab, %%edi\n"
1588 "shrl $2, %%ecx\n"
1589 "jz 1f\n"
1590
1591 ".align 4\n"
1592 "0:\n"
1593 "movb %%al, %%bl\n"
1594 "movl (%%esi), %%edx\n"
1595 "shrl $8, %%eax\n"
1596 "xorb %%dl, %%bl\n"
1597 "shrl $8, %%edx\n"
1598 "xorl (%%edi,%%ebx,4), %%eax\n"
1599
1600 "movb %%al, %%bl\n"
1601 "shrl $8, %%eax\n"
1602 "xorb %%dl, %%bl\n"
1603 "shrl $8, %%edx\n"
1604 "xorl (%%edi,%%ebx,4), %%eax\n"
1605
1606 "movb %%al, %%bl\n"
1607 "shrl $8, %%eax\n"
1608 "xorb %%dl, %%bl\n"
1609 "movb %%dh, %%dl\n"
1610 "xorl (%%edi,%%ebx,4), %%eax\n"
1611
1612 "movb %%al, %%bl\n"
1613 "shrl $8, %%eax\n"
1614 "xorb %%dl, %%bl\n"
1615 "addl $4, %%esi\n"
1616 "xorl (%%edi,%%ebx,4), %%eax\n"
1617
1618 "decl %%ecx\n"
1619 "jnz 0b\n"
1620
1621 "1:\n"
1622 "movl %3, %%ecx\n"
1623 "andl $3, %%ecx\n"
1624 "jz 2f\n"
1625
1626 "movb %%al, %%bl\n"
1627 "shrl $8, %%eax\n"
1628 "xorb (%%esi), %%bl\n"
1629 "xorl (%%edi,%%ebx,4), %%eax\n"
1630
1631 "decl %%ecx\n"
1632 "jz 2f\n"
1633
1634 "movb %%al, %%bl\n"
1635 "shrl $8, %%eax\n"
1636 "xorb 1(%%esi), %%bl\n"
1637 "xorl (%%edi,%%ebx,4), %%eax\n"
1638
1639 "decl %%ecx\n"
1640 "jz 2f\n"
1641
1642 "movb %%al, %%bl\n"
1643 "shrl $8, %%eax\n"
1644 "xorb 2(%%esi), %%bl\n"
1645 "xorl (%%edi,%%ebx,4), %%eax\n"
1646 "2:\n"
1647 : "=a" (_crc)
1648 : "0" (_crc), "g" (p), "g" (len)
1649 : "bx", "cx", "dx", "si", "di"
1650 );
1651
1652 return _crc;
1653}
1654
1655#else /* ASM_CRC */
1656
1657static u32
1658calc_crc32( u32 crc, u8 *p, u32 len )
1659{
1660 while( len-- )
1661 crc = CRC32( *p++, crc );
1662
1663 return crc;
1664}
1665
1666#endif /* ASM_CRC */
1667
1668
1669static u32 crc32tab[] __attribute__ ((aligned(8))) = {
1670 0xD202EF8D, 0xA505DF1B, 0x3C0C8EA1, 0x4B0BBE37,
1671 0xD56F2B94, 0xA2681B02, 0x3B614AB8, 0x4C667A2E,
1672 0xDCD967BF, 0xABDE5729, 0x32D70693, 0x45D03605,
1673 0xDBB4A3A6, 0xACB39330, 0x35BAC28A, 0x42BDF21C,
1674 0xCFB5FFE9, 0xB8B2CF7F, 0x21BB9EC5, 0x56BCAE53,
1675 0xC8D83BF0, 0xBFDF0B66, 0x26D65ADC, 0x51D16A4A,
1676 0xC16E77DB, 0xB669474D, 0x2F6016F7, 0x58672661,
1677 0xC603B3C2, 0xB1048354, 0x280DD2EE, 0x5F0AE278,
1678 0xE96CCF45, 0x9E6BFFD3, 0x0762AE69, 0x70659EFF,
1679 0xEE010B5C, 0x99063BCA, 0x000F6A70, 0x77085AE6,
1680 0xE7B74777, 0x90B077E1, 0x09B9265B, 0x7EBE16CD,
1681 0xE0DA836E, 0x97DDB3F8, 0x0ED4E242, 0x79D3D2D4,
1682 0xF4DBDF21, 0x83DCEFB7, 0x1AD5BE0D, 0x6DD28E9B,
1683 0xF3B61B38, 0x84B12BAE, 0x1DB87A14, 0x6ABF4A82,
1684 0xFA005713, 0x8D076785, 0x140E363F, 0x630906A9,
1685 0xFD6D930A, 0x8A6AA39C, 0x1363F226, 0x6464C2B0,
1686 0xA4DEAE1D, 0xD3D99E8B, 0x4AD0CF31, 0x3DD7FFA7,
1687 0xA3B36A04, 0xD4B45A92, 0x4DBD0B28, 0x3ABA3BBE,
1688 0xAA05262F, 0xDD0216B9, 0x440B4703, 0x330C7795,
1689 0xAD68E236, 0xDA6FD2A0, 0x4366831A, 0x3461B38C,
1690 0xB969BE79, 0xCE6E8EEF, 0x5767DF55, 0x2060EFC3,
1691 0xBE047A60, 0xC9034AF6, 0x500A1B4C, 0x270D2BDA,
1692 0xB7B2364B, 0xC0B506DD, 0x59BC5767, 0x2EBB67F1,
1693 0xB0DFF252, 0xC7D8C2C4, 0x5ED1937E, 0x29D6A3E8,
1694 0x9FB08ED5, 0xE8B7BE43, 0x71BEEFF9, 0x06B9DF6F,
1695 0x98DD4ACC, 0xEFDA7A5A, 0x76D32BE0, 0x01D41B76,
1696 0x916B06E7, 0xE66C3671, 0x7F6567CB, 0x0862575D,
1697 0x9606C2FE, 0xE101F268, 0x7808A3D2, 0x0F0F9344,
1698 0x82079EB1, 0xF500AE27, 0x6C09FF9D, 0x1B0ECF0B,
1699 0x856A5AA8, 0xF26D6A3E, 0x6B643B84, 0x1C630B12,
1700 0x8CDC1683, 0xFBDB2615, 0x62D277AF, 0x15D54739,
1701 0x8BB1D29A, 0xFCB6E20C, 0x65BFB3B6, 0x12B88320,
1702 0x3FBA6CAD, 0x48BD5C3B, 0xD1B40D81, 0xA6B33D17,
1703 0x38D7A8B4, 0x4FD09822, 0xD6D9C998, 0xA1DEF90E,
1704 0x3161E49F, 0x4666D409, 0xDF6F85B3, 0xA868B525,
1705 0x360C2086, 0x410B1010, 0xD80241AA, 0xAF05713C,
1706 0x220D7CC9, 0x550A4C5F, 0xCC031DE5, 0xBB042D73,
1707 0x2560B8D0, 0x52678846, 0xCB6ED9FC, 0xBC69E96A,
1708 0x2CD6F4FB, 0x5BD1C46D, 0xC2D895D7, 0xB5DFA541,
1709 0x2BBB30E2, 0x5CBC0074, 0xC5B551CE, 0xB2B26158,
1710 0x04D44C65, 0x73D37CF3, 0xEADA2D49, 0x9DDD1DDF,
1711 0x03B9887C, 0x74BEB8EA, 0xEDB7E950, 0x9AB0D9C6,
1712 0x0A0FC457, 0x7D08F4C1, 0xE401A57B, 0x930695ED,
1713 0x0D62004E, 0x7A6530D8, 0xE36C6162, 0x946B51F4,
1714 0x19635C01, 0x6E646C97, 0xF76D3D2D, 0x806A0DBB,
1715 0x1E0E9818, 0x6909A88E, 0xF000F934, 0x8707C9A2,
1716 0x17B8D433, 0x60BFE4A5, 0xF9B6B51F, 0x8EB18589,
1717 0x10D5102A, 0x67D220BC, 0xFEDB7106, 0x89DC4190,
1718 0x49662D3D, 0x3E611DAB, 0xA7684C11, 0xD06F7C87,
1719 0x4E0BE924, 0x390CD9B2, 0xA0058808, 0xD702B89E,
1720 0x47BDA50F, 0x30BA9599, 0xA9B3C423, 0xDEB4F4B5,
1721 0x40D06116, 0x37D75180, 0xAEDE003A, 0xD9D930AC,
1722 0x54D13D59, 0x23D60DCF, 0xBADF5C75, 0xCDD86CE3,
1723 0x53BCF940, 0x24BBC9D6, 0xBDB2986C, 0xCAB5A8FA,
1724 0x5A0AB56B, 0x2D0D85FD, 0xB404D447, 0xC303E4D1,
1725 0x5D677172, 0x2A6041E4, 0xB369105E, 0xC46E20C8,
1726 0x72080DF5, 0x050F3D63, 0x9C066CD9, 0xEB015C4F,
1727 0x7565C9EC, 0x0262F97A, 0x9B6BA8C0, 0xEC6C9856,
1728 0x7CD385C7, 0x0BD4B551, 0x92DDE4EB, 0xE5DAD47D,
1729 0x7BBE41DE, 0x0CB97148, 0x95B020F2, 0xE2B71064,
1730 0x6FBF1D91, 0x18B82D07, 0x81B17CBD, 0xF6B64C2B,
1731 0x68D2D988, 0x1FD5E91E, 0x86DCB8A4, 0xF1DB8832,
1732 0x616495A3, 0x1663A535, 0x8F6AF48F, 0xF86DC419,
1733 0x660951BA, 0x110E612C, 0x88073096, 0xFF000000
1734};
1735