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
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68#define VERSION "2.07"
69
70static const char *boot_msg =
71 "SysKonnect FDDI PCI Adapter driver v" VERSION " for\n"
72 " SK-55xx/SK-58xx adapters (SK-NET FDDI-FP/UP/LP)";
73
74
75
76#include <linux/module.h>
77#include <linux/kernel.h>
78#include <linux/errno.h>
79#include <linux/ioport.h>
80#include <linux/slab.h>
81#include <linux/interrupt.h>
82#include <linux/pci.h>
83#include <linux/netdevice.h>
84#include <linux/fddidevice.h>
85#include <linux/skbuff.h>
86#include <linux/bitops.h>
87
88#include <asm/byteorder.h>
89#include <asm/io.h>
90#include <asm/uaccess.h>
91
92#include "h/types.h"
93#undef ADDR
94#include "h/skfbi.h"
95#include "h/fddi.h"
96#include "h/smc.h"
97#include "h/smtstate.h"
98
99
100
101static int skfp_driver_init(struct net_device *dev);
102static int skfp_open(struct net_device *dev);
103static int skfp_close(struct net_device *dev);
104static irqreturn_t skfp_interrupt(int irq, void *dev_id, struct pt_regs *regs);
105static struct net_device_stats *skfp_ctl_get_stats(struct net_device *dev);
106static void skfp_ctl_set_multicast_list(struct net_device *dev);
107static void skfp_ctl_set_multicast_list_wo_lock(struct net_device *dev);
108static int skfp_ctl_set_mac_address(struct net_device *dev, void *addr);
109static int skfp_ioctl(struct net_device *dev, struct ifreq *rq, int cmd);
110static int skfp_send_pkt(struct sk_buff *skb, struct net_device *dev);
111static void send_queued_packets(struct s_smc *smc);
112static void CheckSourceAddress(unsigned char *frame, unsigned char *hw_addr);
113static void ResetAdapter(struct s_smc *smc);
114
115
116
117void *mac_drv_get_space(struct s_smc *smc, u_int size);
118void *mac_drv_get_desc_mem(struct s_smc *smc, u_int size);
119unsigned long mac_drv_virt2phys(struct s_smc *smc, void *virt);
120unsigned long dma_master(struct s_smc *smc, void *virt, int len, int flag);
121void dma_complete(struct s_smc *smc, volatile union s_fp_descr *descr,
122 int flag);
123void mac_drv_tx_complete(struct s_smc *smc, volatile struct s_smt_fp_txd *txd);
124void llc_restart_tx(struct s_smc *smc);
125void mac_drv_rx_complete(struct s_smc *smc, volatile struct s_smt_fp_rxd *rxd,
126 int frag_count, int len);
127void mac_drv_requeue_rxd(struct s_smc *smc, volatile struct s_smt_fp_rxd *rxd,
128 int frag_count);
129void mac_drv_fill_rxd(struct s_smc *smc);
130void mac_drv_clear_rxd(struct s_smc *smc, volatile struct s_smt_fp_rxd *rxd,
131 int frag_count);
132int mac_drv_rx_init(struct s_smc *smc, int len, int fc, char *look_ahead,
133 int la_len);
134void dump_data(unsigned char *Data, int length);
135
136
137extern u_int mac_drv_check_space(void);
138extern void read_address(struct s_smc *smc, u_char * mac_addr);
139extern void card_stop(struct s_smc *smc);
140extern int mac_drv_init(struct s_smc *smc);
141extern void hwm_tx_frag(struct s_smc *smc, char far * virt, u_long phys,
142 int len, int frame_status);
143extern int hwm_tx_init(struct s_smc *smc, u_char fc, int frag_count,
144 int frame_len, int frame_status);
145extern int init_smt(struct s_smc *smc, u_char * mac_addr);
146extern void fddi_isr(struct s_smc *smc);
147extern void hwm_rx_frag(struct s_smc *smc, char far * virt, u_long phys,
148 int len, int frame_status);
149extern void mac_drv_rx_mode(struct s_smc *smc, int mode);
150extern void mac_drv_clear_rx_queue(struct s_smc *smc);
151extern void enable_tx_irq(struct s_smc *smc, u_short queue);
152extern void mac_drv_clear_txd(struct s_smc *smc);
153
154static struct pci_device_id skfddi_pci_tbl[] = {
155 { PCI_VENDOR_ID_SK, PCI_DEVICE_ID_SK_FP, PCI_ANY_ID, PCI_ANY_ID, },
156 { }
157};
158MODULE_DEVICE_TABLE(pci, skfddi_pci_tbl);
159MODULE_LICENSE("GPL");
160MODULE_AUTHOR("Mirko Lindner <mlindner@syskonnect.de>");
161
162
163
164static int num_boards;
165
166#ifdef DRIVERDEBUG
167#define PRINTK(s, args...) printk(s, ## args)
168#else
169#define PRINTK(s, args...)
170#endif
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201static int skfp_init_one(struct pci_dev *pdev,
202 const struct pci_device_id *ent)
203{
204 struct net_device *dev;
205 struct s_smc *smc;
206 void __iomem *mem;
207 int err;
208
209 PRINTK(KERN_INFO "entering skfp_init_one\n");
210
211 if (num_boards == 0)
212 printk("%s\n", boot_msg);
213
214 err = pci_enable_device(pdev);
215 if (err)
216 return err;
217
218 err = pci_request_regions(pdev, "skfddi");
219 if (err)
220 goto err_out1;
221
222 pci_set_master(pdev);
223
224#ifdef MEM_MAPPED_IO
225 if (!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM)) {
226 printk(KERN_ERR "skfp: region is not an MMIO resource\n");
227 err = -EIO;
228 goto err_out2;
229 }
230
231 mem = ioremap(pci_resource_start(pdev, 0), 0x4000);
232#else
233 if (!(pci_resource_flags(pdev, 1) & IO_RESOURCE_IO)) {
234 printk(KERN_ERR "skfp: region is not PIO resource\n");
235 err = -EIO;
236 goto err_out2;
237 }
238
239 mem = ioport_map(pci_resource_start(pdev, 1), FP_IO_LEN);
240#endif
241 if (!mem) {
242 printk(KERN_ERR "skfp: Unable to map register, "
243 "FDDI adapter will be disabled.\n");
244 err = -EIO;
245 goto err_out2;
246 }
247
248 dev = alloc_fddidev(sizeof(struct s_smc));
249 if (!dev) {
250 printk(KERN_ERR "skfp: Unable to allocate fddi device, "
251 "FDDI adapter will be disabled.\n");
252 err = -ENOMEM;
253 goto err_out3;
254 }
255
256 dev->irq = pdev->irq;
257 dev->get_stats = &skfp_ctl_get_stats;
258 dev->open = &skfp_open;
259 dev->stop = &skfp_close;
260 dev->hard_start_xmit = &skfp_send_pkt;
261 dev->set_multicast_list = &skfp_ctl_set_multicast_list;
262 dev->set_mac_address = &skfp_ctl_set_mac_address;
263 dev->do_ioctl = &skfp_ioctl;
264 dev->header_cache_update = NULL;
265
266 SET_MODULE_OWNER(dev);
267 SET_NETDEV_DEV(dev, &pdev->dev);
268
269
270 smc = netdev_priv(dev);
271 smc->os.dev = dev;
272 smc->os.bus_type = SK_BUS_TYPE_PCI;
273 smc->os.pdev = *pdev;
274 smc->os.QueueSkb = MAX_TX_QUEUE_LEN;
275 smc->os.MaxFrameSize = MAX_FRAME_SIZE;
276 smc->os.dev = dev;
277 smc->hw.slot = -1;
278 smc->hw.iop = mem;
279 smc->os.ResetRequested = FALSE;
280 skb_queue_head_init(&smc->os.SendSkbQueue);
281
282 dev->base_addr = (unsigned long)mem;
283
284 err = skfp_driver_init(dev);
285 if (err)
286 goto err_out4;
287
288 err = register_netdev(dev);
289 if (err)
290 goto err_out5;
291
292 ++num_boards;
293 pci_set_drvdata(pdev, dev);
294
295 if ((pdev->subsystem_device & 0xff00) == 0x5500 ||
296 (pdev->subsystem_device & 0xff00) == 0x5800)
297 printk("%s: SysKonnect FDDI PCI adapter"
298 " found (SK-%04X)\n", dev->name,
299 pdev->subsystem_device);
300 else
301 printk("%s: FDDI PCI adapter found\n", dev->name);
302
303 return 0;
304err_out5:
305 if (smc->os.SharedMemAddr)
306 pci_free_consistent(pdev, smc->os.SharedMemSize,
307 smc->os.SharedMemAddr,
308 smc->os.SharedMemDMA);
309 pci_free_consistent(pdev, MAX_FRAME_SIZE,
310 smc->os.LocalRxBuffer, smc->os.LocalRxBufferDMA);
311err_out4:
312 free_netdev(dev);
313err_out3:
314#ifdef MEM_MAPPED_IO
315 iounmap(mem);
316#else
317 ioport_unmap(mem);
318#endif
319err_out2:
320 pci_release_regions(pdev);
321err_out1:
322 pci_disable_device(pdev);
323 return err;
324}
325
326
327
328
329static void __devexit skfp_remove_one(struct pci_dev *pdev)
330{
331 struct net_device *p = pci_get_drvdata(pdev);
332 struct s_smc *lp = netdev_priv(p);
333
334 unregister_netdev(p);
335
336 if (lp->os.SharedMemAddr) {
337 pci_free_consistent(&lp->os.pdev,
338 lp->os.SharedMemSize,
339 lp->os.SharedMemAddr,
340 lp->os.SharedMemDMA);
341 lp->os.SharedMemAddr = NULL;
342 }
343 if (lp->os.LocalRxBuffer) {
344 pci_free_consistent(&lp->os.pdev,
345 MAX_FRAME_SIZE,
346 lp->os.LocalRxBuffer,
347 lp->os.LocalRxBufferDMA);
348 lp->os.LocalRxBuffer = NULL;
349 }
350#ifdef MEM_MAPPED_IO
351 iounmap(lp->hw.iop);
352#else
353 ioport_unmap(lp->hw.iop);
354#endif
355 pci_release_regions(pdev);
356 free_netdev(p);
357
358 pci_disable_device(pdev);
359 pci_set_drvdata(pdev, NULL);
360}
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387static int skfp_driver_init(struct net_device *dev)
388{
389 struct s_smc *smc = netdev_priv(dev);
390 skfddi_priv *bp = &smc->os;
391 int err = -EIO;
392
393 PRINTK(KERN_INFO "entering skfp_driver_init\n");
394
395
396 bp->base_addr = dev->base_addr;
397
398
399 smc->hw.irq = dev->irq;
400
401 spin_lock_init(&bp->DriverLock);
402
403
404 bp->LocalRxBuffer = pci_alloc_consistent(&bp->pdev, MAX_FRAME_SIZE, &bp->LocalRxBufferDMA);
405 if (!bp->LocalRxBuffer) {
406 printk("could not allocate mem for ");
407 printk("LocalRxBuffer: %d byte\n", MAX_FRAME_SIZE);
408 goto fail;
409 }
410
411
412 bp->SharedMemSize = mac_drv_check_space();
413 PRINTK(KERN_INFO "Memory for HWM: %ld\n", bp->SharedMemSize);
414 if (bp->SharedMemSize > 0) {
415 bp->SharedMemSize += 16;
416
417 bp->SharedMemAddr = pci_alloc_consistent(&bp->pdev,
418 bp->SharedMemSize,
419 &bp->SharedMemDMA);
420 if (!bp->SharedMemSize) {
421 printk("could not allocate mem for ");
422 printk("hardware module: %ld byte\n",
423 bp->SharedMemSize);
424 goto fail;
425 }
426 bp->SharedMemHeap = 0;
427
428 } else {
429 bp->SharedMemAddr = NULL;
430 bp->SharedMemHeap = 0;
431 }
432
433 memset(bp->SharedMemAddr, 0, bp->SharedMemSize);
434
435 card_stop(smc);
436
437 PRINTK(KERN_INFO "mac_drv_init()..\n");
438 if (mac_drv_init(smc) != 0) {
439 PRINTK(KERN_INFO "mac_drv_init() failed.\n");
440 goto fail;
441 }
442 read_address(smc, NULL);
443 PRINTK(KERN_INFO "HW-Addr: %02x %02x %02x %02x %02x %02x\n",
444 smc->hw.fddi_canon_addr.a[0],
445 smc->hw.fddi_canon_addr.a[1],
446 smc->hw.fddi_canon_addr.a[2],
447 smc->hw.fddi_canon_addr.a[3],
448 smc->hw.fddi_canon_addr.a[4],
449 smc->hw.fddi_canon_addr.a[5]);
450 memcpy(dev->dev_addr, smc->hw.fddi_canon_addr.a, 6);
451
452 smt_reset_defaults(smc, 0);
453
454 return (0);
455
456fail:
457 if (bp->SharedMemAddr) {
458 pci_free_consistent(&bp->pdev,
459 bp->SharedMemSize,
460 bp->SharedMemAddr,
461 bp->SharedMemDMA);
462 bp->SharedMemAddr = NULL;
463 }
464 if (bp->LocalRxBuffer) {
465 pci_free_consistent(&bp->pdev, MAX_FRAME_SIZE,
466 bp->LocalRxBuffer, bp->LocalRxBufferDMA);
467 bp->LocalRxBuffer = NULL;
468 }
469 return err;
470}
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
491
492
493
494static int skfp_open(struct net_device *dev)
495{
496 struct s_smc *smc = netdev_priv(dev);
497 int err;
498
499 PRINTK(KERN_INFO "entering skfp_open\n");
500
501 err = request_irq(dev->irq, (void *) skfp_interrupt, SA_SHIRQ,
502 dev->name, dev);
503 if (err)
504 return err;
505
506
507
508
509
510
511
512
513
514
515
516 read_address(smc, NULL);
517 memcpy(dev->dev_addr, smc->hw.fddi_canon_addr.a, 6);
518
519 init_smt(smc, NULL);
520 smt_online(smc, 1);
521 STI_FBI();
522
523
524 mac_clear_multicast(smc);
525
526
527 mac_drv_rx_mode(smc, RX_DISABLE_PROMISC);
528
529 netif_start_queue(dev);
530 return (0);
531}
532
533
534
535
536
537
538
539
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
561static int skfp_close(struct net_device *dev)
562{
563 struct s_smc *smc = netdev_priv(dev);
564 skfddi_priv *bp = &smc->os;
565
566 CLI_FBI();
567 smt_reset_defaults(smc, 1);
568 card_stop(smc);
569 mac_drv_clear_tx_queue(smc);
570 mac_drv_clear_rx_queue(smc);
571
572 netif_stop_queue(dev);
573
574 free_irq(dev->irq, dev);
575
576 skb_queue_purge(&bp->SendSkbQueue);
577 bp->QueueSkb = MAX_TX_QUEUE_LEN;
578
579 return (0);
580}
581
582
583
584
585
586
587
588
589
590
591
592
593
594
595
596
597
598
599
600
601
602
603
604
605
606
607
608
609
610
611
612
613
614
615
616
617
618
619irqreturn_t skfp_interrupt(int irq, void *dev_id, struct pt_regs *regs)
620{
621 struct net_device *dev = (struct net_device *) dev_id;
622 struct s_smc *smc;
623 skfddi_priv *bp;
624
625 if (dev == NULL) {
626 printk("%s: irq %d for unknown device\n", dev->name, irq);
627 return IRQ_NONE;
628 }
629
630 smc = netdev_priv(dev);
631 bp = &smc->os;
632
633
634 if (inpd(ADDR(B0_IMSK)) == 0) {
635
636 return IRQ_NONE;
637 }
638
639 if ((inpd(ISR_A) & smc->hw.is_imask) == 0) {
640
641 return IRQ_NONE;
642 }
643 CLI_FBI();
644 spin_lock(&bp->DriverLock);
645
646
647 fddi_isr(smc);
648
649 if (smc->os.ResetRequested) {
650 ResetAdapter(smc);
651 smc->os.ResetRequested = FALSE;
652 }
653 spin_unlock(&bp->DriverLock);
654 STI_FBI();
655
656 return IRQ_HANDLED;
657}
658
659
660
661
662
663
664
665
666
667
668
669
670
671
672
673
674
675
676
677
678
679
680
681
682
683
684
685
686
687
688
689
690
691struct net_device_stats *skfp_ctl_get_stats(struct net_device *dev)
692{
693 struct s_smc *bp = netdev_priv(dev);
694
695
696
697 bp->os.MacStat.port_bs_flag[0] = 0x1234;
698 bp->os.MacStat.port_bs_flag[1] = 0x5678;
699
700#if 0
701
702
703
704
705 memcpy(bp->stats.smt_station_id, &bp->cmd_rsp_virt->smt_mib_get.smt_station_id, sizeof(bp->cmd_rsp_virt->smt_mib_get.smt_station_id));
706 bp->stats.smt_op_version_id = bp->cmd_rsp_virt->smt_mib_get.smt_op_version_id;
707 bp->stats.smt_hi_version_id = bp->cmd_rsp_virt->smt_mib_get.smt_hi_version_id;
708 bp->stats.smt_lo_version_id = bp->cmd_rsp_virt->smt_mib_get.smt_lo_version_id;
709 memcpy(bp->stats.smt_user_data, &bp->cmd_rsp_virt->smt_mib_get.smt_user_data, sizeof(bp->cmd_rsp_virt->smt_mib_get.smt_user_data));
710 bp->stats.smt_mib_version_id = bp->cmd_rsp_virt->smt_mib_get.smt_mib_version_id;
711 bp->stats.smt_mac_cts = bp->cmd_rsp_virt->smt_mib_get.smt_mac_ct;
712 bp->stats.smt_non_master_cts = bp->cmd_rsp_virt->smt_mib_get.smt_non_master_ct;
713 bp->stats.smt_master_cts = bp->cmd_rsp_virt->smt_mib_get.smt_master_ct;
714 bp->stats.smt_available_paths = bp->cmd_rsp_virt->smt_mib_get.smt_available_paths;
715 bp->stats.smt_config_capabilities = bp->cmd_rsp_virt->smt_mib_get.smt_config_capabilities;
716 bp->stats.smt_config_policy = bp->cmd_rsp_virt->smt_mib_get.smt_config_policy;
717 bp->stats.smt_connection_policy = bp->cmd_rsp_virt->smt_mib_get.smt_connection_policy;
718 bp->stats.smt_t_notify = bp->cmd_rsp_virt->smt_mib_get.smt_t_notify;
719 bp->stats.smt_stat_rpt_policy = bp->cmd_rsp_virt->smt_mib_get.smt_stat_rpt_policy;
720 bp->stats.smt_trace_max_expiration = bp->cmd_rsp_virt->smt_mib_get.smt_trace_max_expiration;
721 bp->stats.smt_bypass_present = bp->cmd_rsp_virt->smt_mib_get.smt_bypass_present;
722 bp->stats.smt_ecm_state = bp->cmd_rsp_virt->smt_mib_get.smt_ecm_state;
723 bp->stats.smt_cf_state = bp->cmd_rsp_virt->smt_mib_get.smt_cf_state;
724 bp->stats.smt_remote_disconnect_flag = bp->cmd_rsp_virt->smt_mib_get.smt_remote_disconnect_flag;
725 bp->stats.smt_station_status = bp->cmd_rsp_virt->smt_mib_get.smt_station_status;
726 bp->stats.smt_peer_wrap_flag = bp->cmd_rsp_virt->smt_mib_get.smt_peer_wrap_flag;
727 bp->stats.smt_time_stamp = bp->cmd_rsp_virt->smt_mib_get.smt_msg_time_stamp.ls;
728 bp->stats.smt_transition_time_stamp = bp->cmd_rsp_virt->smt_mib_get.smt_transition_time_stamp.ls;
729 bp->stats.mac_frame_status_functions = bp->cmd_rsp_virt->smt_mib_get.mac_frame_status_functions;
730 bp->stats.mac_t_max_capability = bp->cmd_rsp_virt->smt_mib_get.mac_t_max_capability;
731 bp->stats.mac_tvx_capability = bp->cmd_rsp_virt->smt_mib_get.mac_tvx_capability;
732 bp->stats.mac_available_paths = bp->cmd_rsp_virt->smt_mib_get.mac_available_paths;
733 bp->stats.mac_current_path = bp->cmd_rsp_virt->smt_mib_get.mac_current_path;
734 memcpy(bp->stats.mac_upstream_nbr, &bp->cmd_rsp_virt->smt_mib_get.mac_upstream_nbr, FDDI_K_ALEN);
735 memcpy(bp->stats.mac_downstream_nbr, &bp->cmd_rsp_virt->smt_mib_get.mac_downstream_nbr, FDDI_K_ALEN);
736 memcpy(bp->stats.mac_old_upstream_nbr, &bp->cmd_rsp_virt->smt_mib_get.mac_old_upstream_nbr, FDDI_K_ALEN);
737 memcpy(bp->stats.mac_old_downstream_nbr, &bp->cmd_rsp_virt->smt_mib_get.mac_old_downstream_nbr, FDDI_K_ALEN);
738 bp->stats.mac_dup_address_test = bp->cmd_rsp_virt->smt_mib_get.mac_dup_address_test;
739 bp->stats.mac_requested_paths = bp->cmd_rsp_virt->smt_mib_get.mac_requested_paths;
740 bp->stats.mac_downstream_port_type = bp->cmd_rsp_virt->smt_mib_get.mac_downstream_port_type;
741 memcpy(bp->stats.mac_smt_address, &bp->cmd_rsp_virt->smt_mib_get.mac_smt_address, FDDI_K_ALEN);
742 bp->stats.mac_t_req = bp->cmd_rsp_virt->smt_mib_get.mac_t_req;
743 bp->stats.mac_t_neg = bp->cmd_rsp_virt->smt_mib_get.mac_t_neg;
744 bp->stats.mac_t_max = bp->cmd_rsp_virt->smt_mib_get.mac_t_max;
745 bp->stats.mac_tvx_value = bp->cmd_rsp_virt->smt_mib_get.mac_tvx_value;
746 bp->stats.mac_frame_error_threshold = bp->cmd_rsp_virt->smt_mib_get.mac_frame_error_threshold;
747 bp->stats.mac_frame_error_ratio = bp->cmd_rsp_virt->smt_mib_get.mac_frame_error_ratio;
748 bp->stats.mac_rmt_state = bp->cmd_rsp_virt->smt_mib_get.mac_rmt_state;
749 bp->stats.mac_da_flag = bp->cmd_rsp_virt->smt_mib_get.mac_da_flag;
750 bp->stats.mac_una_da_flag = bp->cmd_rsp_virt->smt_mib_get.mac_unda_flag;
751 bp->stats.mac_frame_error_flag = bp->cmd_rsp_virt->smt_mib_get.mac_frame_error_flag;
752 bp->stats.mac_ma_unitdata_available = bp->cmd_rsp_virt->smt_mib_get.mac_ma_unitdata_available;
753 bp->stats.mac_hardware_present = bp->cmd_rsp_virt->smt_mib_get.mac_hardware_present;
754 bp->stats.mac_ma_unitdata_enable = bp->cmd_rsp_virt->smt_mib_get.mac_ma_unitdata_enable;
755 bp->stats.path_tvx_lower_bound = bp->cmd_rsp_virt->smt_mib_get.path_tvx_lower_bound;
756 bp->stats.path_t_max_lower_bound = bp->cmd_rsp_virt->smt_mib_get.path_t_max_lower_bound;
757 bp->stats.path_max_t_req = bp->cmd_rsp_virt->smt_mib_get.path_max_t_req;
758 memcpy(bp->stats.path_configuration, &bp->cmd_rsp_virt->smt_mib_get.path_configuration, sizeof(bp->cmd_rsp_virt->smt_mib_get.path_configuration));
759 bp->stats.port_my_type[0] = bp->cmd_rsp_virt->smt_mib_get.port_my_type[0];
760 bp->stats.port_my_type[1] = bp->cmd_rsp_virt->smt_mib_get.port_my_type[1];
761 bp->stats.port_neighbor_type[0] = bp->cmd_rsp_virt->smt_mib_get.port_neighbor_type[0];
762 bp->stats.port_neighbor_type[1] = bp->cmd_rsp_virt->smt_mib_get.port_neighbor_type[1];
763 bp->stats.port_connection_policies[0] = bp->cmd_rsp_virt->smt_mib_get.port_connection_policies[0];
764 bp->stats.port_connection_policies[1] = bp->cmd_rsp_virt->smt_mib_get.port_connection_policies[1];
765 bp->stats.port_mac_indicated[0] = bp->cmd_rsp_virt->smt_mib_get.port_mac_indicated[0];
766 bp->stats.port_mac_indicated[1] = bp->cmd_rsp_virt->smt_mib_get.port_mac_indicated[1];
767 bp->stats.port_current_path[0] = bp->cmd_rsp_virt->smt_mib_get.port_current_path[0];
768 bp->stats.port_current_path[1] = bp->cmd_rsp_virt->smt_mib_get.port_current_path[1];
769 memcpy(&bp->stats.port_requested_paths[0 * 3], &bp->cmd_rsp_virt->smt_mib_get.port_requested_paths[0], 3);
770 memcpy(&bp->stats.port_requested_paths[1 * 3], &bp->cmd_rsp_virt->smt_mib_get.port_requested_paths[1], 3);
771 bp->stats.port_mac_placement[0] = bp->cmd_rsp_virt->smt_mib_get.port_mac_placement[0];
772 bp->stats.port_mac_placement[1] = bp->cmd_rsp_virt->smt_mib_get.port_mac_placement[1];
773 bp->stats.port_available_paths[0] = bp->cmd_rsp_virt->smt_mib_get.port_available_paths[0];
774 bp->stats.port_available_paths[1] = bp->cmd_rsp_virt->smt_mib_get.port_available_paths[1];
775 bp->stats.port_pmd_class[0] = bp->cmd_rsp_virt->smt_mib_get.port_pmd_class[0];
776 bp->stats.port_pmd_class[1] = bp->cmd_rsp_virt->smt_mib_get.port_pmd_class[1];
777 bp->stats.port_connection_capabilities[0] = bp->cmd_rsp_virt->smt_mib_get.port_connection_capabilities[0];
778 bp->stats.port_connection_capabilities[1] = bp->cmd_rsp_virt->smt_mib_get.port_connection_capabilities[1];
779 bp->stats.port_bs_flag[0] = bp->cmd_rsp_virt->smt_mib_get.port_bs_flag[0];
780 bp->stats.port_bs_flag[1] = bp->cmd_rsp_virt->smt_mib_get.port_bs_flag[1];
781 bp->stats.port_ler_estimate[0] = bp->cmd_rsp_virt->smt_mib_get.port_ler_estimate[0];
782 bp->stats.port_ler_estimate[1] = bp->cmd_rsp_virt->smt_mib_get.port_ler_estimate[1];
783 bp->stats.port_ler_cutoff[0] = bp->cmd_rsp_virt->smt_mib_get.port_ler_cutoff[0];
784 bp->stats.port_ler_cutoff[1] = bp->cmd_rsp_virt->smt_mib_get.port_ler_cutoff[1];
785 bp->stats.port_ler_alarm[0] = bp->cmd_rsp_virt->smt_mib_get.port_ler_alarm[0];
786 bp->stats.port_ler_alarm[1] = bp->cmd_rsp_virt->smt_mib_get.port_ler_alarm[1];
787 bp->stats.port_connect_state[0] = bp->cmd_rsp_virt->smt_mib_get.port_connect_state[0];
788 bp->stats.port_connect_state[1] = bp->cmd_rsp_virt->smt_mib_get.port_connect_state[1];
789 bp->stats.port_pcm_state[0] = bp->cmd_rsp_virt->smt_mib_get.port_pcm_state[0];
790 bp->stats.port_pcm_state[1] = bp->cmd_rsp_virt->smt_mib_get.port_pcm_state[1];
791 bp->stats.port_pc_withhold[0] = bp->cmd_rsp_virt->smt_mib_get.port_pc_withhold[0];
792 bp->stats.port_pc_withhold[1] = bp->cmd_rsp_virt->smt_mib_get.port_pc_withhold[1];
793 bp->stats.port_ler_flag[0] = bp->cmd_rsp_virt->smt_mib_get.port_ler_flag[0];
794 bp->stats.port_ler_flag[1] = bp->cmd_rsp_virt->smt_mib_get.port_ler_flag[1];
795 bp->stats.port_hardware_present[0] = bp->cmd_rsp_virt->smt_mib_get.port_hardware_present[0];
796 bp->stats.port_hardware_present[1] = bp->cmd_rsp_virt->smt_mib_get.port_hardware_present[1];
797
798
799
800
801 bp->stats.mac_frame_cts = bp->cmd_rsp_virt->cntrs_get.cntrs.frame_cnt.ls;
802 bp->stats.mac_copied_cts = bp->cmd_rsp_virt->cntrs_get.cntrs.copied_cnt.ls;
803 bp->stats.mac_transmit_cts = bp->cmd_rsp_virt->cntrs_get.cntrs.transmit_cnt.ls;
804 bp->stats.mac_error_cts = bp->cmd_rsp_virt->cntrs_get.cntrs.error_cnt.ls;
805 bp->stats.mac_lost_cts = bp->cmd_rsp_virt->cntrs_get.cntrs.lost_cnt.ls;
806 bp->stats.port_lct_fail_cts[0] = bp->cmd_rsp_virt->cntrs_get.cntrs.lct_rejects[0].ls;
807 bp->stats.port_lct_fail_cts[1] = bp->cmd_rsp_virt->cntrs_get.cntrs.lct_rejects[1].ls;
808 bp->stats.port_lem_reject_cts[0] = bp->cmd_rsp_virt->cntrs_get.cntrs.lem_rejects[0].ls;
809 bp->stats.port_lem_reject_cts[1] = bp->cmd_rsp_virt->cntrs_get.cntrs.lem_rejects[1].ls;
810 bp->stats.port_lem_cts[0] = bp->cmd_rsp_virt->cntrs_get.cntrs.link_errors[0].ls;
811 bp->stats.port_lem_cts[1] = bp->cmd_rsp_virt->cntrs_get.cntrs.link_errors[1].ls;
812
813#endif
814 return ((struct net_device_stats *) &bp->os.MacStat);
815}
816
817
818
819
820
821
822
823
824
825
826
827
828
829
830
831
832
833
834
835
836
837
838
839
840
841
842
843
844
845
846
847
848
849
850
851
852
853
854
855static void skfp_ctl_set_multicast_list(struct net_device *dev)
856{
857 struct s_smc *smc = netdev_priv(dev);
858 skfddi_priv *bp = &smc->os;
859 unsigned long Flags;
860
861 spin_lock_irqsave(&bp->DriverLock, Flags);
862 skfp_ctl_set_multicast_list_wo_lock(dev);
863 spin_unlock_irqrestore(&bp->DriverLock, Flags);
864 return;
865}
866
867
868
869static void skfp_ctl_set_multicast_list_wo_lock(struct net_device *dev)
870{
871 struct s_smc *smc = netdev_priv(dev);
872 struct dev_mc_list *dmi;
873 int i;
874
875
876 if (dev->flags & IFF_PROMISC) {
877 mac_drv_rx_mode(smc, RX_ENABLE_PROMISC);
878 PRINTK(KERN_INFO "PROMISCUOUS MODE ENABLED\n");
879 }
880
881 else {
882 mac_drv_rx_mode(smc, RX_DISABLE_PROMISC);
883 PRINTK(KERN_INFO "PROMISCUOUS MODE DISABLED\n");
884
885
886 mac_clear_multicast(smc);
887 mac_drv_rx_mode(smc, RX_DISABLE_ALLMULTI);
888
889 if (dev->flags & IFF_ALLMULTI) {
890 mac_drv_rx_mode(smc, RX_ENABLE_ALLMULTI);
891 PRINTK(KERN_INFO "ENABLE ALL MC ADDRESSES\n");
892 } else if (dev->mc_count > 0) {
893 if (dev->mc_count <= FPMAX_MULTICAST) {
894
895
896
897 dmi = dev->mc_list;
898
899 for (i = 0; i < dev->mc_count; i++) {
900 mac_add_multicast(smc,
901 (struct fddi_addr *)dmi->dmi_addr,
902 1);
903
904 PRINTK(KERN_INFO "ENABLE MC ADDRESS:");
905 PRINTK(" %02x %02x %02x ",
906 dmi->dmi_addr[0],
907 dmi->dmi_addr[1],
908 dmi->dmi_addr[2]);
909 PRINTK("%02x %02x %02x\n",
910 dmi->dmi_addr[3],
911 dmi->dmi_addr[4],
912 dmi->dmi_addr[5]);
913 dmi = dmi->next;
914 }
915
916 } else {
917
918 mac_drv_rx_mode(smc, RX_ENABLE_ALLMULTI);
919 PRINTK(KERN_INFO "ENABLE ALL MC ADDRESSES\n");
920 }
921 } else {
922
923 PRINTK(KERN_INFO "DISABLE ALL MC ADDRESSES\n");
924 }
925
926
927 mac_update_multicast(smc);
928 }
929 return;
930}
931
932
933
934
935
936
937
938
939
940
941
942
943
944
945
946
947
948
949
950
951
952static int skfp_ctl_set_mac_address(struct net_device *dev, void *addr)
953{
954 struct s_smc *smc = netdev_priv(dev);
955 struct sockaddr *p_sockaddr = (struct sockaddr *) addr;
956 skfddi_priv *bp = &smc->os;
957 unsigned long Flags;
958
959
960 memcpy(dev->dev_addr, p_sockaddr->sa_data, FDDI_K_ALEN);
961 spin_lock_irqsave(&bp->DriverLock, Flags);
962 ResetAdapter(smc);
963 spin_unlock_irqrestore(&bp->DriverLock, Flags);
964
965 return (0);
966}
967
968
969
970
971
972
973
974
975
976
977
978
979
980
981
982
983
984
985
986
987
988
989
990
991
992static int skfp_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
993{
994 struct s_smc *smc = netdev_priv(dev);
995 skfddi_priv *lp = &smc->os;
996 struct s_skfp_ioctl ioc;
997 int status = 0;
998
999 if (copy_from_user(&ioc, rq->ifr_data, sizeof(struct s_skfp_ioctl)))
1000 return -EFAULT;
1001
1002 switch (ioc.cmd) {
1003 case SKFP_GET_STATS:
1004 ioc.len = sizeof(lp->MacStat);
1005 status = copy_to_user(ioc.data, skfp_ctl_get_stats(dev), ioc.len)
1006 ? -EFAULT : 0;
1007 break;
1008 case SKFP_CLR_STATS:
1009 if (!capable(CAP_NET_ADMIN)) {
1010 memset(&lp->MacStat, 0, sizeof(lp->MacStat));
1011 } else {
1012 status = -EPERM;
1013 }
1014 break;
1015 default:
1016 printk("ioctl for %s: unknow cmd: %04x\n", dev->name, ioc.cmd);
1017 status = -EOPNOTSUPP;
1018
1019 }
1020
1021 return status;
1022}
1023
1024
1025
1026
1027
1028
1029
1030
1031
1032
1033
1034
1035
1036
1037
1038
1039
1040
1041
1042
1043
1044
1045
1046
1047
1048
1049
1050
1051
1052
1053
1054
1055
1056
1057
1058
1059
1060
1061
1062
1063
1064
1065
1066
1067
1068
1069
1070
1071
1072static int skfp_send_pkt(struct sk_buff *skb, struct net_device *dev)
1073{
1074 struct s_smc *smc = netdev_priv(dev);
1075 skfddi_priv *bp = &smc->os;
1076
1077 PRINTK(KERN_INFO "skfp_send_pkt\n");
1078
1079
1080
1081
1082
1083
1084
1085
1086
1087
1088 if (!(skb->len >= FDDI_K_LLC_ZLEN && skb->len <= FDDI_K_LLC_LEN)) {
1089 bp->MacStat.gen.tx_errors++;
1090
1091 netif_start_queue(dev);
1092 dev_kfree_skb(skb);
1093 return (0);
1094 }
1095 if (bp->QueueSkb == 0) {
1096
1097 netif_stop_queue(dev);
1098 return 1;
1099 }
1100 bp->QueueSkb--;
1101 skb_queue_tail(&bp->SendSkbQueue, skb);
1102 send_queued_packets(netdev_priv(dev));
1103 if (bp->QueueSkb == 0) {
1104 netif_stop_queue(dev);
1105 }
1106 dev->trans_start = jiffies;
1107 return 0;
1108
1109}
1110
1111
1112
1113
1114
1115
1116
1117
1118
1119
1120
1121
1122
1123
1124
1125
1126
1127
1128
1129
1130
1131
1132
1133
1134
1135static void send_queued_packets(struct s_smc *smc)
1136{
1137 skfddi_priv *bp = &smc->os;
1138 struct sk_buff *skb;
1139 unsigned char fc;
1140 int queue;
1141 struct s_smt_fp_txd *txd;
1142 dma_addr_t dma_address;
1143 unsigned long Flags;
1144
1145 int frame_status;
1146
1147 PRINTK(KERN_INFO "send queued packets\n");
1148 for (;;) {
1149
1150 skb = skb_dequeue(&bp->SendSkbQueue);
1151
1152 if (!skb) {
1153 PRINTK(KERN_INFO "queue empty\n");
1154 return;
1155 }
1156
1157 spin_lock_irqsave(&bp->DriverLock, Flags);
1158 fc = skb->data[0];
1159 queue = (fc & FC_SYNC_BIT) ? QUEUE_S : QUEUE_A0;
1160#ifdef ESS
1161
1162
1163 if ((fc & ~(FC_SYNC_BIT | FC_LLC_PRIOR)) == FC_ASYNC_LLC) {
1164
1165 if (!smc->ess.sync_bw_available)
1166 fc &= ~FC_SYNC_BIT;
1167
1168 else {
1169
1170 if (smc->mib.fddiESSSynchTxMode) {
1171
1172 fc |= FC_SYNC_BIT;
1173 }
1174 }
1175 }
1176#endif
1177 frame_status = hwm_tx_init(smc, fc, 1, skb->len, queue);
1178
1179 if ((frame_status & (LOC_TX | LAN_TX)) == 0) {
1180
1181
1182 if ((frame_status & RING_DOWN) != 0) {
1183
1184 PRINTK("Tx attempt while ring down.\n");
1185 } else if ((frame_status & OUT_OF_TXD) != 0) {
1186 PRINTK("%s: out of TXDs.\n", bp->dev->name);
1187 } else {
1188 PRINTK("%s: out of transmit resources",
1189 bp->dev->name);
1190 }
1191
1192
1193
1194 skb_queue_head(&bp->SendSkbQueue, skb);
1195 spin_unlock_irqrestore(&bp->DriverLock, Flags);
1196 return;
1197
1198 }
1199
1200 bp->QueueSkb++;
1201
1202
1203 CheckSourceAddress(skb->data, smc->hw.fddi_canon_addr.a);
1204
1205 txd = (struct s_smt_fp_txd *) HWM_GET_CURR_TXD(smc, queue);
1206
1207 dma_address = pci_map_single(&bp->pdev, skb->data,
1208 skb->len, PCI_DMA_TODEVICE);
1209 if (frame_status & LAN_TX) {
1210 txd->txd_os.skb = skb;
1211 txd->txd_os.dma_addr = dma_address;
1212 }
1213 hwm_tx_frag(smc, skb->data, dma_address, skb->len,
1214 frame_status | FIRST_FRAG | LAST_FRAG | EN_IRQ_EOF);
1215
1216 if (!(frame_status & LAN_TX)) {
1217 pci_unmap_single(&bp->pdev, dma_address,
1218 skb->len, PCI_DMA_TODEVICE);
1219 dev_kfree_skb_irq(skb);
1220 }
1221 spin_unlock_irqrestore(&bp->DriverLock, Flags);
1222 }
1223
1224 return;
1225
1226}
1227
1228
1229
1230
1231
1232
1233
1234
1235
1236void CheckSourceAddress(unsigned char *frame, unsigned char *hw_addr)
1237{
1238 unsigned char SRBit;
1239
1240 if ((((unsigned long) frame[1 + 6]) & ~0x01) != 0)
1241
1242 return;
1243 if ((unsigned short) frame[1 + 10] != 0)
1244 return;
1245 SRBit = frame[1 + 6] & 0x01;
1246 memcpy(&frame[1 + 6], hw_addr, 6);
1247 frame[8] |= SRBit;
1248}
1249
1250
1251
1252
1253
1254
1255
1256
1257
1258
1259
1260
1261
1262static void ResetAdapter(struct s_smc *smc)
1263{
1264
1265 PRINTK(KERN_INFO "[fddi: ResetAdapter]\n");
1266
1267
1268
1269 card_stop(smc);
1270
1271
1272 mac_drv_clear_tx_queue(smc);
1273 mac_drv_clear_rx_queue(smc);
1274
1275
1276
1277 smt_reset_defaults(smc, 1);
1278
1279 init_smt(smc, (smc->os.dev)->dev_addr);
1280
1281 smt_online(smc, 1);
1282 STI_FBI();
1283
1284
1285 skfp_ctl_set_multicast_list_wo_lock(smc->os.dev);
1286}
1287
1288
1289
1290
1291
1292
1293
1294
1295
1296
1297
1298
1299
1300
1301
1302
1303
1304
1305
1306
1307void llc_restart_tx(struct s_smc *smc)
1308{
1309 skfddi_priv *bp = &smc->os;
1310
1311 PRINTK(KERN_INFO "[llc_restart_tx]\n");
1312
1313
1314 spin_unlock(&bp->DriverLock);
1315 send_queued_packets(smc);
1316 spin_lock(&bp->DriverLock);
1317 netif_start_queue(bp->dev);
1318
1319}
1320
1321
1322
1323
1324
1325
1326
1327
1328
1329
1330
1331
1332
1333
1334
1335
1336
1337void *mac_drv_get_space(struct s_smc *smc, unsigned int size)
1338{
1339 void *virt;
1340
1341 PRINTK(KERN_INFO "mac_drv_get_space (%d bytes), ", size);
1342 virt = (void *) (smc->os.SharedMemAddr + smc->os.SharedMemHeap);
1343
1344 if ((smc->os.SharedMemHeap + size) > smc->os.SharedMemSize) {
1345 printk("Unexpected SMT memory size requested: %d\n", size);
1346 return (NULL);
1347 }
1348 smc->os.SharedMemHeap += size;
1349
1350 PRINTK(KERN_INFO "mac_drv_get_space end\n");
1351 PRINTK(KERN_INFO "virt addr: %lx\n", (ulong) virt);
1352 PRINTK(KERN_INFO "bus addr: %lx\n", (ulong)
1353 (smc->os.SharedMemDMA +
1354 ((char *) virt - (char *)smc->os.SharedMemAddr)));
1355 return (virt);
1356}
1357
1358
1359
1360
1361
1362
1363
1364
1365
1366
1367
1368
1369
1370
1371
1372
1373
1374
1375
1376
1377void *mac_drv_get_desc_mem(struct s_smc *smc, unsigned int size)
1378{
1379
1380 char *virt;
1381
1382 PRINTK(KERN_INFO "mac_drv_get_desc_mem\n");
1383
1384
1385
1386 virt = mac_drv_get_space(smc, size);
1387
1388 size = (u_int) (16 - (((unsigned long) virt) & 15UL));
1389 size = size % 16;
1390
1391 PRINTK("Allocate %u bytes alignment gap ", size);
1392 PRINTK("for descriptor memory.\n");
1393
1394 if (!mac_drv_get_space(smc, size)) {
1395 printk("fddi: Unable to align descriptor memory.\n");
1396 return (NULL);
1397 }
1398 return (virt + size);
1399}
1400
1401
1402
1403
1404
1405
1406
1407
1408
1409
1410
1411
1412
1413
1414
1415unsigned long mac_drv_virt2phys(struct s_smc *smc, void *virt)
1416{
1417 return (smc->os.SharedMemDMA +
1418 ((char *) virt - (char *)smc->os.SharedMemAddr));
1419}
1420
1421
1422
1423
1424
1425
1426
1427
1428
1429
1430
1431
1432
1433
1434
1435
1436
1437
1438
1439
1440
1441
1442
1443
1444
1445
1446
1447
1448
1449
1450u_long dma_master(struct s_smc * smc, void *virt, int len, int flag)
1451{
1452 return (smc->os.SharedMemDMA +
1453 ((char *) virt - (char *)smc->os.SharedMemAddr));
1454}
1455
1456
1457
1458
1459
1460
1461
1462
1463
1464
1465
1466
1467
1468
1469
1470
1471
1472
1473
1474
1475
1476
1477
1478void dma_complete(struct s_smc *smc, volatile union s_fp_descr *descr, int flag)
1479{
1480
1481
1482
1483
1484
1485
1486
1487
1488
1489
1490
1491
1492 if (flag & DMA_WR) {
1493 skfddi_priv *bp = &smc->os;
1494 volatile struct s_smt_fp_rxd *r = &descr->r;
1495
1496
1497 if (r->rxd_os.skb && r->rxd_os.dma_addr) {
1498 int MaxFrameSize = bp->MaxFrameSize;
1499
1500 pci_unmap_single(&bp->pdev, r->rxd_os.dma_addr,
1501 MaxFrameSize, PCI_DMA_FROMDEVICE);
1502 r->rxd_os.dma_addr = 0;
1503 }
1504 }
1505}
1506
1507
1508
1509
1510
1511
1512
1513
1514
1515
1516
1517
1518
1519
1520
1521
1522void mac_drv_tx_complete(struct s_smc *smc, volatile struct s_smt_fp_txd *txd)
1523{
1524 struct sk_buff *skb;
1525
1526 PRINTK(KERN_INFO "entering mac_drv_tx_complete\n");
1527
1528
1529 if (!(skb = txd->txd_os.skb)) {
1530 PRINTK("TXD with no skb assigned.\n");
1531 return;
1532 }
1533 txd->txd_os.skb = NULL;
1534
1535
1536 pci_unmap_single(&smc->os.pdev, txd->txd_os.dma_addr,
1537 skb->len, PCI_DMA_TODEVICE);
1538 txd->txd_os.dma_addr = 0;
1539
1540 smc->os.MacStat.gen.tx_packets++;
1541 smc->os.MacStat.gen.tx_bytes+=skb->len;
1542
1543
1544 dev_kfree_skb_irq(skb);
1545
1546 PRINTK(KERN_INFO "leaving mac_drv_tx_complete\n");
1547}
1548
1549
1550
1551
1552
1553
1554
1555#ifdef DUMPPACKETS
1556void dump_data(unsigned char *Data, int length)
1557{
1558 int i, j;
1559 unsigned char s[255], sh[10];
1560 if (length > 64) {
1561 length = 64;
1562 }
1563 printk(KERN_INFO "---Packet start---\n");
1564 for (i = 0, j = 0; i < length / 8; i++, j += 8)
1565 printk(KERN_INFO "%02x %02x %02x %02x %02x %02x %02x %02x\n",
1566 Data[j + 0], Data[j + 1], Data[j + 2], Data[j + 3],
1567 Data[j + 4], Data[j + 5], Data[j + 6], Data[j + 7]);
1568 strcpy(s, "");
1569 for (i = 0; i < length % 8; i++) {
1570 sprintf(sh, "%02x ", Data[j + i]);
1571 strcat(s, sh);
1572 }
1573 printk(KERN_INFO "%s\n", s);
1574 printk(KERN_INFO "------------------\n");
1575}
1576#else
1577#define dump_data(data,len)
1578#endif
1579
1580
1581
1582
1583
1584
1585
1586
1587
1588
1589
1590
1591
1592
1593
1594
1595
1596
1597
1598
1599
1600
1601
1602
1603
1604void mac_drv_rx_complete(struct s_smc *smc, volatile struct s_smt_fp_rxd *rxd,
1605 int frag_count, int len)
1606{
1607 skfddi_priv *bp = &smc->os;
1608 struct sk_buff *skb;
1609 unsigned char *virt, *cp;
1610 unsigned short ri;
1611 u_int RifLength;
1612
1613 PRINTK(KERN_INFO "entering mac_drv_rx_complete (len=%d)\n", len);
1614 if (frag_count != 1) {
1615
1616 printk("fddi: Multi-fragment receive!\n");
1617 goto RequeueRxd;
1618
1619 }
1620 skb = rxd->rxd_os.skb;
1621 if (!skb) {
1622 PRINTK(KERN_INFO "No skb in rxd\n");
1623 smc->os.MacStat.gen.rx_errors++;
1624 goto RequeueRxd;
1625 }
1626 virt = skb->data;
1627
1628
1629
1630 dump_data(skb->data, len);
1631
1632
1633
1634
1635
1636
1637
1638
1639
1640
1641
1642
1643
1644
1645
1646
1647 if ((virt[1 + 6] & FDDI_RII) == 0)
1648 RifLength = 0;
1649 else {
1650 int n;
1651
1652 PRINTK(KERN_INFO "RIF found\n");
1653
1654 cp = virt + FDDI_MAC_HDR_LEN;
1655
1656 ri = ntohs(*((unsigned short *) cp));
1657 RifLength = ri & FDDI_RCF_LEN_MASK;
1658 if (len < (int) (FDDI_MAC_HDR_LEN + RifLength)) {
1659 printk("fddi: Invalid RIF.\n");
1660 goto RequeueRxd;
1661
1662 }
1663 virt[1 + 6] &= ~FDDI_RII;
1664
1665
1666 virt = cp + RifLength;
1667 for (n = FDDI_MAC_HDR_LEN; n; n--)
1668 *--virt = *--cp;
1669
1670 skb_pull(skb, RifLength);
1671 len -= RifLength;
1672 RifLength = 0;
1673 }
1674
1675
1676 smc->os.MacStat.gen.rx_packets++;
1677
1678 smc->os.MacStat.gen.rx_bytes+=len;
1679
1680
1681 if (virt[1] & 0x01) {
1682
1683 smc->os.MacStat.gen.multicast++;
1684 }
1685
1686
1687 rxd->rxd_os.skb = NULL;
1688 skb_trim(skb, len);
1689 skb->protocol = fddi_type_trans(skb, bp->dev);
1690 skb->dev = bp->dev;
1691
1692 netif_rx(skb);
1693 bp->dev->last_rx = jiffies;
1694
1695 HWM_RX_CHECK(smc, RX_LOW_WATERMARK);
1696 return;
1697
1698 RequeueRxd:
1699 PRINTK(KERN_INFO "Rx: re-queue RXD.\n");
1700 mac_drv_requeue_rxd(smc, rxd, frag_count);
1701 smc->os.MacStat.gen.rx_errors++;
1702
1703
1704}
1705
1706
1707
1708
1709
1710
1711
1712
1713
1714
1715
1716
1717
1718
1719
1720
1721
1722
1723
1724
1725void mac_drv_requeue_rxd(struct s_smc *smc, volatile struct s_smt_fp_rxd *rxd,
1726 int frag_count)
1727{
1728 volatile struct s_smt_fp_rxd *next_rxd;
1729 volatile struct s_smt_fp_rxd *src_rxd;
1730 struct sk_buff *skb;
1731 int MaxFrameSize;
1732 unsigned char *v_addr;
1733 dma_addr_t b_addr;
1734
1735 if (frag_count != 1)
1736
1737 printk("fddi: Multi-fragment requeue!\n");
1738
1739 MaxFrameSize = smc->os.MaxFrameSize;
1740 src_rxd = rxd;
1741 for (; frag_count > 0; frag_count--) {
1742 next_rxd = src_rxd->rxd_next;
1743 rxd = HWM_GET_CURR_RXD(smc);
1744
1745 skb = src_rxd->rxd_os.skb;
1746 if (skb == NULL) {
1747
1748 PRINTK("Requeue with no skb in rxd!\n");
1749 skb = alloc_skb(MaxFrameSize + 3, GFP_ATOMIC);
1750 if (skb) {
1751
1752 rxd->rxd_os.skb = skb;
1753 skb_reserve(skb, 3);
1754 skb_put(skb, MaxFrameSize);
1755 v_addr = skb->data;
1756 b_addr = pci_map_single(&smc->os.pdev,
1757 v_addr,
1758 MaxFrameSize,
1759 PCI_DMA_FROMDEVICE);
1760 rxd->rxd_os.dma_addr = b_addr;
1761 } else {
1762
1763 PRINTK("Queueing invalid buffer!\n");
1764 rxd->rxd_os.skb = NULL;
1765 v_addr = smc->os.LocalRxBuffer;
1766 b_addr = smc->os.LocalRxBufferDMA;
1767 }
1768 } else {
1769
1770 rxd->rxd_os.skb = skb;
1771 v_addr = skb->data;
1772 b_addr = pci_map_single(&smc->os.pdev,
1773 v_addr,
1774 MaxFrameSize,
1775 PCI_DMA_FROMDEVICE);
1776 rxd->rxd_os.dma_addr = b_addr;
1777 }
1778 hwm_rx_frag(smc, v_addr, b_addr, MaxFrameSize,
1779 FIRST_FRAG | LAST_FRAG);
1780
1781 src_rxd = next_rxd;
1782 }
1783}
1784
1785
1786
1787
1788
1789
1790
1791
1792
1793
1794
1795
1796
1797
1798
1799
1800
1801
1802void mac_drv_fill_rxd(struct s_smc *smc)
1803{
1804 int MaxFrameSize;
1805 unsigned char *v_addr;
1806 unsigned long b_addr;
1807 struct sk_buff *skb;
1808 volatile struct s_smt_fp_rxd *rxd;
1809
1810 PRINTK(KERN_INFO "entering mac_drv_fill_rxd\n");
1811
1812
1813
1814
1815 MaxFrameSize = smc->os.MaxFrameSize;
1816
1817 while (HWM_GET_RX_FREE(smc) > 0) {
1818 PRINTK(KERN_INFO ".\n");
1819
1820 rxd = HWM_GET_CURR_RXD(smc);
1821 skb = alloc_skb(MaxFrameSize + 3, GFP_ATOMIC);
1822 if (skb) {
1823
1824 skb_reserve(skb, 3);
1825 skb_put(skb, MaxFrameSize);
1826 v_addr = skb->data;
1827 b_addr = pci_map_single(&smc->os.pdev,
1828 v_addr,
1829 MaxFrameSize,
1830 PCI_DMA_FROMDEVICE);
1831 rxd->rxd_os.dma_addr = b_addr;
1832 } else {
1833
1834
1835
1836
1837
1838 PRINTK("Queueing invalid buffer!\n");
1839 v_addr = smc->os.LocalRxBuffer;
1840 b_addr = smc->os.LocalRxBufferDMA;
1841 }
1842
1843 rxd->rxd_os.skb = skb;
1844
1845
1846 hwm_rx_frag(smc, v_addr, b_addr, MaxFrameSize,
1847 FIRST_FRAG | LAST_FRAG);
1848 }
1849 PRINTK(KERN_INFO "leaving mac_drv_fill_rxd\n");
1850}
1851
1852
1853
1854
1855
1856
1857
1858
1859
1860
1861
1862
1863
1864
1865
1866
1867
1868
1869void mac_drv_clear_rxd(struct s_smc *smc, volatile struct s_smt_fp_rxd *rxd,
1870 int frag_count)
1871{
1872
1873 struct sk_buff *skb;
1874
1875 PRINTK("entering mac_drv_clear_rxd\n");
1876
1877 if (frag_count != 1)
1878
1879 printk("fddi: Multi-fragment clear!\n");
1880
1881 for (; frag_count > 0; frag_count--) {
1882 skb = rxd->rxd_os.skb;
1883 if (skb != NULL) {
1884 skfddi_priv *bp = &smc->os;
1885 int MaxFrameSize = bp->MaxFrameSize;
1886
1887 pci_unmap_single(&bp->pdev, rxd->rxd_os.dma_addr,
1888 MaxFrameSize, PCI_DMA_FROMDEVICE);
1889
1890 dev_kfree_skb(skb);
1891 rxd->rxd_os.skb = NULL;
1892 }
1893 rxd = rxd->rxd_next;
1894
1895 }
1896}
1897
1898
1899
1900
1901
1902
1903
1904
1905
1906
1907
1908
1909
1910
1911
1912
1913
1914
1915
1916
1917
1918
1919
1920
1921
1922
1923
1924
1925
1926int mac_drv_rx_init(struct s_smc *smc, int len, int fc,
1927 char *look_ahead, int la_len)
1928{
1929 struct sk_buff *skb;
1930
1931 PRINTK("entering mac_drv_rx_init(len=%d)\n", len);
1932
1933
1934
1935 if (len != la_len || len < FDDI_MAC_HDR_LEN || !look_ahead) {
1936 PRINTK("fddi: Discard invalid local SMT frame\n");
1937 PRINTK(" len=%d, la_len=%d, (ULONG) look_ahead=%08lXh.\n",
1938 len, la_len, (unsigned long) look_ahead);
1939 return (0);
1940 }
1941 skb = alloc_skb(len + 3, GFP_ATOMIC);
1942 if (!skb) {
1943 PRINTK("fddi: Local SMT: skb memory exhausted.\n");
1944 return (0);
1945 }
1946 skb_reserve(skb, 3);
1947 skb_put(skb, len);
1948 memcpy(skb->data, look_ahead, len);
1949
1950
1951 skb->protocol = fddi_type_trans(skb, smc->os.dev);
1952 skb->dev->last_rx = jiffies;
1953 netif_rx(skb);
1954
1955 return (0);
1956}
1957
1958
1959
1960
1961
1962
1963
1964
1965
1966
1967
1968
1969
1970
1971
1972
1973
1974void smt_timer_poll(struct s_smc *smc)
1975{
1976}
1977
1978
1979
1980
1981
1982
1983
1984
1985
1986
1987
1988
1989
1990
1991
1992void ring_status_indication(struct s_smc *smc, u_long status)
1993{
1994 PRINTK("ring_status_indication( ");
1995 if (status & RS_RES15)
1996 PRINTK("RS_RES15 ");
1997 if (status & RS_HARDERROR)
1998 PRINTK("RS_HARDERROR ");
1999 if (status & RS_SOFTERROR)
2000 PRINTK("RS_SOFTERROR ");
2001 if (status & RS_BEACON)
2002 PRINTK("RS_BEACON ");
2003 if (status & RS_PATHTEST)
2004 PRINTK("RS_PATHTEST ");
2005 if (status & RS_SELFTEST)
2006 PRINTK("RS_SELFTEST ");
2007 if (status & RS_RES9)
2008 PRINTK("RS_RES9 ");
2009 if (status & RS_DISCONNECT)
2010 PRINTK("RS_DISCONNECT ");
2011 if (status & RS_RES7)
2012 PRINTK("RS_RES7 ");
2013 if (status & RS_DUPADDR)
2014 PRINTK("RS_DUPADDR ");
2015 if (status & RS_NORINGOP)
2016 PRINTK("RS_NORINGOP ");
2017 if (status & RS_VERSION)
2018 PRINTK("RS_VERSION ");
2019 if (status & RS_STUCKBYPASSS)
2020 PRINTK("RS_STUCKBYPASSS ");
2021 if (status & RS_EVENT)
2022 PRINTK("RS_EVENT ");
2023 if (status & RS_RINGOPCHANGE)
2024 PRINTK("RS_RINGOPCHANGE ");
2025 if (status & RS_RES0)
2026 PRINTK("RS_RES0 ");
2027 PRINTK("]\n");
2028}
2029
2030
2031
2032
2033
2034
2035
2036
2037
2038
2039
2040
2041
2042
2043
2044
2045
2046unsigned long smt_get_time(void)
2047{
2048 return jiffies;
2049}
2050
2051
2052
2053
2054
2055
2056
2057
2058
2059
2060
2061
2062
2063
2064
2065
2066void smt_stat_counter(struct s_smc *smc, int stat)
2067{
2068
2069
2070 PRINTK(KERN_INFO "smt_stat_counter\n");
2071 switch (stat) {
2072 case 0:
2073 PRINTK(KERN_INFO "Ring operational change.\n");
2074 break;
2075 case 1:
2076 PRINTK(KERN_INFO "Receive fifo overflow.\n");
2077 smc->os.MacStat.gen.rx_errors++;
2078 break;
2079 default:
2080 PRINTK(KERN_INFO "Unknown status (%d).\n", stat);
2081 break;
2082 }
2083}
2084
2085
2086
2087
2088
2089
2090
2091
2092
2093
2094
2095
2096
2097
2098
2099
2100
2101
2102void cfm_state_change(struct s_smc *smc, int c_state)
2103{
2104#ifdef DRIVERDEBUG
2105 char *s;
2106
2107 switch (c_state) {
2108 case SC0_ISOLATED:
2109 s = "SC0_ISOLATED";
2110 break;
2111 case SC1_WRAP_A:
2112 s = "SC1_WRAP_A";
2113 break;
2114 case SC2_WRAP_B:
2115 s = "SC2_WRAP_B";
2116 break;
2117 case SC4_THRU_A:
2118 s = "SC4_THRU_A";
2119 break;
2120 case SC5_THRU_B:
2121 s = "SC5_THRU_B";
2122 break;
2123 case SC7_WRAP_S:
2124 s = "SC7_WRAP_S";
2125 break;
2126 case SC9_C_WRAP_A:
2127 s = "SC9_C_WRAP_A";
2128 break;
2129 case SC10_C_WRAP_B:
2130 s = "SC10_C_WRAP_B";
2131 break;
2132 case SC11_C_WRAP_S:
2133 s = "SC11_C_WRAP_S";
2134 break;
2135 default:
2136 PRINTK(KERN_INFO "cfm_state_change: unknown %d\n", c_state);
2137 return;
2138 }
2139 PRINTK(KERN_INFO "cfm_state_change: %s\n", s);
2140#endif
2141}
2142
2143
2144
2145
2146
2147
2148
2149
2150
2151
2152
2153
2154
2155
2156
2157
2158
2159
2160void ecm_state_change(struct s_smc *smc, int e_state)
2161{
2162#ifdef DRIVERDEBUG
2163 char *s;
2164
2165 switch (e_state) {
2166 case EC0_OUT:
2167 s = "EC0_OUT";
2168 break;
2169 case EC1_IN:
2170 s = "EC1_IN";
2171 break;
2172 case EC2_TRACE:
2173 s = "EC2_TRACE";
2174 break;
2175 case EC3_LEAVE:
2176 s = "EC3_LEAVE";
2177 break;
2178 case EC4_PATH_TEST:
2179 s = "EC4_PATH_TEST";
2180 break;
2181 case EC5_INSERT:
2182 s = "EC5_INSERT";
2183 break;
2184 case EC6_CHECK:
2185 s = "EC6_CHECK";
2186 break;
2187 case EC7_DEINSERT:
2188 s = "EC7_DEINSERT";
2189 break;
2190 default:
2191 s = "unknown";
2192 break;
2193 }
2194 PRINTK(KERN_INFO "ecm_state_change: %s\n", s);
2195#endif
2196}
2197
2198
2199
2200
2201
2202
2203
2204
2205
2206
2207
2208
2209
2210
2211
2212
2213
2214
2215void rmt_state_change(struct s_smc *smc, int r_state)
2216{
2217#ifdef DRIVERDEBUG
2218 char *s;
2219
2220 switch (r_state) {
2221 case RM0_ISOLATED:
2222 s = "RM0_ISOLATED";
2223 break;
2224 case RM1_NON_OP:
2225 s = "RM1_NON_OP - not operational";
2226 break;
2227 case RM2_RING_OP:
2228 s = "RM2_RING_OP - ring operational";
2229 break;
2230 case RM3_DETECT:
2231 s = "RM3_DETECT - detect dupl addresses";
2232 break;
2233 case RM4_NON_OP_DUP:
2234 s = "RM4_NON_OP_DUP - dupl. addr detected";
2235 break;
2236 case RM5_RING_OP_DUP:
2237 s = "RM5_RING_OP_DUP - ring oper. with dupl. addr";
2238 break;
2239 case RM6_DIRECTED:
2240 s = "RM6_DIRECTED - sending directed beacons";
2241 break;
2242 case RM7_TRACE:
2243 s = "RM7_TRACE - trace initiated";
2244 break;
2245 default:
2246 s = "unknown";
2247 break;
2248 }
2249 PRINTK(KERN_INFO "[rmt_state_change: %s]\n", s);
2250#endif
2251}
2252
2253
2254
2255
2256
2257
2258
2259
2260
2261
2262
2263
2264
2265
2266
2267void drv_reset_indication(struct s_smc *smc)
2268{
2269 PRINTK(KERN_INFO "entering drv_reset_indication\n");
2270
2271 smc->os.ResetRequested = TRUE;
2272
2273}
2274
2275static struct pci_driver skfddi_pci_driver = {
2276 .name = "skfddi",
2277 .id_table = skfddi_pci_tbl,
2278 .probe = skfp_init_one,
2279 .remove = __devexit_p(skfp_remove_one),
2280};
2281
2282static int __init skfd_init(void)
2283{
2284 return pci_module_init(&skfddi_pci_driver);
2285}
2286
2287static void __exit skfd_exit(void)
2288{
2289 pci_unregister_driver(&skfddi_pci_driver);
2290}
2291
2292module_init(skfd_init);
2293module_exit(skfd_exit);
2294