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#include <linux/module.h>
26#include <linux/types.h>
27#include <linux/pci.h>
28#include <linux/kernel.h>
29#include <linux/init.h>
30#include <linux/ioport.h>
31#include <linux/atmdev.h>
32#include <linux/delay.h>
33#include <linux/interrupt.h>
34#include <linux/poison.h>
35#include <linux/bitrev.h>
36#include <linux/mutex.h>
37
38#include <asm/atomic.h>
39#include <asm/io.h>
40#include <asm/byteorder.h>
41
42#include "ambassador.h"
43
44#define maintainer_string "Giuliano Procida at Madge Networks <gprocida@madge.com>"
45#define description_string "Madge ATM Ambassador driver"
46#define version_string "1.2.4"
47
48static inline void __init show_version (void) {
49 printk ("%s version %s\n", description_string, version_string);
50}
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
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
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295#ifdef AMB_NEW_MICROCODE
296#define UCODE(x) UCODE2(atmsar12.x)
297#else
298#define UCODE(x) UCODE2(atmsar11.x)
299#endif
300#define UCODE2(x) #x
301
302static u32 __devinitdata ucode_start =
303#include UCODE(start)
304;
305
306static region __devinitdata ucode_regions[] = {
307#include UCODE(regions)
308 { 0, 0 }
309};
310
311static u32 __devinitdata ucode_data[] = {
312#include UCODE(data)
313 0xdeadbeef
314};
315
316static void do_housekeeping (unsigned long arg);
317
318
319static unsigned short debug = 0;
320static unsigned int cmds = 8;
321static unsigned int txs = 32;
322static unsigned int rxs[NUM_RX_POOLS] = { 64, 64, 64, 64 };
323static unsigned int rxs_bs[NUM_RX_POOLS] = { 4080, 12240, 36720, 65535 };
324static unsigned int rx_lats = 7;
325static unsigned char pci_lat = 0;
326
327static const unsigned long onegigmask = -1 << 30;
328
329
330
331static inline void wr_plain (const amb_dev * dev, size_t addr, u32 data) {
332 PRINTD (DBG_FLOW|DBG_REGS, "wr: %08zx <- %08x", addr, data);
333#ifdef AMB_MMIO
334 dev->membase[addr / sizeof(u32)] = data;
335#else
336 outl (data, dev->iobase + addr);
337#endif
338}
339
340static inline u32 rd_plain (const amb_dev * dev, size_t addr) {
341#ifdef AMB_MMIO
342 u32 data = dev->membase[addr / sizeof(u32)];
343#else
344 u32 data = inl (dev->iobase + addr);
345#endif
346 PRINTD (DBG_FLOW|DBG_REGS, "rd: %08zx -> %08x", addr, data);
347 return data;
348}
349
350static inline void wr_mem (const amb_dev * dev, size_t addr, u32 data) {
351 __be32 be = cpu_to_be32 (data);
352 PRINTD (DBG_FLOW|DBG_REGS, "wr: %08zx <- %08x b[%08x]", addr, data, be);
353#ifdef AMB_MMIO
354 dev->membase[addr / sizeof(u32)] = be;
355#else
356 outl (be, dev->iobase + addr);
357#endif
358}
359
360static inline u32 rd_mem (const amb_dev * dev, size_t addr) {
361#ifdef AMB_MMIO
362 __be32 be = dev->membase[addr / sizeof(u32)];
363#else
364 __be32 be = inl (dev->iobase + addr);
365#endif
366 u32 data = be32_to_cpu (be);
367 PRINTD (DBG_FLOW|DBG_REGS, "rd: %08zx -> %08x b[%08x]", addr, data, be);
368 return data;
369}
370
371
372
373static inline void dump_registers (const amb_dev * dev) {
374#ifdef DEBUG_AMBASSADOR
375 if (debug & DBG_REGS) {
376 size_t i;
377 PRINTD (DBG_REGS, "reading PLX control: ");
378 for (i = 0x00; i < 0x30; i += sizeof(u32))
379 rd_mem (dev, i);
380 PRINTD (DBG_REGS, "reading mailboxes: ");
381 for (i = 0x40; i < 0x60; i += sizeof(u32))
382 rd_mem (dev, i);
383 PRINTD (DBG_REGS, "reading doorb irqev irqen reset:");
384 for (i = 0x60; i < 0x70; i += sizeof(u32))
385 rd_mem (dev, i);
386 }
387#else
388 (void) dev;
389#endif
390 return;
391}
392
393static inline void dump_loader_block (volatile loader_block * lb) {
394#ifdef DEBUG_AMBASSADOR
395 unsigned int i;
396 PRINTDB (DBG_LOAD, "lb @ %p; res: %d, cmd: %d, pay:",
397 lb, be32_to_cpu (lb->result), be32_to_cpu (lb->command));
398 for (i = 0; i < MAX_COMMAND_DATA; ++i)
399 PRINTDM (DBG_LOAD, " %08x", be32_to_cpu (lb->payload.data[i]));
400 PRINTDE (DBG_LOAD, ", vld: %08x", be32_to_cpu (lb->valid));
401#else
402 (void) lb;
403#endif
404 return;
405}
406
407static inline void dump_command (command * cmd) {
408#ifdef DEBUG_AMBASSADOR
409 unsigned int i;
410 PRINTDB (DBG_CMD, "cmd @ %p, req: %08x, pars:",
411 cmd, (cmd->request));
412 for (i = 0; i < 3; ++i)
413 PRINTDM (DBG_CMD, " %08x", (cmd->args.par[i]));
414 PRINTDE (DBG_CMD, "");
415#else
416 (void) cmd;
417#endif
418 return;
419}
420
421static inline void dump_skb (char * prefix, unsigned int vc, struct sk_buff * skb) {
422#ifdef DEBUG_AMBASSADOR
423 unsigned int i;
424 unsigned char * data = skb->data;
425 PRINTDB (DBG_DATA, "%s(%u) ", prefix, vc);
426 for (i=0; i<skb->len && i < 256;i++)
427 PRINTDM (DBG_DATA, "%02x ", data[i]);
428 PRINTDE (DBG_DATA,"");
429#else
430 (void) prefix;
431 (void) vc;
432 (void) skb;
433#endif
434 return;
435}
436
437
438
439
440
441static int check_area (void * start, size_t length) {
442
443 const u32 fourmegmask = -1 << 22;
444 const u32 twofivesixmask = -1 << 8;
445 const u32 starthole = 0xE0000000;
446 u32 startaddress = virt_to_bus (start);
447 u32 lastaddress = startaddress+length-1;
448 if ((startaddress ^ lastaddress) & fourmegmask ||
449 (startaddress & twofivesixmask) == starthole) {
450 PRINTK (KERN_ERR, "check_area failure: [%x,%x] - mail maintainer!",
451 startaddress, lastaddress);
452 return -1;
453 } else {
454 return 0;
455 }
456}
457
458
459
460static void amb_kfree_skb (struct sk_buff * skb) {
461 if (ATM_SKB(skb)->vcc->pop) {
462 ATM_SKB(skb)->vcc->pop (ATM_SKB(skb)->vcc, skb);
463 } else {
464 dev_kfree_skb_any (skb);
465 }
466}
467
468
469
470static void tx_complete (amb_dev * dev, tx_out * tx) {
471 tx_simple * tx_descr = bus_to_virt (tx->handle);
472 struct sk_buff * skb = tx_descr->skb;
473
474 PRINTD (DBG_FLOW|DBG_TX, "tx_complete %p %p", dev, tx);
475
476
477 atomic_inc(&ATM_SKB(skb)->vcc->stats->tx);
478
479
480 kfree (tx_descr);
481
482
483 amb_kfree_skb (skb);
484
485 dev->stats.tx_ok++;
486 return;
487}
488
489
490
491static void rx_complete (amb_dev * dev, rx_out * rx) {
492 struct sk_buff * skb = bus_to_virt (rx->handle);
493 u16 vc = be16_to_cpu (rx->vc);
494
495 u16 status = be16_to_cpu (rx->status);
496 u16 rx_len = be16_to_cpu (rx->length);
497
498 PRINTD (DBG_FLOW|DBG_RX, "rx_complete %p %p (len=%hu)", dev, rx, rx_len);
499
500
501 if (!status) {
502 struct atm_vcc * atm_vcc = dev->rxer[vc];
503 dev->stats.rx.ok++;
504
505 if (atm_vcc) {
506
507 if (rx_len <= atm_vcc->qos.rxtp.max_sdu) {
508
509 if (atm_charge (atm_vcc, skb->truesize)) {
510
511
512 ATM_SKB(skb)->vcc = atm_vcc;
513 skb_put (skb, rx_len);
514
515 dump_skb ("<<<", vc, skb);
516
517
518 atomic_inc(&atm_vcc->stats->rx);
519 __net_timestamp(skb);
520
521 atm_vcc->push (atm_vcc, skb);
522 return;
523
524 } else {
525
526 PRINTD (DBG_INFO|DBG_RX, "dropped thanks to atm_charge (vc %hu, truesize %u)", vc, skb->truesize);
527
528 }
529
530 } else {
531 PRINTK (KERN_INFO, "dropped over-size frame");
532
533 atomic_inc(&atm_vcc->stats->rx_drop);
534 }
535
536 } else {
537 PRINTD (DBG_WARN|DBG_RX, "got frame but RX closed for channel %hu", vc);
538
539 }
540
541 } else {
542 dev->stats.rx.error++;
543 if (status & CRC_ERR)
544 dev->stats.rx.badcrc++;
545 if (status & LEN_ERR)
546 dev->stats.rx.toolong++;
547 if (status & ABORT_ERR)
548 dev->stats.rx.aborted++;
549 if (status & UNUSED_ERR)
550 dev->stats.rx.unused++;
551 }
552
553 dev_kfree_skb_any (skb);
554 return;
555}
556
557
558
559
560
561
562
563
564
565
566
567
568
569
570
571
572
573
574
575
576static int command_do (amb_dev * dev, command * cmd) {
577 amb_cq * cq = &dev->cq;
578 volatile amb_cq_ptrs * ptrs = &cq->ptrs;
579 command * my_slot;
580
581 PRINTD (DBG_FLOW|DBG_CMD, "command_do %p", dev);
582
583 if (test_bit (dead, &dev->flags))
584 return 0;
585
586 spin_lock (&cq->lock);
587
588
589 if (cq->pending < cq->maximum) {
590
591 my_slot = ptrs->in;
592 PRINTD (DBG_CMD, "command in slot %p", my_slot);
593
594 dump_command (cmd);
595
596
597 *ptrs->in = *cmd;
598 cq->pending++;
599 ptrs->in = NEXTQ (ptrs->in, ptrs->start, ptrs->limit);
600
601
602 wr_mem (dev, offsetof(amb_mem, mb.adapter.cmd_address), virt_to_bus (ptrs->in));
603
604 if (cq->pending > cq->high)
605 cq->high = cq->pending;
606 spin_unlock (&cq->lock);
607
608
609
610
611 msleep(cq->pending);
612
613
614 while (ptrs->out != my_slot) {
615 PRINTD (DBG_CMD, "wait: command slot (now at %p)", ptrs->out);
616 set_current_state(TASK_UNINTERRUPTIBLE);
617 schedule();
618 }
619
620
621 while (ptrs->out->request != cpu_to_be32 (SRB_COMPLETE)) {
622 PRINTD (DBG_CMD, "wait: command slot completion");
623 set_current_state(TASK_UNINTERRUPTIBLE);
624 schedule();
625 }
626
627 PRINTD (DBG_CMD, "command complete");
628
629 spin_lock (&cq->lock);
630 cq->pending--;
631
632 *cmd = *ptrs->out;
633 ptrs->out = NEXTQ (ptrs->out, ptrs->start, ptrs->limit);
634 spin_unlock (&cq->lock);
635
636 return 0;
637 } else {
638 cq->filled++;
639 spin_unlock (&cq->lock);
640 return -EAGAIN;
641 }
642
643}
644
645
646
647static int tx_give (amb_dev * dev, tx_in * tx) {
648 amb_txq * txq = &dev->txq;
649 unsigned long flags;
650
651 PRINTD (DBG_FLOW|DBG_TX, "tx_give %p", dev);
652
653 if (test_bit (dead, &dev->flags))
654 return 0;
655
656 spin_lock_irqsave (&txq->lock, flags);
657
658 if (txq->pending < txq->maximum) {
659 PRINTD (DBG_TX, "TX in slot %p", txq->in.ptr);
660
661 *txq->in.ptr = *tx;
662 txq->pending++;
663 txq->in.ptr = NEXTQ (txq->in.ptr, txq->in.start, txq->in.limit);
664
665 wr_mem (dev, offsetof(amb_mem, mb.adapter.tx_address), virt_to_bus (txq->in.ptr));
666 wr_mem (dev, offsetof(amb_mem, doorbell), TX_FRAME);
667
668 if (txq->pending > txq->high)
669 txq->high = txq->pending;
670 spin_unlock_irqrestore (&txq->lock, flags);
671 return 0;
672 } else {
673 txq->filled++;
674 spin_unlock_irqrestore (&txq->lock, flags);
675 return -EAGAIN;
676 }
677}
678
679static int tx_take (amb_dev * dev) {
680 amb_txq * txq = &dev->txq;
681 unsigned long flags;
682
683 PRINTD (DBG_FLOW|DBG_TX, "tx_take %p", dev);
684
685 spin_lock_irqsave (&txq->lock, flags);
686
687 if (txq->pending && txq->out.ptr->handle) {
688
689 tx_complete (dev, txq->out.ptr);
690
691 txq->out.ptr->handle = 0;
692
693 txq->pending--;
694 txq->out.ptr = NEXTQ (txq->out.ptr, txq->out.start, txq->out.limit);
695
696 spin_unlock_irqrestore (&txq->lock, flags);
697 return 0;
698 } else {
699
700 spin_unlock_irqrestore (&txq->lock, flags);
701 return -1;
702 }
703}
704
705
706
707static int rx_give (amb_dev * dev, rx_in * rx, unsigned char pool) {
708 amb_rxq * rxq = &dev->rxq[pool];
709 unsigned long flags;
710
711 PRINTD (DBG_FLOW|DBG_RX, "rx_give %p[%hu]", dev, pool);
712
713 spin_lock_irqsave (&rxq->lock, flags);
714
715 if (rxq->pending < rxq->maximum) {
716 PRINTD (DBG_RX, "RX in slot %p", rxq->in.ptr);
717
718 *rxq->in.ptr = *rx;
719 rxq->pending++;
720 rxq->in.ptr = NEXTQ (rxq->in.ptr, rxq->in.start, rxq->in.limit);
721
722 wr_mem (dev, offsetof(amb_mem, mb.adapter.rx_address[pool]), virt_to_bus (rxq->in.ptr));
723
724 spin_unlock_irqrestore (&rxq->lock, flags);
725 return 0;
726 } else {
727 spin_unlock_irqrestore (&rxq->lock, flags);
728 return -1;
729 }
730}
731
732static int rx_take (amb_dev * dev, unsigned char pool) {
733 amb_rxq * rxq = &dev->rxq[pool];
734 unsigned long flags;
735
736 PRINTD (DBG_FLOW|DBG_RX, "rx_take %p[%hu]", dev, pool);
737
738 spin_lock_irqsave (&rxq->lock, flags);
739
740 if (rxq->pending && (rxq->out.ptr->status || rxq->out.ptr->length)) {
741
742 rx_complete (dev, rxq->out.ptr);
743
744 rxq->out.ptr->status = 0;
745 rxq->out.ptr->length = 0;
746
747 rxq->pending--;
748 rxq->out.ptr = NEXTQ (rxq->out.ptr, rxq->out.start, rxq->out.limit);
749
750 if (rxq->pending < rxq->low)
751 rxq->low = rxq->pending;
752 spin_unlock_irqrestore (&rxq->lock, flags);
753 return 0;
754 } else {
755 if (!rxq->pending && rxq->buffers_wanted)
756 rxq->emptied++;
757 spin_unlock_irqrestore (&rxq->lock, flags);
758 return -1;
759 }
760}
761
762
763
764
765static void drain_rx_pool (amb_dev * dev, unsigned char pool) {
766 amb_rxq * rxq = &dev->rxq[pool];
767
768 PRINTD (DBG_FLOW|DBG_POOL, "drain_rx_pool %p %hu", dev, pool);
769
770 if (test_bit (dead, &dev->flags))
771 return;
772
773
774
775
776 if (rxq->pending > rxq->buffers_wanted) {
777 command cmd;
778 cmd.request = cpu_to_be32 (SRB_FLUSH_BUFFER_Q);
779 cmd.args.flush.flags = cpu_to_be32 (pool << SRB_POOL_SHIFT);
780 while (command_do (dev, &cmd))
781 schedule();
782
783 while (rxq->pending > rxq->buffers_wanted)
784 if (rx_take (dev, pool))
785 schedule();
786 }
787
788 return;
789}
790
791static void drain_rx_pools (amb_dev * dev) {
792 unsigned char pool;
793
794 PRINTD (DBG_FLOW|DBG_POOL, "drain_rx_pools %p", dev);
795
796 for (pool = 0; pool < NUM_RX_POOLS; ++pool)
797 drain_rx_pool (dev, pool);
798}
799
800static void fill_rx_pool (amb_dev * dev, unsigned char pool,
801 gfp_t priority)
802{
803 rx_in rx;
804 amb_rxq * rxq;
805
806 PRINTD (DBG_FLOW|DBG_POOL, "fill_rx_pool %p %hu %x", dev, pool, priority);
807
808 if (test_bit (dead, &dev->flags))
809 return;
810
811 rxq = &dev->rxq[pool];
812 while (rxq->pending < rxq->maximum && rxq->pending < rxq->buffers_wanted) {
813
814 struct sk_buff * skb = alloc_skb (rxq->buffer_size, priority);
815 if (!skb) {
816 PRINTD (DBG_SKB|DBG_POOL, "failed to allocate skb for RX pool %hu", pool);
817 return;
818 }
819 if (check_area (skb->data, skb->truesize)) {
820 dev_kfree_skb_any (skb);
821 return;
822 }
823
824 PRINTD (DBG_SKB, "allocated skb at %p, head %p, area %li",
825 skb, skb->head, (long) (skb_end_pointer(skb) - skb->head));
826 rx.handle = virt_to_bus (skb);
827 rx.host_address = cpu_to_be32 (virt_to_bus (skb->data));
828 if (rx_give (dev, &rx, pool))
829 dev_kfree_skb_any (skb);
830
831 }
832
833 return;
834}
835
836
837static void fill_rx_pools (amb_dev * dev) {
838 unsigned char pool;
839
840 PRINTD (DBG_FLOW|DBG_POOL, "fill_rx_pools %p", dev);
841
842 for (pool = 0; pool < NUM_RX_POOLS; ++pool)
843 fill_rx_pool (dev, pool, GFP_ATOMIC);
844
845 return;
846}
847
848
849
850static void interrupts_on (amb_dev * dev) {
851 wr_plain (dev, offsetof(amb_mem, interrupt_control),
852 rd_plain (dev, offsetof(amb_mem, interrupt_control))
853 | AMB_INTERRUPT_BITS);
854}
855
856
857
858static void interrupts_off (amb_dev * dev) {
859 wr_plain (dev, offsetof(amb_mem, interrupt_control),
860 rd_plain (dev, offsetof(amb_mem, interrupt_control))
861 &~ AMB_INTERRUPT_BITS);
862}
863
864
865
866static irqreturn_t interrupt_handler(int irq, void *dev_id) {
867 amb_dev * dev = dev_id;
868
869 PRINTD (DBG_IRQ|DBG_FLOW, "interrupt_handler: %p", dev_id);
870
871 {
872 u32 interrupt = rd_plain (dev, offsetof(amb_mem, interrupt));
873
874
875 if (!interrupt) {
876 PRINTD (DBG_IRQ, "irq not for me: %d", irq);
877 return IRQ_NONE;
878 }
879
880
881 PRINTD (DBG_IRQ, "FYI: interrupt was %08x", interrupt);
882 wr_plain (dev, offsetof(amb_mem, interrupt), -1);
883 }
884
885 {
886 unsigned int irq_work = 0;
887 unsigned char pool;
888 for (pool = 0; pool < NUM_RX_POOLS; ++pool)
889 while (!rx_take (dev, pool))
890 ++irq_work;
891 while (!tx_take (dev))
892 ++irq_work;
893
894 if (irq_work) {
895#ifdef FILL_RX_POOLS_IN_BH
896 schedule_work (&dev->bh);
897#else
898 fill_rx_pools (dev);
899#endif
900
901 PRINTD (DBG_IRQ, "work done: %u", irq_work);
902 } else {
903 PRINTD (DBG_IRQ|DBG_WARN, "no work done");
904 }
905 }
906
907 PRINTD (DBG_IRQ|DBG_FLOW, "interrupt_handler done: %p", dev_id);
908 return IRQ_HANDLED;
909}
910
911
912
913static int make_rate (unsigned int rate, rounding r,
914 u16 * bits, unsigned int * actual) {
915 unsigned char exp = -1;
916 unsigned int man = -1;
917
918 PRINTD (DBG_FLOW|DBG_QOS, "make_rate %u", rate);
919
920
921
922
923
924
925
926
927
928
929
930
931
932
933
934 if (rate > 0xffc00000U) {
935
936
937 if (r == round_up) {
938 return -EINVAL;
939 } else {
940 exp = 31;
941 man = 511;
942 }
943
944 } else if (rate) {
945
946
947 exp = 31;
948 man = rate;
949
950
951 while (!(man & (1<<31))) {
952 exp = exp - 1;
953 man = man<<1;
954 }
955
956
957
958
959 man = man<<1;
960 man &= 0xffffffffU;
961
962
963
964
965
966
967
968
969 switch (r) {
970 case round_down: {
971
972 man = man>>(32-9);
973 break;
974 }
975 case round_up: {
976
977 if (man & (~0U>>9)) {
978 man = (man>>(32-9)) + 1;
979 if (man == (1<<9)) {
980
981 man = 0;
982 exp += 1;
983 }
984 } else {
985 man = (man>>(32-9));
986 }
987 break;
988 }
989 case round_nearest: {
990
991 if (man & (1<<(32-9-1))) {
992 man = (man>>(32-9)) + 1;
993 if (man == (1<<9)) {
994
995 man = 0;
996 exp += 1;
997 }
998 } else {
999 man = (man>>(32-9));
1000 }
1001 break;
1002 }
1003 }
1004
1005 } else {
1006
1007
1008 if (r == round_down) {
1009 return -EINVAL;
1010 } else {
1011 exp = 0;
1012 man = 0;
1013 }
1014
1015 }
1016
1017 PRINTD (DBG_QOS, "rate: man=%u, exp=%hu", man, exp);
1018
1019 if (bits)
1020 *bits = (exp<<9) | man;
1021
1022 if (actual)
1023 *actual = (exp >= 9)
1024 ? (1 << exp) + (man << (exp-9))
1025 : (1 << exp) + ((man + (1<<(9-exp-1))) >> (9-exp));
1026
1027 return 0;
1028}
1029
1030
1031
1032
1033
1034
1035
1036
1037static int amb_open (struct atm_vcc * atm_vcc)
1038{
1039 int error;
1040
1041 struct atm_qos * qos;
1042 struct atm_trafprm * txtp;
1043 struct atm_trafprm * rxtp;
1044 u16 tx_rate_bits = -1;
1045 u16 tx_vc_bits = -1;
1046 u16 tx_frame_bits = -1;
1047
1048 amb_dev * dev = AMB_DEV(atm_vcc->dev);
1049 amb_vcc * vcc;
1050 unsigned char pool = -1;
1051 short vpi = atm_vcc->vpi;
1052 int vci = atm_vcc->vci;
1053
1054 PRINTD (DBG_FLOW|DBG_VCC, "amb_open %x %x", vpi, vci);
1055
1056#ifdef ATM_VPI_UNSPEC
1057
1058 if (vpi == ATM_VPI_UNSPEC || vci == ATM_VCI_UNSPEC) {
1059 PRINTK (KERN_WARNING, "rejecting open with unspecified VPI/VCI (deprecated)");
1060 return -EINVAL;
1061 }
1062#endif
1063
1064 if (!(0 <= vpi && vpi < (1<<NUM_VPI_BITS) &&
1065 0 <= vci && vci < (1<<NUM_VCI_BITS))) {
1066 PRINTD (DBG_WARN|DBG_VCC, "VPI/VCI out of range: %hd/%d", vpi, vci);
1067 return -EINVAL;
1068 }
1069
1070 qos = &atm_vcc->qos;
1071
1072 if (qos->aal != ATM_AAL5) {
1073 PRINTD (DBG_QOS, "AAL not supported");
1074 return -EINVAL;
1075 }
1076
1077
1078
1079 PRINTD (DBG_QOS, "TX:");
1080 txtp = &qos->txtp;
1081 if (txtp->traffic_class != ATM_NONE) {
1082 switch (txtp->traffic_class) {
1083 case ATM_UBR: {
1084
1085 int pcr = atm_pcr_goal (txtp);
1086 if (!pcr) {
1087
1088 tx_rate_bits = 0;
1089 tx_vc_bits = TX_UBR;
1090 tx_frame_bits = TX_FRAME_NOTCAP;
1091 } else {
1092 rounding r;
1093 if (pcr < 0) {
1094 r = round_down;
1095 pcr = -pcr;
1096 } else {
1097 r = round_up;
1098 }
1099 error = make_rate (pcr, r, &tx_rate_bits, NULL);
1100 if (error)
1101 return error;
1102 tx_vc_bits = TX_UBR_CAPPED;
1103 tx_frame_bits = TX_FRAME_CAPPED;
1104 }
1105 break;
1106 }
1107#if 0
1108 case ATM_ABR: {
1109 pcr = atm_pcr_goal (txtp);
1110 PRINTD (DBG_QOS, "pcr goal = %d", pcr);
1111 break;
1112 }
1113#endif
1114 default: {
1115
1116 PRINTD (DBG_QOS, "request for non-UBR denied");
1117 return -EINVAL;
1118 }
1119 }
1120 PRINTD (DBG_QOS, "tx_rate_bits=%hx, tx_vc_bits=%hx",
1121 tx_rate_bits, tx_vc_bits);
1122 }
1123
1124 PRINTD (DBG_QOS, "RX:");
1125 rxtp = &qos->rxtp;
1126 if (rxtp->traffic_class == ATM_NONE) {
1127
1128 } else {
1129
1130 for (pool = 0; pool < NUM_RX_POOLS; ++pool)
1131 if ((unsigned int) rxtp->max_sdu <= dev->rxq[pool].buffer_size) {
1132 PRINTD (DBG_VCC|DBG_QOS|DBG_POOL, "chose pool %hu (max_sdu %u <= %u)",
1133 pool, rxtp->max_sdu, dev->rxq[pool].buffer_size);
1134 break;
1135 }
1136 if (pool == NUM_RX_POOLS) {
1137 PRINTD (DBG_WARN|DBG_VCC|DBG_QOS|DBG_POOL,
1138 "no pool suitable for VC (RX max_sdu %d is too large)",
1139 rxtp->max_sdu);
1140 return -EINVAL;
1141 }
1142
1143 switch (rxtp->traffic_class) {
1144 case ATM_UBR: {
1145 break;
1146 }
1147#if 0
1148 case ATM_ABR: {
1149 pcr = atm_pcr_goal (rxtp);
1150 PRINTD (DBG_QOS, "pcr goal = %d", pcr);
1151 break;
1152 }
1153#endif
1154 default: {
1155
1156 PRINTD (DBG_QOS, "request for non-UBR denied");
1157 return -EINVAL;
1158 }
1159 }
1160 }
1161
1162
1163 vcc = kmalloc (sizeof(amb_vcc), GFP_KERNEL);
1164 if (!vcc) {
1165 PRINTK (KERN_ERR, "out of memory!");
1166 return -ENOMEM;
1167 }
1168 atm_vcc->dev_data = (void *) vcc;
1169
1170
1171
1172
1173
1174 set_bit(ATM_VF_ADDR,&atm_vcc->flags);
1175
1176 if (txtp->traffic_class != ATM_NONE) {
1177 command cmd;
1178
1179 vcc->tx_frame_bits = tx_frame_bits;
1180
1181 mutex_lock(&dev->vcc_sf);
1182 if (dev->rxer[vci]) {
1183
1184 cmd.request = cpu_to_be32 (SRB_MODIFY_VC_RATE);
1185 cmd.args.modify_rate.vc = cpu_to_be32 (vci);
1186 cmd.args.modify_rate.rate = cpu_to_be32 (tx_rate_bits << SRB_RATE_SHIFT);
1187 while (command_do (dev, &cmd))
1188 schedule();
1189
1190 cmd.request = cpu_to_be32 (SRB_MODIFY_VC_FLAGS);
1191 cmd.args.modify_flags.vc = cpu_to_be32 (vci);
1192 cmd.args.modify_flags.flags = cpu_to_be32
1193 ( (AMB_VCC(dev->rxer[vci])->rx_info.pool << SRB_POOL_SHIFT)
1194 | (tx_vc_bits << SRB_FLAGS_SHIFT) );
1195 while (command_do (dev, &cmd))
1196 schedule();
1197 } else {
1198
1199 cmd.request = cpu_to_be32 (SRB_OPEN_VC);
1200 cmd.args.open.vc = cpu_to_be32 (vci);
1201 cmd.args.open.flags = cpu_to_be32 (tx_vc_bits << SRB_FLAGS_SHIFT);
1202 cmd.args.open.rate = cpu_to_be32 (tx_rate_bits << SRB_RATE_SHIFT);
1203 while (command_do (dev, &cmd))
1204 schedule();
1205 }
1206 dev->txer[vci].tx_present = 1;
1207 mutex_unlock(&dev->vcc_sf);
1208 }
1209
1210 if (rxtp->traffic_class != ATM_NONE) {
1211 command cmd;
1212
1213 vcc->rx_info.pool = pool;
1214
1215 mutex_lock(&dev->vcc_sf);
1216
1217 if (!dev->rxq[pool].buffers_wanted)
1218 dev->rxq[pool].buffers_wanted = rx_lats;
1219 dev->rxq[pool].buffers_wanted += 1;
1220 fill_rx_pool (dev, pool, GFP_KERNEL);
1221
1222 if (dev->txer[vci].tx_present) {
1223
1224
1225 cmd.request = cpu_to_be32 (SRB_MODIFY_VC_FLAGS);
1226 cmd.args.modify_flags.vc = cpu_to_be32 (vci);
1227 cmd.args.modify_flags.flags = cpu_to_be32
1228 ( (pool << SRB_POOL_SHIFT)
1229 | (dev->txer[vci].tx_vc_bits << SRB_FLAGS_SHIFT) );
1230 } else {
1231
1232 cmd.request = cpu_to_be32 (SRB_OPEN_VC);
1233 cmd.args.open.vc = cpu_to_be32 (vci);
1234 cmd.args.open.flags = cpu_to_be32 (pool << SRB_POOL_SHIFT);
1235 cmd.args.open.rate = cpu_to_be32 (0);
1236 }
1237 while (command_do (dev, &cmd))
1238 schedule();
1239
1240 dev->rxer[vci] = atm_vcc;
1241 mutex_unlock(&dev->vcc_sf);
1242 }
1243
1244
1245 set_bit(ATM_VF_READY,&atm_vcc->flags);
1246
1247 return 0;
1248}
1249
1250
1251
1252static void amb_close (struct atm_vcc * atm_vcc) {
1253 amb_dev * dev = AMB_DEV (atm_vcc->dev);
1254 amb_vcc * vcc = AMB_VCC (atm_vcc);
1255 u16 vci = atm_vcc->vci;
1256
1257 PRINTD (DBG_VCC|DBG_FLOW, "amb_close");
1258
1259
1260 clear_bit(ATM_VF_READY,&atm_vcc->flags);
1261
1262
1263 if (atm_vcc->qos.txtp.traffic_class != ATM_NONE) {
1264 command cmd;
1265
1266 mutex_lock(&dev->vcc_sf);
1267 if (dev->rxer[vci]) {
1268
1269 cmd.request = cpu_to_be32 (SRB_MODIFY_VC_RATE);
1270 cmd.args.modify_rate.vc = cpu_to_be32 (vci);
1271 cmd.args.modify_rate.rate = cpu_to_be32 (0);
1272
1273 } else {
1274
1275 cmd.request = cpu_to_be32 (SRB_CLOSE_VC);
1276 cmd.args.close.vc = cpu_to_be32 (vci);
1277 }
1278 dev->txer[vci].tx_present = 0;
1279 while (command_do (dev, &cmd))
1280 schedule();
1281 mutex_unlock(&dev->vcc_sf);
1282 }
1283
1284
1285 if (atm_vcc->qos.rxtp.traffic_class != ATM_NONE) {
1286 command cmd;
1287
1288
1289 unsigned char pool = vcc->rx_info.pool;
1290
1291 mutex_lock(&dev->vcc_sf);
1292 if (dev->txer[vci].tx_present) {
1293
1294 cmd.request = cpu_to_be32 (SRB_MODIFY_VC_FLAGS);
1295 cmd.args.modify_flags.vc = cpu_to_be32 (vci);
1296 cmd.args.modify_flags.flags = cpu_to_be32
1297 (dev->txer[vci].tx_vc_bits << SRB_FLAGS_SHIFT);
1298 } else {
1299
1300 cmd.request = cpu_to_be32 (SRB_CLOSE_VC);
1301 cmd.args.close.vc = cpu_to_be32 (vci);
1302 }
1303
1304 if (atm_vcc != dev->rxer[vci])
1305 PRINTK (KERN_ERR, "%s vcc=%p rxer[vci]=%p",
1306 "arghhh! we're going to die!",
1307 vcc, dev->rxer[vci]);
1308 dev->rxer[vci] = NULL;
1309 while (command_do (dev, &cmd))
1310 schedule();
1311
1312
1313 dev->rxq[pool].buffers_wanted -= 1;
1314 if (dev->rxq[pool].buffers_wanted == rx_lats) {
1315 dev->rxq[pool].buffers_wanted = 0;
1316 drain_rx_pool (dev, pool);
1317 }
1318 mutex_unlock(&dev->vcc_sf);
1319 }
1320
1321
1322 kfree (vcc);
1323
1324
1325 clear_bit(ATM_VF_ADDR,&atm_vcc->flags);
1326
1327 return;
1328}
1329
1330
1331
1332
1333
1334
1335
1336
1337
1338
1339
1340static int amb_send (struct atm_vcc * atm_vcc, struct sk_buff * skb) {
1341 amb_dev * dev = AMB_DEV(atm_vcc->dev);
1342 amb_vcc * vcc = AMB_VCC(atm_vcc);
1343 u16 vc = atm_vcc->vci;
1344 unsigned int tx_len = skb->len;
1345 unsigned char * tx_data = skb->data;
1346 tx_simple * tx_descr;
1347 tx_in tx;
1348
1349 if (test_bit (dead, &dev->flags))
1350 return -EIO;
1351
1352 PRINTD (DBG_FLOW|DBG_TX, "amb_send vc %x data %p len %u",
1353 vc, tx_data, tx_len);
1354
1355 dump_skb (">>>", vc, skb);
1356
1357 if (!dev->txer[vc].tx_present) {
1358 PRINTK (KERN_ERR, "attempt to send on RX-only VC %x", vc);
1359 return -EBADFD;
1360 }
1361
1362
1363
1364
1365 ATM_SKB(skb)->vcc = atm_vcc;
1366
1367 if (skb->len > (size_t) atm_vcc->qos.txtp.max_sdu) {
1368 PRINTK (KERN_ERR, "sk_buff length greater than agreed max_sdu, dropping...");
1369 return -EIO;
1370 }
1371
1372 if (check_area (skb->data, skb->len)) {
1373 atomic_inc(&atm_vcc->stats->tx_err);
1374 return -ENOMEM;
1375 }
1376
1377
1378 tx_descr = kmalloc (sizeof(tx_simple), GFP_KERNEL);
1379 if (!tx_descr) {
1380 PRINTK (KERN_ERR, "could not allocate TX descriptor");
1381 return -ENOMEM;
1382 }
1383 if (check_area (tx_descr, sizeof(tx_simple))) {
1384 kfree (tx_descr);
1385 return -ENOMEM;
1386 }
1387 PRINTD (DBG_TX, "fragment list allocated at %p", tx_descr);
1388
1389 tx_descr->skb = skb;
1390
1391 tx_descr->tx_frag.bytes = cpu_to_be32 (tx_len);
1392 tx_descr->tx_frag.address = cpu_to_be32 (virt_to_bus (tx_data));
1393
1394 tx_descr->tx_frag_end.handle = virt_to_bus (tx_descr);
1395 tx_descr->tx_frag_end.vc = 0;
1396 tx_descr->tx_frag_end.next_descriptor_length = 0;
1397 tx_descr->tx_frag_end.next_descriptor = 0;
1398#ifdef AMB_NEW_MICROCODE
1399 tx_descr->tx_frag_end.cpcs_uu = 0;
1400 tx_descr->tx_frag_end.cpi = 0;
1401 tx_descr->tx_frag_end.pad = 0;
1402#endif
1403
1404 tx.vc = cpu_to_be16 (vcc->tx_frame_bits | vc);
1405 tx.tx_descr_length = cpu_to_be16 (sizeof(tx_frag)+sizeof(tx_frag_end));
1406 tx.tx_descr_addr = cpu_to_be32 (virt_to_bus (&tx_descr->tx_frag));
1407
1408 while (tx_give (dev, &tx))
1409 schedule();
1410 return 0;
1411}
1412
1413
1414
1415
1416
1417
1418
1419#if 0
1420static void amb_free_rx_skb (struct atm_vcc * atm_vcc, struct sk_buff * skb) {
1421 amb_dev * dev = AMB_DEV (atm_vcc->dev);
1422 amb_vcc * vcc = AMB_VCC (atm_vcc);
1423 unsigned char pool = vcc->rx_info.pool;
1424 rx_in rx;
1425
1426
1427
1428
1429
1430
1431 PRINTD (DBG_FLOW|DBG_SKB, "amb_rx_free skb %p (atm_vcc %p, vcc %p)",
1432 skb, atm_vcc, vcc);
1433
1434 rx.handle = virt_to_bus (skb);
1435 rx.host_address = cpu_to_be32 (virt_to_bus (skb->data));
1436
1437 skb->data = skb->head;
1438 skb->tail = skb->head;
1439 skb->len = 0;
1440
1441 if (!rx_give (dev, &rx, pool)) {
1442
1443 PRINTD (DBG_SKB|DBG_POOL, "recycled skb for pool %hu", pool);
1444 return;
1445 }
1446
1447
1448 dev_kfree_skb_any (skb);
1449
1450 return;
1451}
1452#endif
1453
1454
1455
1456static int amb_proc_read (struct atm_dev * atm_dev, loff_t * pos, char * page) {
1457 amb_dev * dev = AMB_DEV (atm_dev);
1458 int left = *pos;
1459 unsigned char pool;
1460
1461 PRINTD (DBG_FLOW, "amb_proc_read");
1462
1463
1464
1465 if (!left--) {
1466 amb_stats * s = &dev->stats;
1467 return sprintf (page,
1468 "frames: TX OK %lu, RX OK %lu, RX bad %lu "
1469 "(CRC %lu, long %lu, aborted %lu, unused %lu).\n",
1470 s->tx_ok, s->rx.ok, s->rx.error,
1471 s->rx.badcrc, s->rx.toolong,
1472 s->rx.aborted, s->rx.unused);
1473 }
1474
1475 if (!left--) {
1476 amb_cq * c = &dev->cq;
1477 return sprintf (page, "cmd queue [cur/hi/max]: %u/%u/%u. ",
1478 c->pending, c->high, c->maximum);
1479 }
1480
1481 if (!left--) {
1482 amb_txq * t = &dev->txq;
1483 return sprintf (page, "TX queue [cur/max high full]: %u/%u %u %u.\n",
1484 t->pending, t->maximum, t->high, t->filled);
1485 }
1486
1487 if (!left--) {
1488 unsigned int count = sprintf (page, "RX queues [cur/max/req low empty]:");
1489 for (pool = 0; pool < NUM_RX_POOLS; ++pool) {
1490 amb_rxq * r = &dev->rxq[pool];
1491 count += sprintf (page+count, " %u/%u/%u %u %u",
1492 r->pending, r->maximum, r->buffers_wanted, r->low, r->emptied);
1493 }
1494 count += sprintf (page+count, ".\n");
1495 return count;
1496 }
1497
1498 if (!left--) {
1499 unsigned int count = sprintf (page, "RX buffer sizes:");
1500 for (pool = 0; pool < NUM_RX_POOLS; ++pool) {
1501 amb_rxq * r = &dev->rxq[pool];
1502 count += sprintf (page+count, " %u", r->buffer_size);
1503 }
1504 count += sprintf (page+count, ".\n");
1505 return count;
1506 }
1507
1508#if 0
1509 if (!left--) {
1510
1511 }
1512#endif
1513
1514 return 0;
1515}
1516
1517
1518
1519static const struct atmdev_ops amb_ops = {
1520 .open = amb_open,
1521 .close = amb_close,
1522 .send = amb_send,
1523 .proc_read = amb_proc_read,
1524 .owner = THIS_MODULE,
1525};
1526
1527
1528static void do_housekeeping (unsigned long arg) {
1529 amb_dev * dev = (amb_dev *) arg;
1530
1531
1532
1533
1534 fill_rx_pools (dev);
1535 mod_timer(&dev->housekeeping, jiffies + 10*HZ);
1536
1537 return;
1538}
1539
1540
1541
1542static int __devinit create_queues (amb_dev * dev, unsigned int cmds,
1543 unsigned int txs, unsigned int * rxs,
1544 unsigned int * rx_buffer_sizes) {
1545 unsigned char pool;
1546 size_t total = 0;
1547 void * memory;
1548 void * limit;
1549
1550 PRINTD (DBG_FLOW, "create_queues %p", dev);
1551
1552 total += cmds * sizeof(command);
1553
1554 total += txs * (sizeof(tx_in) + sizeof(tx_out));
1555
1556 for (pool = 0; pool < NUM_RX_POOLS; ++pool)
1557 total += rxs[pool] * (sizeof(rx_in) + sizeof(rx_out));
1558
1559 memory = kmalloc (total, GFP_KERNEL);
1560 if (!memory) {
1561 PRINTK (KERN_ERR, "could not allocate queues");
1562 return -ENOMEM;
1563 }
1564 if (check_area (memory, total)) {
1565 PRINTK (KERN_ERR, "queues allocated in nasty area");
1566 kfree (memory);
1567 return -ENOMEM;
1568 }
1569
1570 limit = memory + total;
1571 PRINTD (DBG_INIT, "queues from %p to %p", memory, limit);
1572
1573 PRINTD (DBG_CMD, "command queue at %p", memory);
1574
1575 {
1576 command * cmd = memory;
1577 amb_cq * cq = &dev->cq;
1578
1579 cq->pending = 0;
1580 cq->high = 0;
1581 cq->maximum = cmds - 1;
1582
1583 cq->ptrs.start = cmd;
1584 cq->ptrs.in = cmd;
1585 cq->ptrs.out = cmd;
1586 cq->ptrs.limit = cmd + cmds;
1587
1588 memory = cq->ptrs.limit;
1589 }
1590
1591 PRINTD (DBG_TX, "TX queue pair at %p", memory);
1592
1593 {
1594 tx_in * in = memory;
1595 tx_out * out;
1596 amb_txq * txq = &dev->txq;
1597
1598 txq->pending = 0;
1599 txq->high = 0;
1600 txq->filled = 0;
1601 txq->maximum = txs - 1;
1602
1603 txq->in.start = in;
1604 txq->in.ptr = in;
1605 txq->in.limit = in + txs;
1606
1607 memory = txq->in.limit;
1608 out = memory;
1609
1610 txq->out.start = out;
1611 txq->out.ptr = out;
1612 txq->out.limit = out + txs;
1613
1614 memory = txq->out.limit;
1615 }
1616
1617 PRINTD (DBG_RX, "RX queue pairs at %p", memory);
1618
1619 for (pool = 0; pool < NUM_RX_POOLS; ++pool) {
1620 rx_in * in = memory;
1621 rx_out * out;
1622 amb_rxq * rxq = &dev->rxq[pool];
1623
1624 rxq->buffer_size = rx_buffer_sizes[pool];
1625 rxq->buffers_wanted = 0;
1626
1627 rxq->pending = 0;
1628 rxq->low = rxs[pool] - 1;
1629 rxq->emptied = 0;
1630 rxq->maximum = rxs[pool] - 1;
1631
1632 rxq->in.start = in;
1633 rxq->in.ptr = in;
1634 rxq->in.limit = in + rxs[pool];
1635
1636 memory = rxq->in.limit;
1637 out = memory;
1638
1639 rxq->out.start = out;
1640 rxq->out.ptr = out;
1641 rxq->out.limit = out + rxs[pool];
1642
1643 memory = rxq->out.limit;
1644 }
1645
1646 if (memory == limit) {
1647 return 0;
1648 } else {
1649 PRINTK (KERN_ERR, "bad queue alloc %p != %p (tell maintainer)", memory, limit);
1650 kfree (limit - total);
1651 return -ENOMEM;
1652 }
1653
1654}
1655
1656
1657
1658static void destroy_queues (amb_dev * dev) {
1659
1660 void * memory = dev->cq.ptrs.start;
1661
1662
1663 PRINTD (DBG_FLOW, "destroy_queues %p", dev);
1664
1665 PRINTD (DBG_INIT, "freeing queues at %p", memory);
1666 kfree (memory);
1667
1668 return;
1669}
1670
1671
1672
1673static unsigned int command_timeouts [] = {
1674 [host_memory_test] = 15,
1675 [read_adapter_memory] = 2,
1676 [write_adapter_memory] = 2,
1677 [adapter_start] = 50,
1678 [get_version_number] = 10,
1679 [interrupt_host] = 1,
1680 [flash_erase_sector] = 1,
1681 [adap_download_block] = 1,
1682 [adap_erase_flash] = 1,
1683 [adap_run_in_iram] = 1,
1684 [adap_end_download] = 1
1685};
1686
1687
1688static unsigned int command_successes [] = {
1689 [host_memory_test] = COMMAND_PASSED_TEST,
1690 [read_adapter_memory] = COMMAND_READ_DATA_OK,
1691 [write_adapter_memory] = COMMAND_WRITE_DATA_OK,
1692 [adapter_start] = COMMAND_COMPLETE,
1693 [get_version_number] = COMMAND_COMPLETE,
1694 [interrupt_host] = COMMAND_COMPLETE,
1695 [flash_erase_sector] = COMMAND_COMPLETE,
1696 [adap_download_block] = COMMAND_COMPLETE,
1697 [adap_erase_flash] = COMMAND_COMPLETE,
1698 [adap_run_in_iram] = COMMAND_COMPLETE,
1699 [adap_end_download] = COMMAND_COMPLETE
1700};
1701
1702static int decode_loader_result (loader_command cmd, u32 result)
1703{
1704 int res;
1705 const char *msg;
1706
1707 if (result == command_successes[cmd])
1708 return 0;
1709
1710 switch (result) {
1711 case BAD_COMMAND:
1712 res = -EINVAL;
1713 msg = "bad command";
1714 break;
1715 case COMMAND_IN_PROGRESS:
1716 res = -ETIMEDOUT;
1717 msg = "command in progress";
1718 break;
1719 case COMMAND_PASSED_TEST:
1720 res = 0;
1721 msg = "command passed test";
1722 break;
1723 case COMMAND_FAILED_TEST:
1724 res = -EIO;
1725 msg = "command failed test";
1726 break;
1727 case COMMAND_READ_DATA_OK:
1728 res = 0;
1729 msg = "command read data ok";
1730 break;
1731 case COMMAND_READ_BAD_ADDRESS:
1732 res = -EINVAL;
1733 msg = "command read bad address";
1734 break;
1735 case COMMAND_WRITE_DATA_OK:
1736 res = 0;
1737 msg = "command write data ok";
1738 break;
1739 case COMMAND_WRITE_BAD_ADDRESS:
1740 res = -EINVAL;
1741 msg = "command write bad address";
1742 break;
1743 case COMMAND_WRITE_FLASH_FAILURE:
1744 res = -EIO;
1745 msg = "command write flash failure";
1746 break;
1747 case COMMAND_COMPLETE:
1748 res = 0;
1749 msg = "command complete";
1750 break;
1751 case COMMAND_FLASH_ERASE_FAILURE:
1752 res = -EIO;
1753 msg = "command flash erase failure";
1754 break;
1755 case COMMAND_WRITE_BAD_DATA:
1756 res = -EINVAL;
1757 msg = "command write bad data";
1758 break;
1759 default:
1760 res = -EINVAL;
1761 msg = "unknown error";
1762 PRINTD (DBG_LOAD|DBG_ERR,
1763 "decode_loader_result got %d=%x !",
1764 result, result);
1765 break;
1766 }
1767
1768 PRINTK (KERN_ERR, "%s", msg);
1769 return res;
1770}
1771
1772static int __devinit do_loader_command (volatile loader_block * lb,
1773 const amb_dev * dev, loader_command cmd) {
1774
1775 unsigned long timeout;
1776
1777 PRINTD (DBG_FLOW|DBG_LOAD, "do_loader_command");
1778
1779
1780
1781
1782
1783
1784
1785
1786
1787
1788 lb->result = 0;
1789 lb->command = cpu_to_be32 (cmd);
1790 lb->valid = cpu_to_be32 (DMA_VALID);
1791
1792
1793 wr_mem (dev, offsetof(amb_mem, doorbell), virt_to_bus (lb) & ~onegigmask);
1794
1795 timeout = command_timeouts[cmd] * 10;
1796
1797 while (!lb->result || lb->result == cpu_to_be32 (COMMAND_IN_PROGRESS))
1798 if (timeout) {
1799 timeout = msleep_interruptible(timeout);
1800 } else {
1801 PRINTD (DBG_LOAD|DBG_ERR, "command %d timed out", cmd);
1802 dump_registers (dev);
1803 dump_loader_block (lb);
1804 return -ETIMEDOUT;
1805 }
1806
1807 if (cmd == adapter_start) {
1808
1809 timeout = 100;
1810 while (rd_plain (dev, offsetof(amb_mem, doorbell)))
1811 if (timeout) {
1812 timeout = msleep_interruptible(timeout);
1813 } else {
1814 PRINTD (DBG_LOAD|DBG_ERR, "start command did not clear doorbell, res=%08x",
1815 be32_to_cpu (lb->result));
1816 dump_registers (dev);
1817 return -ETIMEDOUT;
1818 }
1819 return 0;
1820 } else {
1821 return decode_loader_result (cmd, be32_to_cpu (lb->result));
1822 }
1823
1824}
1825
1826
1827
1828static int __devinit get_loader_version (loader_block * lb,
1829 const amb_dev * dev, u32 * version) {
1830 int res;
1831
1832 PRINTD (DBG_FLOW|DBG_LOAD, "get_loader_version");
1833
1834 res = do_loader_command (lb, dev, get_version_number);
1835 if (res)
1836 return res;
1837 if (version)
1838 *version = be32_to_cpu (lb->payload.version);
1839 return 0;
1840}
1841
1842
1843
1844static int __devinit loader_write (loader_block * lb,
1845 const amb_dev * dev, const u32 * data,
1846 u32 address, unsigned int count) {
1847 unsigned int i;
1848 transfer_block * tb = &lb->payload.transfer;
1849
1850 PRINTD (DBG_FLOW|DBG_LOAD, "loader_write");
1851
1852 if (count > MAX_TRANSFER_DATA)
1853 return -EINVAL;
1854 tb->address = cpu_to_be32 (address);
1855 tb->count = cpu_to_be32 (count);
1856 for (i = 0; i < count; ++i)
1857 tb->data[i] = cpu_to_be32 (data[i]);
1858 return do_loader_command (lb, dev, write_adapter_memory);
1859}
1860
1861
1862
1863static int __devinit loader_verify (loader_block * lb,
1864 const amb_dev * dev, const u32 * data,
1865 u32 address, unsigned int count) {
1866 unsigned int i;
1867 transfer_block * tb = &lb->payload.transfer;
1868 int res;
1869
1870 PRINTD (DBG_FLOW|DBG_LOAD, "loader_verify");
1871
1872 if (count > MAX_TRANSFER_DATA)
1873 return -EINVAL;
1874 tb->address = cpu_to_be32 (address);
1875 tb->count = cpu_to_be32 (count);
1876 res = do_loader_command (lb, dev, read_adapter_memory);
1877 if (!res)
1878 for (i = 0; i < count; ++i)
1879 if (tb->data[i] != cpu_to_be32 (data[i])) {
1880 res = -EINVAL;
1881 break;
1882 }
1883 return res;
1884}
1885
1886
1887
1888static int __devinit loader_start (loader_block * lb,
1889 const amb_dev * dev, u32 address) {
1890 PRINTD (DBG_FLOW|DBG_LOAD, "loader_start");
1891
1892 lb->payload.start = cpu_to_be32 (address);
1893 return do_loader_command (lb, dev, adapter_start);
1894}
1895
1896
1897
1898static inline void sf (const char * msg)
1899{
1900 PRINTK (KERN_ERR, "self-test failed: %s", msg);
1901}
1902
1903static int amb_reset (amb_dev * dev, int diags) {
1904 u32 word;
1905
1906 PRINTD (DBG_FLOW|DBG_LOAD, "amb_reset");
1907
1908 word = rd_plain (dev, offsetof(amb_mem, reset_control));
1909
1910 wr_plain (dev, offsetof(amb_mem, reset_control), word | AMB_RESET_BITS);
1911
1912 udelay (10);
1913#if 1
1914
1915 wr_plain (dev, offsetof(amb_mem, interrupt_control), AMB_DOORBELL_BITS);
1916
1917 wr_plain (dev, offsetof(amb_mem, interrupt), -1);
1918#endif
1919
1920 wr_plain (dev, offsetof(amb_mem, mb.loader.ready), 0);
1921
1922 wr_plain (dev, offsetof(amb_mem, reset_control), word &~ AMB_RESET_BITS);
1923
1924 if (diags) {
1925 unsigned long timeout;
1926
1927 msleep(4200);
1928
1929 timeout = 500;
1930 while (!rd_plain (dev, offsetof(amb_mem, mb.loader.ready)))
1931 if (timeout) {
1932 timeout = msleep_interruptible(timeout);
1933 } else {
1934 PRINTD (DBG_LOAD|DBG_ERR, "reset timed out");
1935 return -ETIMEDOUT;
1936 }
1937
1938
1939
1940 word = rd_mem (dev, offsetof(amb_mem, mb.loader.result));
1941 if (word & SELF_TEST_FAILURE) {
1942 if (word & GPINT_TST_FAILURE)
1943 sf ("interrupt");
1944 if (word & SUNI_DATA_PATTERN_FAILURE)
1945 sf ("SUNI data pattern");
1946 if (word & SUNI_DATA_BITS_FAILURE)
1947 sf ("SUNI data bits");
1948 if (word & SUNI_UTOPIA_FAILURE)
1949 sf ("SUNI UTOPIA interface");
1950 if (word & SUNI_FIFO_FAILURE)
1951 sf ("SUNI cell buffer FIFO");
1952 if (word & SRAM_FAILURE)
1953 sf ("bad SRAM");
1954
1955 return -EIO;
1956 }
1957
1958 }
1959 return 0;
1960}
1961
1962
1963
1964static int __devinit ucode_init (loader_block * lb, amb_dev * dev) {
1965 unsigned int i = 0;
1966 unsigned int total = 0;
1967 const u32 * pointer = ucode_data;
1968 u32 address;
1969 unsigned int count;
1970 int res;
1971
1972 PRINTD (DBG_FLOW|DBG_LOAD, "ucode_init");
1973
1974 while (address = ucode_regions[i].start,
1975 count = ucode_regions[i].count) {
1976 PRINTD (DBG_LOAD, "starting region (%x, %u)", address, count);
1977 while (count) {
1978 unsigned int words;
1979 if (count <= MAX_TRANSFER_DATA)
1980 words = count;
1981 else
1982 words = MAX_TRANSFER_DATA;
1983 total += words;
1984 res = loader_write (lb, dev, pointer, address, words);
1985 if (res)
1986 return res;
1987 res = loader_verify (lb, dev, pointer, address, words);
1988 if (res)
1989 return res;
1990 count -= words;
1991 address += sizeof(u32) * words;
1992 pointer += words;
1993 }
1994 i += 1;
1995 }
1996 if (*pointer == ATM_POISON) {
1997 return loader_start (lb, dev, ucode_start);
1998 } else {
1999
2000 PRINTD (DBG_LOAD|DBG_ERR,
2001 "offset=%li, *pointer=%x, address=%x, total=%u",
2002 (long) (pointer - ucode_data), *pointer, address, total);
2003 PRINTK (KERN_ERR, "incorrect microcode data");
2004 return -ENOMEM;
2005 }
2006}
2007
2008
2009
2010static inline __be32 bus_addr(void * addr) {
2011 return cpu_to_be32 (virt_to_bus (addr));
2012}
2013
2014static int __devinit amb_talk (amb_dev * dev) {
2015 adap_talk_block a;
2016 unsigned char pool;
2017 unsigned long timeout;
2018
2019 PRINTD (DBG_FLOW, "amb_talk %p", dev);
2020
2021 a.command_start = bus_addr (dev->cq.ptrs.start);
2022 a.command_end = bus_addr (dev->cq.ptrs.limit);
2023 a.tx_start = bus_addr (dev->txq.in.start);
2024 a.tx_end = bus_addr (dev->txq.in.limit);
2025 a.txcom_start = bus_addr (dev->txq.out.start);
2026 a.txcom_end = bus_addr (dev->txq.out.limit);
2027
2028 for (pool = 0; pool < NUM_RX_POOLS; ++pool) {
2029
2030 a.rec_struct[pool].buffer_start = bus_addr (dev->rxq[pool].in.start);
2031 a.rec_struct[pool].buffer_end = bus_addr (dev->rxq[pool].in.limit);
2032 a.rec_struct[pool].rx_start = bus_addr (dev->rxq[pool].out.start);
2033 a.rec_struct[pool].rx_end = bus_addr (dev->rxq[pool].out.limit);
2034 a.rec_struct[pool].buffer_size = cpu_to_be32 (dev->rxq[pool].buffer_size);
2035 }
2036
2037#ifdef AMB_NEW_MICROCODE
2038
2039 a.init_flags = 0;
2040#endif
2041
2042
2043 wr_mem (dev, offsetof(amb_mem, doorbell), virt_to_bus (&a));
2044
2045
2046 msleep(2200);
2047
2048 timeout = 500;
2049 while (rd_plain (dev, offsetof(amb_mem, doorbell)))
2050 if (timeout) {
2051 timeout = msleep_interruptible(timeout);
2052 } else {
2053 PRINTD (DBG_INIT|DBG_ERR, "adapter init timed out");
2054 return -ETIMEDOUT;
2055 }
2056
2057 return 0;
2058}
2059
2060
2061static void __devinit amb_ucode_version (amb_dev * dev) {
2062 u32 major;
2063 u32 minor;
2064 command cmd;
2065 cmd.request = cpu_to_be32 (SRB_GET_VERSION);
2066 while (command_do (dev, &cmd)) {
2067 set_current_state(TASK_UNINTERRUPTIBLE);
2068 schedule();
2069 }
2070 major = be32_to_cpu (cmd.args.version.major);
2071 minor = be32_to_cpu (cmd.args.version.minor);
2072 PRINTK (KERN_INFO, "microcode version is %u.%u", major, minor);
2073}
2074
2075
2076static void __devinit amb_esi (amb_dev * dev, u8 * esi) {
2077 u32 lower4;
2078 u16 upper2;
2079 command cmd;
2080
2081 cmd.request = cpu_to_be32 (SRB_GET_BIA);
2082 while (command_do (dev, &cmd)) {
2083 set_current_state(TASK_UNINTERRUPTIBLE);
2084 schedule();
2085 }
2086 lower4 = be32_to_cpu (cmd.args.bia.lower4);
2087 upper2 = be32_to_cpu (cmd.args.bia.upper2);
2088 PRINTD (DBG_LOAD, "BIA: lower4: %08x, upper2 %04x", lower4, upper2);
2089
2090 if (esi) {
2091 unsigned int i;
2092
2093 PRINTDB (DBG_INIT, "ESI:");
2094 for (i = 0; i < ESI_LEN; ++i) {
2095 if (i < 4)
2096 esi[i] = bitrev8(lower4>>(8*i));
2097 else
2098 esi[i] = bitrev8(upper2>>(8*(i-4)));
2099 PRINTDM (DBG_INIT, " %02x", esi[i]);
2100 }
2101
2102 PRINTDE (DBG_INIT, "");
2103 }
2104
2105 return;
2106}
2107
2108static void fixup_plx_window (amb_dev *dev, loader_block *lb)
2109{
2110
2111 unsigned long blb;
2112 u32 mapreg;
2113 blb = virt_to_bus(lb);
2114
2115 mapreg = rd_plain (dev, offsetof(amb_mem, stuff[10]));
2116 mapreg &= ~onegigmask;
2117 mapreg |= blb & onegigmask;
2118 wr_plain (dev, offsetof(amb_mem, stuff[10]), mapreg);
2119 return;
2120}
2121
2122static int __devinit amb_init (amb_dev * dev)
2123{
2124 loader_block lb;
2125
2126 u32 version;
2127
2128 if (amb_reset (dev, 1)) {
2129 PRINTK (KERN_ERR, "card reset failed!");
2130 } else {
2131 fixup_plx_window (dev, &lb);
2132
2133 if (get_loader_version (&lb, dev, &version)) {
2134 PRINTK (KERN_INFO, "failed to get loader version");
2135 } else {
2136 PRINTK (KERN_INFO, "loader version is %08x", version);
2137
2138 if (ucode_init (&lb, dev)) {
2139 PRINTK (KERN_ERR, "microcode failure");
2140 } else if (create_queues (dev, cmds, txs, rxs, rxs_bs)) {
2141 PRINTK (KERN_ERR, "failed to get memory for queues");
2142 } else {
2143
2144 if (amb_talk (dev)) {
2145 PRINTK (KERN_ERR, "adapter did not accept queues");
2146 } else {
2147
2148 amb_ucode_version (dev);
2149 return 0;
2150
2151 }
2152
2153 destroy_queues (dev);
2154 }
2155
2156 amb_reset (dev, 0);
2157 }
2158
2159 }
2160
2161 return -EINVAL;
2162}
2163
2164static void setup_dev(amb_dev *dev, struct pci_dev *pci_dev)
2165{
2166 unsigned char pool;
2167
2168
2169 dev->pci_dev = pci_dev;
2170 pci_set_drvdata(pci_dev, dev);
2171
2172 dev->iobase = pci_resource_start (pci_dev, 1);
2173 dev->irq = pci_dev->irq;
2174 dev->membase = bus_to_virt(pci_resource_start(pci_dev, 0));
2175
2176
2177 dev->flags = 0;
2178
2179
2180
2181
2182 dev->tx_avail = ATM_OC3_PCR;
2183 dev->rx_avail = ATM_OC3_PCR;
2184
2185#ifdef FILL_RX_POOLS_IN_BH
2186
2187 INIT_WORK(&dev->bh, (void (*)(void *)) fill_rx_pools, dev);
2188#endif
2189
2190
2191
2192 mutex_init(&dev->vcc_sf);
2193
2194
2195
2196
2197 spin_lock_init (&dev->cq.lock);
2198 spin_lock_init (&dev->txq.lock);
2199 for (pool = 0; pool < NUM_RX_POOLS; ++pool)
2200 spin_lock_init (&dev->rxq[pool].lock);
2201}
2202
2203static void setup_pci_dev(struct pci_dev *pci_dev)
2204{
2205 unsigned char lat;
2206
2207
2208 pci_set_master(pci_dev);
2209
2210
2211 pci_read_config_byte (pci_dev, PCI_LATENCY_TIMER, &lat);
2212
2213 if (!pci_lat)
2214 pci_lat = (lat < MIN_PCI_LATENCY) ? MIN_PCI_LATENCY : lat;
2215
2216 if (lat != pci_lat) {
2217 PRINTK (KERN_INFO, "Changing PCI latency timer from %hu to %hu",
2218 lat, pci_lat);
2219 pci_write_config_byte(pci_dev, PCI_LATENCY_TIMER, pci_lat);
2220 }
2221}
2222
2223static int __devinit amb_probe(struct pci_dev *pci_dev, const struct pci_device_id *pci_ent)
2224{
2225 amb_dev * dev;
2226 int err;
2227 unsigned int irq;
2228
2229 err = pci_enable_device(pci_dev);
2230 if (err < 0) {
2231 PRINTK (KERN_ERR, "skipped broken (PLX rev 2) card");
2232 goto out;
2233 }
2234
2235
2236 irq = pci_dev->irq;
2237
2238 if (pci_dev->device == PCI_DEVICE_ID_MADGE_AMBASSADOR_BAD) {
2239 PRINTK (KERN_ERR, "skipped broken (PLX rev 2) card");
2240 err = -EINVAL;
2241 goto out_disable;
2242 }
2243
2244 PRINTD (DBG_INFO, "found Madge ATM adapter (amb) at"
2245 " IO %llx, IRQ %u, MEM %p",
2246 (unsigned long long)pci_resource_start(pci_dev, 1),
2247 irq, bus_to_virt(pci_resource_start(pci_dev, 0)));
2248
2249
2250 err = pci_request_region(pci_dev, 1, DEV_LABEL);
2251 if (err < 0) {
2252 PRINTK (KERN_ERR, "IO range already in use!");
2253 goto out_disable;
2254 }
2255
2256 dev = kzalloc(sizeof(amb_dev), GFP_KERNEL);
2257 if (!dev) {
2258 PRINTK (KERN_ERR, "out of memory!");
2259 err = -ENOMEM;
2260 goto out_release;
2261 }
2262
2263 setup_dev(dev, pci_dev);
2264
2265 err = amb_init(dev);
2266 if (err < 0) {
2267 PRINTK (KERN_ERR, "adapter initialisation failure");
2268 goto out_free;
2269 }
2270
2271 setup_pci_dev(pci_dev);
2272
2273
2274 err = request_irq(irq, interrupt_handler, IRQF_SHARED, DEV_LABEL, dev);
2275 if (err < 0) {
2276 PRINTK (KERN_ERR, "request IRQ failed!");
2277 goto out_reset;
2278 }
2279
2280 dev->atm_dev = atm_dev_register (DEV_LABEL, &amb_ops, -1, NULL);
2281 if (!dev->atm_dev) {
2282 PRINTD (DBG_ERR, "failed to register Madge ATM adapter");
2283 err = -EINVAL;
2284 goto out_free_irq;
2285 }
2286
2287 PRINTD (DBG_INFO, "registered Madge ATM adapter (no. %d) (%p) at %p",
2288 dev->atm_dev->number, dev, dev->atm_dev);
2289 dev->atm_dev->dev_data = (void *) dev;
2290
2291
2292 amb_esi (dev, dev->atm_dev->esi);
2293
2294
2295 dev->atm_dev->ci_range.vpi_bits = NUM_VPI_BITS;
2296 dev->atm_dev->ci_range.vci_bits = NUM_VCI_BITS;
2297
2298 init_timer(&dev->housekeeping);
2299 dev->housekeeping.function = do_housekeeping;
2300 dev->housekeeping.data = (unsigned long) dev;
2301 mod_timer(&dev->housekeeping, jiffies);
2302
2303
2304 interrupts_on (dev);
2305
2306out:
2307 return err;
2308
2309out_free_irq:
2310 free_irq(irq, dev);
2311out_reset:
2312 amb_reset(dev, 0);
2313out_free:
2314 kfree(dev);
2315out_release:
2316 pci_release_region(pci_dev, 1);
2317out_disable:
2318 pci_disable_device(pci_dev);
2319 goto out;
2320}
2321
2322
2323static void __devexit amb_remove_one(struct pci_dev *pci_dev)
2324{
2325 struct amb_dev *dev;
2326
2327 dev = pci_get_drvdata(pci_dev);
2328
2329 PRINTD(DBG_INFO|DBG_INIT, "closing %p (atm_dev = %p)", dev, dev->atm_dev);
2330 del_timer_sync(&dev->housekeeping);
2331
2332 drain_rx_pools(dev);
2333 interrupts_off(dev);
2334 amb_reset(dev, 0);
2335 free_irq(dev->irq, dev);
2336 pci_disable_device(pci_dev);
2337 destroy_queues(dev);
2338 atm_dev_deregister(dev->atm_dev);
2339 kfree(dev);
2340 pci_release_region(pci_dev, 1);
2341}
2342
2343static void __init amb_check_args (void) {
2344 unsigned char pool;
2345 unsigned int max_rx_size;
2346
2347#ifdef DEBUG_AMBASSADOR
2348 PRINTK (KERN_NOTICE, "debug bitmap is %hx", debug &= DBG_MASK);
2349#else
2350 if (debug)
2351 PRINTK (KERN_NOTICE, "no debugging support");
2352#endif
2353
2354 if (cmds < MIN_QUEUE_SIZE)
2355 PRINTK (KERN_NOTICE, "cmds has been raised to %u",
2356 cmds = MIN_QUEUE_SIZE);
2357
2358 if (txs < MIN_QUEUE_SIZE)
2359 PRINTK (KERN_NOTICE, "txs has been raised to %u",
2360 txs = MIN_QUEUE_SIZE);
2361
2362 for (pool = 0; pool < NUM_RX_POOLS; ++pool)
2363 if (rxs[pool] < MIN_QUEUE_SIZE)
2364 PRINTK (KERN_NOTICE, "rxs[%hu] has been raised to %u",
2365 pool, rxs[pool] = MIN_QUEUE_SIZE);
2366
2367
2368 max_rx_size = 0;
2369 for (pool = 0; pool < NUM_RX_POOLS; ++pool)
2370 if (rxs_bs[pool] <= max_rx_size)
2371 PRINTK (KERN_NOTICE, "useless pool (rxs_bs[%hu] = %u)",
2372 pool, rxs_bs[pool]);
2373 else
2374 max_rx_size = rxs_bs[pool];
2375
2376 if (rx_lats < MIN_RX_BUFFERS)
2377 PRINTK (KERN_NOTICE, "rx_lats has been raised to %u",
2378 rx_lats = MIN_RX_BUFFERS);
2379
2380 return;
2381}
2382
2383
2384
2385MODULE_AUTHOR(maintainer_string);
2386MODULE_DESCRIPTION(description_string);
2387MODULE_LICENSE("GPL");
2388module_param(debug, ushort, 0644);
2389module_param(cmds, uint, 0);
2390module_param(txs, uint, 0);
2391module_param_array(rxs, uint, NULL, 0);
2392module_param_array(rxs_bs, uint, NULL, 0);
2393module_param(rx_lats, uint, 0);
2394module_param(pci_lat, byte, 0);
2395MODULE_PARM_DESC(debug, "debug bitmap, see .h file");
2396MODULE_PARM_DESC(cmds, "number of command queue entries");
2397MODULE_PARM_DESC(txs, "number of TX queue entries");
2398MODULE_PARM_DESC(rxs, "number of RX queue entries [" __MODULE_STRING(NUM_RX_POOLS) "]");
2399MODULE_PARM_DESC(rxs_bs, "size of RX buffers [" __MODULE_STRING(NUM_RX_POOLS) "]");
2400MODULE_PARM_DESC(rx_lats, "number of extra buffers to cope with RX latencies");
2401MODULE_PARM_DESC(pci_lat, "PCI latency in bus cycles");
2402
2403
2404
2405static struct pci_device_id amb_pci_tbl[] = {
2406 { PCI_VENDOR_ID_MADGE, PCI_DEVICE_ID_MADGE_AMBASSADOR, PCI_ANY_ID, PCI_ANY_ID,
2407 0, 0, 0 },
2408 { PCI_VENDOR_ID_MADGE, PCI_DEVICE_ID_MADGE_AMBASSADOR_BAD, PCI_ANY_ID, PCI_ANY_ID,
2409 0, 0, 0 },
2410 { 0, }
2411};
2412
2413MODULE_DEVICE_TABLE(pci, amb_pci_tbl);
2414
2415static struct pci_driver amb_driver = {
2416 .name = "amb",
2417 .probe = amb_probe,
2418 .remove = __devexit_p(amb_remove_one),
2419 .id_table = amb_pci_tbl,
2420};
2421
2422static int __init amb_module_init (void)
2423{
2424 PRINTD (DBG_FLOW|DBG_INIT, "init_module");
2425
2426
2427 if (sizeof(amb_mem) != 4*16 + 4*12) {
2428 PRINTK (KERN_ERR, "Fix amb_mem (is %lu words).",
2429 (unsigned long) sizeof(amb_mem));
2430 return -ENOMEM;
2431 }
2432
2433 show_version();
2434
2435 amb_check_args();
2436
2437
2438 return pci_register_driver(&amb_driver);
2439}
2440
2441
2442
2443static void __exit amb_module_exit (void)
2444{
2445 PRINTD (DBG_FLOW|DBG_INIT, "cleanup_module");
2446
2447 pci_unregister_driver(&amb_driver);
2448}
2449
2450module_init(amb_module_init);
2451module_exit(amb_module_exit);
2452