?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Linux 2.6.34-rc3
[pohmelfs.git] / drivers / isdn / hardware / avm / b1dma.c
blob124550d0dbf361f2d28a006f6b9787e83c02685a
1 /* $Id: b1dma.c,v 1.1.2.3 2004/02/10 01:07:12 keil Exp $
2 *
3 * Common module for AVM B1 cards that support dma with AMCC
4 *
5 * Copyright 2000 by Carsten Paeth <calle@calle.de>
6 *
7 * This software may be used and distributed according to the terms
8 * of the GNU General Public License, incorporated herein by reference.
9 *
10 */
11
12 #include <linux/module.h>
13 #include <linux/kernel.h>
14 #include <linux/proc_fs.h>
15 #include <linux/seq_file.h>
16 #include <linux/skbuff.h>
17 #include <linux/delay.h>
18 #include <linux/mm.h>
19 #include <linux/interrupt.h>
20 #include <linux/ioport.h>
21 #include <linux/capi.h>
22 #include <linux/kernelcapi.h>
23 #include <asm/io.h>
24 #include <linux/init.h>
25 #include <asm/uaccess.h>
26 #include <linux/netdevice.h>
27 #include <linux/isdn/capilli.h>
28 #include "avmcard.h"
29 #include <linux/isdn/capicmd.h>
30 #include <linux/isdn/capiutil.h>
31
32 static char *revision = "$Revision: 1.1.2.3 $";
33
34 #undef AVM_B1DMA_DEBUG
35
36 /* ------------------------------------------------------------- */
37
38 MODULE_DESCRIPTION("CAPI4Linux: DMA support for active AVM cards");
39 MODULE_AUTHOR("Carsten Paeth");
40 MODULE_LICENSE("GPL");
41
42 static int suppress_pollack = 0;
43 module_param(suppress_pollack, bool, 0);
44
45 /* ------------------------------------------------------------- */
46
47 static void b1dma_dispatch_tx(avmcard *card);
48
49 /* ------------------------------------------------------------- */
50
51 /* S5933 */
52
53 #define AMCC_RXPTR 0x24
54 #define AMCC_RXLEN 0x28
55 #define AMCC_TXPTR 0x2c
56 #define AMCC_TXLEN 0x30
57
58 #define AMCC_INTCSR 0x38
59 # define EN_READ_TC_INT 0x00008000L
60 # define EN_WRITE_TC_INT 0x00004000L
61 # define EN_TX_TC_INT EN_READ_TC_INT
62 # define EN_RX_TC_INT EN_WRITE_TC_INT
63 # define AVM_FLAG 0x30000000L
64
65 # define ANY_S5933_INT 0x00800000L
66 # define READ_TC_INT 0x00080000L
67 # define WRITE_TC_INT 0x00040000L
68 # define TX_TC_INT READ_TC_INT
69 # define RX_TC_INT WRITE_TC_INT
70 # define MASTER_ABORT_INT 0x00100000L
71 # define TARGET_ABORT_INT 0x00200000L
72 # define BUS_MASTER_INT 0x00200000L
73 # define ALL_INT 0x000C0000L
74
75 #define AMCC_MCSR 0x3c
76 # define A2P_HI_PRIORITY 0x00000100L
77 # define EN_A2P_TRANSFERS 0x00000400L
78 # define P2A_HI_PRIORITY 0x00001000L
79 # define EN_P2A_TRANSFERS 0x00004000L
80 # define RESET_A2P_FLAGS 0x04000000L
81 # define RESET_P2A_FLAGS 0x02000000L
82
83 /* ------------------------------------------------------------- */
84
85 static inline void b1dma_writel(avmcard *card, u32 value, int off)
86 {
87 writel(value, card->mbase + off);
88 }
89
90 static inline u32 b1dma_readl(avmcard *card, int off)
91 {
92 return readl(card->mbase + off);
93 }
94
95 /* ------------------------------------------------------------- */
96
97 static inline int b1dma_tx_empty(unsigned int port)
98 {
99 return inb(port + 0x03) & 0x1;
100 }
101
102 static inline int b1dma_rx_full(unsigned int port)
103 {
104 return inb(port + 0x02) & 0x1;
105 }
106
107 static int b1dma_tolink(avmcard *card, void *buf, unsigned int len)
108 {
109 unsigned long stop = jiffies + 1 * HZ; /* maximum wait time 1 sec */
110 unsigned char *s = (unsigned char *)buf;
111 while (len--) {
112 while ( !b1dma_tx_empty(card->port)
113 && time_before(jiffies, stop));
114 if (!b1dma_tx_empty(card->port))
115 return -1;
116 t1outp(card->port, 0x01, *s++);
117 }
118 return 0;
119 }
120
121 static int b1dma_fromlink(avmcard *card, void *buf, unsigned int len)
122 {
123 unsigned long stop = jiffies + 1 * HZ; /* maximum wait time 1 sec */
124 unsigned char *s = (unsigned char *)buf;
125 while (len--) {
126 while ( !b1dma_rx_full(card->port)
127 && time_before(jiffies, stop));
128 if (!b1dma_rx_full(card->port))
129 return -1;
130 *s++ = t1inp(card->port, 0x00);
131 }
132 return 0;
133 }
134
135 static int WriteReg(avmcard *card, u32 reg, u8 val)
136 {
137 u8 cmd = 0x00;
138 if ( b1dma_tolink(card, &cmd, 1) == 0
139 && b1dma_tolink(card, &reg, 4) == 0) {
140 u32 tmp = val;
141 return b1dma_tolink(card, &tmp, 4);
142 }
143 return -1;
144 }
145
146 static u8 ReadReg(avmcard *card, u32 reg)
147 {
148 u8 cmd = 0x01;
149 if ( b1dma_tolink(card, &cmd, 1) == 0
150 && b1dma_tolink(card, &reg, 4) == 0) {
151 u32 tmp;
152 if (b1dma_fromlink(card, &tmp, 4) == 0)
153 return (u8)tmp;
154 }
155 return 0xff;
156 }
157
158 /* ------------------------------------------------------------- */
159
160 static inline void _put_byte(void **pp, u8 val)
161 {
162 u8 *s = *pp;
163 *s++ = val;
164 *pp = s;
165 }
166
167 static inline void _put_word(void **pp, u32 val)
168 {
169 u8 *s = *pp;
170 *s++ = val & 0xff;
171 *s++ = (val >> 8) & 0xff;
172 *s++ = (val >> 16) & 0xff;
173 *s++ = (val >> 24) & 0xff;
174 *pp = s;
175 }
176
177 static inline void _put_slice(void **pp, unsigned char *dp, unsigned int len)
178 {
179 unsigned i = len;
180 _put_word(pp, i);
181 while (i-- > 0)
182 _put_byte(pp, *dp++);
183 }
184
185 static inline u8 _get_byte(void **pp)
186 {
187 u8 *s = *pp;
188 u8 val;
189 val = *s++;
190 *pp = s;
191 return val;
192 }
193
194 static inline u32 _get_word(void **pp)
195 {
196 u8 *s = *pp;
197 u32 val;
198 val = *s++;
199 val |= (*s++ << 8);
200 val |= (*s++ << 16);
201 val |= (*s++ << 24);
202 *pp = s;
203 return val;
204 }
205
206 static inline u32 _get_slice(void **pp, unsigned char *dp)
207 {
208 unsigned int len, i;
209
210 len = i = _get_word(pp);
211 while (i-- > 0) *dp++ = _get_byte(pp);
212 return len;
213 }
214
215 /* ------------------------------------------------------------- */
216
217 void b1dma_reset(avmcard *card)
218 {
219 card->csr = 0x0;
220 b1dma_writel(card, card->csr, AMCC_INTCSR);
221 b1dma_writel(card, 0, AMCC_MCSR);
222 b1dma_writel(card, 0, AMCC_RXLEN);
223 b1dma_writel(card, 0, AMCC_TXLEN);
224
225 t1outp(card->port, 0x10, 0x00);
226 t1outp(card->port, 0x07, 0x00);
227
228 b1dma_writel(card, 0, AMCC_MCSR);
229 mdelay(10);
230 b1dma_writel(card, 0x0f000000, AMCC_MCSR); /* reset all */
231 mdelay(10);
232 b1dma_writel(card, 0, AMCC_MCSR);
233 if (card->cardtype == avm_t1pci)
234 mdelay(42);
235 else
236 mdelay(10);
237 }
238
239 /* ------------------------------------------------------------- */
240
241 static int b1dma_detect(avmcard *card)
242 {
243 b1dma_writel(card, 0, AMCC_MCSR);
244 mdelay(10);
245 b1dma_writel(card, 0x0f000000, AMCC_MCSR); /* reset all */
246 mdelay(10);
247 b1dma_writel(card, 0, AMCC_MCSR);
248 mdelay(42);
249
250 b1dma_writel(card, 0, AMCC_RXLEN);
251 b1dma_writel(card, 0, AMCC_TXLEN);
252 card->csr = 0x0;
253 b1dma_writel(card, card->csr, AMCC_INTCSR);
254
255 if (b1dma_readl(card, AMCC_MCSR) != 0x000000E6)
256 return 1;
257
258 b1dma_writel(card, 0xffffffff, AMCC_RXPTR);
259 b1dma_writel(card, 0xffffffff, AMCC_TXPTR);
260 if ( b1dma_readl(card, AMCC_RXPTR) != 0xfffffffc
261 || b1dma_readl(card, AMCC_TXPTR) != 0xfffffffc)
262 return 2;
263
264 b1dma_writel(card, 0x0, AMCC_RXPTR);
265 b1dma_writel(card, 0x0, AMCC_TXPTR);
266 if ( b1dma_readl(card, AMCC_RXPTR) != 0x0
267 || b1dma_readl(card, AMCC_TXPTR) != 0x0)
268 return 3;
269
270 t1outp(card->port, 0x10, 0x00);
271 t1outp(card->port, 0x07, 0x00);
272
273 t1outp(card->port, 0x02, 0x02);
274 t1outp(card->port, 0x03, 0x02);
275
276 if ( (t1inp(card->port, 0x02) & 0xFE) != 0x02
277 || t1inp(card->port, 0x3) != 0x03)
278 return 4;
279
280 t1outp(card->port, 0x02, 0x00);
281 t1outp(card->port, 0x03, 0x00);
282
283 if ( (t1inp(card->port, 0x02) & 0xFE) != 0x00
284 || t1inp(card->port, 0x3) != 0x01)
285 return 5;
286
287 return 0;
288 }
289
290 int t1pci_detect(avmcard *card)
291 {
292 int ret;
293
294 if ((ret = b1dma_detect(card)) != 0)
295 return ret;
296
297 /* Transputer test */
298
299 if ( WriteReg(card, 0x80001000, 0x11) != 0
300 || WriteReg(card, 0x80101000, 0x22) != 0
301 || WriteReg(card, 0x80201000, 0x33) != 0
302 || WriteReg(card, 0x80301000, 0x44) != 0)
303 return 6;
304
305 if ( ReadReg(card, 0x80001000) != 0x11
306 || ReadReg(card, 0x80101000) != 0x22
307 || ReadReg(card, 0x80201000) != 0x33
308 || ReadReg(card, 0x80301000) != 0x44)
309 return 7;
310
311 if ( WriteReg(card, 0x80001000, 0x55) != 0
312 || WriteReg(card, 0x80101000, 0x66) != 0
313 || WriteReg(card, 0x80201000, 0x77) != 0
314 || WriteReg(card, 0x80301000, 0x88) != 0)
315 return 8;
316
317 if ( ReadReg(card, 0x80001000) != 0x55
318 || ReadReg(card, 0x80101000) != 0x66
319 || ReadReg(card, 0x80201000) != 0x77
320 || ReadReg(card, 0x80301000) != 0x88)
321 return 9;
322
323 return 0;
324 }
325
326 int b1pciv4_detect(avmcard *card)
327 {
328 int ret, i;
329
330 if ((ret = b1dma_detect(card)) != 0)
331 return ret;
332
333 for (i=0; i < 5 ; i++) {
334 if (WriteReg(card, 0x80A00000, 0x21) != 0)
335 return 6;
336 if ((ReadReg(card, 0x80A00000) & 0x01) != 0x01)
337 return 7;
338 }
339 for (i=0; i < 5 ; i++) {
340 if (WriteReg(card, 0x80A00000, 0x20) != 0)
341 return 8;
342 if ((ReadReg(card, 0x80A00000) & 0x01) != 0x00)
343 return 9;
344 }
345
346 return 0;
347 }
348
349 static void b1dma_queue_tx(avmcard *card, struct sk_buff *skb)
350 {
351 unsigned long flags;
352
353 spin_lock_irqsave(&card->lock, flags);
354
355 skb_queue_tail(&card->dma->send_queue, skb);
356
357 if (!(card->csr & EN_TX_TC_INT)) {
358 b1dma_dispatch_tx(card);
359 b1dma_writel(card, card->csr, AMCC_INTCSR);
360 }
361
362 spin_unlock_irqrestore(&card->lock, flags);
363 }
364
365 /* ------------------------------------------------------------- */
366
367 static void b1dma_dispatch_tx(avmcard *card)
368 {
369 avmcard_dmainfo *dma = card->dma;
370 struct sk_buff *skb;
371 u8 cmd, subcmd;
372 u16 len;
373 u32 txlen;
374 void *p;
375
376 skb = skb_dequeue(&dma->send_queue);
377
378 len = CAPIMSG_LEN(skb->data);
379
380 if (len) {
381 cmd = CAPIMSG_COMMAND(skb->data);
382 subcmd = CAPIMSG_SUBCOMMAND(skb->data);
383
384 p = dma->sendbuf.dmabuf;
385
386 if (CAPICMD(cmd, subcmd) == CAPI_DATA_B3_REQ) {
387 u16 dlen = CAPIMSG_DATALEN(skb->data);
388 _put_byte(&p, SEND_DATA_B3_REQ);
389 _put_slice(&p, skb->data, len);
390 _put_slice(&p, skb->data + len, dlen);
391 } else {
392 _put_byte(&p, SEND_MESSAGE);
393 _put_slice(&p, skb->data, len);
394 }
395 txlen = (u8 *)p - (u8 *)dma->sendbuf.dmabuf;
396 #ifdef AVM_B1DMA_DEBUG
397 printk(KERN_DEBUG "tx: put msg len=%d\n", txlen);
398 #endif
399 } else {
400 txlen = skb->len-2;
401 #ifdef AVM_B1DMA_POLLDEBUG
402 if (skb->data[2] == SEND_POLLACK)
403 printk(KERN_INFO "%s: send ack\n", card->name);
404 #endif
405 #ifdef AVM_B1DMA_DEBUG
406 printk(KERN_DEBUG "tx: put 0x%x len=%d\n",
407 skb->data[2], txlen);
408 #endif
409 skb_copy_from_linear_data_offset(skb, 2, dma->sendbuf.dmabuf,
410 skb->len - 2);
411 }
412 txlen = (txlen + 3) & ~3;
413
414 b1dma_writel(card, dma->sendbuf.dmaaddr, AMCC_TXPTR);
415 b1dma_writel(card, txlen, AMCC_TXLEN);
416
417 card->csr |= EN_TX_TC_INT;
418
419 dev_kfree_skb_any(skb);
420 }
421
422 /* ------------------------------------------------------------- */
423
424 static void queue_pollack(avmcard *card)
425 {
426 struct sk_buff *skb;
427 void *p;
428
429 skb = alloc_skb(3, GFP_ATOMIC);
430 if (!skb) {
431 printk(KERN_CRIT "%s: no memory, lost poll ack\n",
432 card->name);
433 return;
434 }
435 p = skb->data;
436 _put_byte(&p, 0);
437 _put_byte(&p, 0);
438 _put_byte(&p, SEND_POLLACK);
439 skb_put(skb, (u8 *)p - (u8 *)skb->data);
440
441 b1dma_queue_tx(card, skb);
442 }
443
444 /* ------------------------------------------------------------- */
445
446 static void b1dma_handle_rx(avmcard *card)
447 {
448 avmctrl_info *cinfo = &card->ctrlinfo[0];
449 avmcard_dmainfo *dma = card->dma;
450 struct capi_ctr *ctrl = &cinfo->capi_ctrl;
451 struct sk_buff *skb;
452 void *p = dma->recvbuf.dmabuf+4;
453 u32 ApplId, MsgLen, DataB3Len, NCCI, WindowSize;
454 u8 b1cmd = _get_byte(&p);
455
456 #ifdef AVM_B1DMA_DEBUG
457 printk(KERN_DEBUG "rx: 0x%x %lu\n", b1cmd, (unsigned long)dma->recvlen);
458 #endif
459
460 switch (b1cmd) {
461 case RECEIVE_DATA_B3_IND:
462
463 ApplId = (unsigned) _get_word(&p);
464 MsgLen = _get_slice(&p, card->msgbuf);
465 DataB3Len = _get_slice(&p, card->databuf);
466
467 if (MsgLen < 30) { /* not CAPI 64Bit */
468 memset(card->msgbuf+MsgLen, 0, 30-MsgLen);
469 MsgLen = 30;
470 CAPIMSG_SETLEN(card->msgbuf, 30);
471 }
472 if (!(skb = alloc_skb(DataB3Len+MsgLen, GFP_ATOMIC))) {
473 printk(KERN_ERR "%s: incoming packet dropped\n",
474 card->name);
475 } else {
476 memcpy(skb_put(skb, MsgLen), card->msgbuf, MsgLen);
477 memcpy(skb_put(skb, DataB3Len), card->databuf, DataB3Len);
478 capi_ctr_handle_message(ctrl, ApplId, skb);
479 }
480 break;
481
482 case RECEIVE_MESSAGE:
483
484 ApplId = (unsigned) _get_word(&p);
485 MsgLen = _get_slice(&p, card->msgbuf);
486 if (!(skb = alloc_skb(MsgLen, GFP_ATOMIC))) {
487 printk(KERN_ERR "%s: incoming packet dropped\n",
488 card->name);
489 } else {
490 memcpy(skb_put(skb, MsgLen), card->msgbuf, MsgLen);
491 if (CAPIMSG_CMD(skb->data) == CAPI_DATA_B3_CONF) {
492 spin_lock(&card->lock);
493 capilib_data_b3_conf(&cinfo->ncci_head, ApplId,
494 CAPIMSG_NCCI(skb->data),
495 CAPIMSG_MSGID(skb->data));
496 spin_unlock(&card->lock);
497 }
498 capi_ctr_handle_message(ctrl, ApplId, skb);
499 }
500 break;
501
502 case RECEIVE_NEW_NCCI:
503
504 ApplId = _get_word(&p);
505 NCCI = _get_word(&p);
506 WindowSize = _get_word(&p);
507 spin_lock(&card->lock);
508 capilib_new_ncci(&cinfo->ncci_head, ApplId, NCCI, WindowSize);
509 spin_unlock(&card->lock);
510 break;
511
512 case RECEIVE_FREE_NCCI:
513
514 ApplId = _get_word(&p);
515 NCCI = _get_word(&p);
516
517 if (NCCI != 0xffffffff) {
518 spin_lock(&card->lock);
519 capilib_free_ncci(&cinfo->ncci_head, ApplId, NCCI);
520 spin_unlock(&card->lock);
521 }
522 break;
523
524 case RECEIVE_START:
525 #ifdef AVM_B1DMA_POLLDEBUG
526 printk(KERN_INFO "%s: receive poll\n", card->name);
527 #endif
528 if (!suppress_pollack)
529 queue_pollack(card);
530 capi_ctr_resume_output(ctrl);
531 break;
532
533 case RECEIVE_STOP:
534 capi_ctr_suspend_output(ctrl);
535 break;
536
537 case RECEIVE_INIT:
538
539 cinfo->versionlen = _get_slice(&p, cinfo->versionbuf);
540 b1_parse_version(cinfo);
541 printk(KERN_INFO "%s: %s-card (%s) now active\n",
542 card->name,
543 cinfo->version[VER_CARDTYPE],
544 cinfo->version[VER_DRIVER]);
545 capi_ctr_ready(ctrl);
546 break;
547
548 case RECEIVE_TASK_READY:
549 ApplId = (unsigned) _get_word(&p);
550 MsgLen = _get_slice(&p, card->msgbuf);
551 card->msgbuf[MsgLen] = 0;
552 while ( MsgLen > 0
553 && ( card->msgbuf[MsgLen-1] == '\n'
554 || card->msgbuf[MsgLen-1] == '\r')) {
555 card->msgbuf[MsgLen-1] = 0;
556 MsgLen--;
557 }
558 printk(KERN_INFO "%s: task %d \"%s\" ready.\n",
559 card->name, ApplId, card->msgbuf);
560 break;
561
562 case RECEIVE_DEBUGMSG:
563 MsgLen = _get_slice(&p, card->msgbuf);
564 card->msgbuf[MsgLen] = 0;
565 while ( MsgLen > 0
566 && ( card->msgbuf[MsgLen-1] == '\n'
567 || card->msgbuf[MsgLen-1] == '\r')) {
568 card->msgbuf[MsgLen-1] = 0;
569 MsgLen--;
570 }
571 printk(KERN_INFO "%s: DEBUG: %s\n", card->name, card->msgbuf);
572 break;
573
574 default:
575 printk(KERN_ERR "%s: b1dma_interrupt: 0x%x ???\n",
576 card->name, b1cmd);
577 return;
578 }
579 }
580
581 /* ------------------------------------------------------------- */
582
583 static void b1dma_handle_interrupt(avmcard *card)
584 {
585 u32 status;
586 u32 newcsr;
587
588 spin_lock(&card->lock);
589
590 status = b1dma_readl(card, AMCC_INTCSR);
591 if ((status & ANY_S5933_INT) == 0) {
592 spin_unlock(&card->lock);
593 return;
594 }
595
596 newcsr = card->csr | (status & ALL_INT);
597 if (status & TX_TC_INT) newcsr &= ~EN_TX_TC_INT;
598 if (status & RX_TC_INT) newcsr &= ~EN_RX_TC_INT;
599 b1dma_writel(card, newcsr, AMCC_INTCSR);
600
601 if ((status & RX_TC_INT) != 0) {
602 struct avmcard_dmainfo *dma = card->dma;
603 u32 rxlen;
604 if (card->dma->recvlen == 0) {
605 rxlen = b1dma_readl(card, AMCC_RXLEN);
606 if (rxlen == 0) {
607 dma->recvlen = *((u32 *)dma->recvbuf.dmabuf);
608 rxlen = (dma->recvlen + 3) & ~3;
609 b1dma_writel(card, dma->recvbuf.dmaaddr+4, AMCC_RXPTR);
610 b1dma_writel(card, rxlen, AMCC_RXLEN);
611 #ifdef AVM_B1DMA_DEBUG
612 } else {
613 printk(KERN_ERR "%s: rx not complete (%d).\n",
614 card->name, rxlen);
615 #endif
616 }
617 } else {
618 spin_unlock(&card->lock);
619 b1dma_handle_rx(card);
620 dma->recvlen = 0;
621 spin_lock(&card->lock);
622 b1dma_writel(card, dma->recvbuf.dmaaddr, AMCC_RXPTR);
623 b1dma_writel(card, 4, AMCC_RXLEN);
624 }
625 }
626
627 if ((status & TX_TC_INT) != 0) {
628 if (skb_queue_empty(&card->dma->send_queue))
629 card->csr &= ~EN_TX_TC_INT;
630 else
631 b1dma_dispatch_tx(card);
632 }
633 b1dma_writel(card, card->csr, AMCC_INTCSR);
634
635 spin_unlock(&card->lock);
636 }
637
638 irqreturn_t b1dma_interrupt(int interrupt, void *devptr)
639 {
640 avmcard *card = devptr;
641
642 b1dma_handle_interrupt(card);
643 return IRQ_HANDLED;
644 }
645
646 /* ------------------------------------------------------------- */
647
648 static int b1dma_loaded(avmcard *card)
649 {
650 unsigned long stop;
651 unsigned char ans;
652 unsigned long tout = 2;
653 unsigned int base = card->port;
654
655 for (stop = jiffies + tout * HZ; time_before(jiffies, stop);) {
656 if (b1_tx_empty(base))
657 break;
658 }
659 if (!b1_tx_empty(base)) {
660 printk(KERN_ERR "%s: b1dma_loaded: tx err, corrupted t4 file ?\n",
661 card->name);
662 return 0;
663 }
664 b1_put_byte(base, SEND_POLLACK);
665 for (stop = jiffies + tout * HZ; time_before(jiffies, stop);) {
666 if (b1_rx_full(base)) {
667 if ((ans = b1_get_byte(base)) == RECEIVE_POLLDWORD) {
668 return 1;
669 }
670 printk(KERN_ERR "%s: b1dma_loaded: got 0x%x, firmware not running in dword mode\n", card->name, ans);
671 return 0;
672 }
673 }
674 printk(KERN_ERR "%s: b1dma_loaded: firmware not running\n", card->name);
675 return 0;
676 }
677
678 /* ------------------------------------------------------------- */
679
680 static void b1dma_send_init(avmcard *card)
681 {
682 struct sk_buff *skb;
683 void *p;
684
685 skb = alloc_skb(15, GFP_ATOMIC);
686 if (!skb) {
687 printk(KERN_CRIT "%s: no memory, lost register appl.\n",
688 card->name);
689 return;
690 }
691 p = skb->data;
692 _put_byte(&p, 0);
693 _put_byte(&p, 0);
694 _put_byte(&p, SEND_INIT);
695 _put_word(&p, CAPI_MAXAPPL);
696 _put_word(&p, AVM_NCCI_PER_CHANNEL*30);
697 _put_word(&p, card->cardnr - 1);
698 skb_put(skb, (u8 *)p - (u8 *)skb->data);
699
700 b1dma_queue_tx(card, skb);
701 }
702
703 int b1dma_load_firmware(struct capi_ctr *ctrl, capiloaddata *data)
704 {
705 avmctrl_info *cinfo = (avmctrl_info *)(ctrl->driverdata);
706 avmcard *card = cinfo->card;
707 int retval;
708
709 b1dma_reset(card);
710
711 if ((retval = b1_load_t4file(card, &data->firmware))) {
712 b1dma_reset(card);
713 printk(KERN_ERR "%s: failed to load t4file!!\n",
714 card->name);
715 return retval;
716 }
717
718 if (data->configuration.len > 0 && data->configuration.data) {
719 if ((retval = b1_load_config(card, &data->configuration))) {
720 b1dma_reset(card);
721 printk(KERN_ERR "%s: failed to load config!!\n",
722 card->name);
723 return retval;
724 }
725 }
726
727 if (!b1dma_loaded(card)) {
728 b1dma_reset(card);
729 printk(KERN_ERR "%s: failed to load t4file.\n", card->name);
730 return -EIO;
731 }
732
733 card->csr = AVM_FLAG;
734 b1dma_writel(card, card->csr, AMCC_INTCSR);
735 b1dma_writel(card, EN_A2P_TRANSFERS|EN_P2A_TRANSFERS|A2P_HI_PRIORITY|
736 P2A_HI_PRIORITY|RESET_A2P_FLAGS|RESET_P2A_FLAGS,
737 AMCC_MCSR);
738 t1outp(card->port, 0x07, 0x30);
739 t1outp(card->port, 0x10, 0xF0);
740
741 card->dma->recvlen = 0;
742 b1dma_writel(card, card->dma->recvbuf.dmaaddr, AMCC_RXPTR);
743 b1dma_writel(card, 4, AMCC_RXLEN);
744 card->csr |= EN_RX_TC_INT;
745 b1dma_writel(card, card->csr, AMCC_INTCSR);
746
747 b1dma_send_init(card);
748
749 return 0;
750 }
751
752 void b1dma_reset_ctr(struct capi_ctr *ctrl)
753 {
754 avmctrl_info *cinfo = (avmctrl_info *)(ctrl->driverdata);
755 avmcard *card = cinfo->card;
756 unsigned long flags;
757
758 spin_lock_irqsave(&card->lock, flags);
759 b1dma_reset(card);
760
761 memset(cinfo->version, 0, sizeof(cinfo->version));
762 capilib_release(&cinfo->ncci_head);
763 spin_unlock_irqrestore(&card->lock, flags);
764 capi_ctr_down(ctrl);
765 }
766
767 /* ------------------------------------------------------------- */
768
769 void b1dma_register_appl(struct capi_ctr *ctrl,
770 u16 appl,
771 capi_register_params *rp)
772 {
773 avmctrl_info *cinfo = (avmctrl_info *)(ctrl->driverdata);
774 avmcard *card = cinfo->card;
775 struct sk_buff *skb;
776 int want = rp->level3cnt;
777 int nconn;
778 void *p;
779
780 if (want > 0) nconn = want;
781 else nconn = ctrl->profile.nbchannel * -want;
782 if (nconn == 0) nconn = ctrl->profile.nbchannel;
783
784 skb = alloc_skb(23, GFP_ATOMIC);
785 if (!skb) {
786 printk(KERN_CRIT "%s: no memory, lost register appl.\n",
787 card->name);
788 return;
789 }
790 p = skb->data;
791 _put_byte(&p, 0);
792 _put_byte(&p, 0);
793 _put_byte(&p, SEND_REGISTER);
794 _put_word(&p, appl);
795 _put_word(&p, 1024 * (nconn+1));
796 _put_word(&p, nconn);
797 _put_word(&p, rp->datablkcnt);
798 _put_word(&p, rp->datablklen);
799 skb_put(skb, (u8 *)p - (u8 *)skb->data);
800
801 b1dma_queue_tx(card, skb);
802 }
803
804 /* ------------------------------------------------------------- */
805
806 void b1dma_release_appl(struct capi_ctr *ctrl, u16 appl)
807 {
808 avmctrl_info *cinfo = (avmctrl_info *)(ctrl->driverdata);
809 avmcard *card = cinfo->card;
810 struct sk_buff *skb;
811 void *p;
812 unsigned long flags;
813
814 spin_lock_irqsave(&card->lock, flags);
815 capilib_release_appl(&cinfo->ncci_head, appl);
816 spin_unlock_irqrestore(&card->lock, flags);
817
818 skb = alloc_skb(7, GFP_ATOMIC);
819 if (!skb) {
820 printk(KERN_CRIT "%s: no memory, lost release appl.\n",
821 card->name);
822 return;
823 }
824 p = skb->data;
825 _put_byte(&p, 0);
826 _put_byte(&p, 0);
827 _put_byte(&p, SEND_RELEASE);
828 _put_word(&p, appl);
829
830 skb_put(skb, (u8 *)p - (u8 *)skb->data);
831
832 b1dma_queue_tx(card, skb);
833 }
834
835 /* ------------------------------------------------------------- */
836
837 u16 b1dma_send_message(struct capi_ctr *ctrl, struct sk_buff *skb)
838 {
839 avmctrl_info *cinfo = (avmctrl_info *)(ctrl->driverdata);
840 avmcard *card = cinfo->card;
841 u16 retval = CAPI_NOERROR;
842
843 if (CAPIMSG_CMD(skb->data) == CAPI_DATA_B3_REQ) {
844 unsigned long flags;
845 spin_lock_irqsave(&card->lock, flags);
846 retval = capilib_data_b3_req(&cinfo->ncci_head,
847 CAPIMSG_APPID(skb->data),
848 CAPIMSG_NCCI(skb->data),
849 CAPIMSG_MSGID(skb->data));
850 spin_unlock_irqrestore(&card->lock, flags);
851 }
852 if (retval == CAPI_NOERROR)
853 b1dma_queue_tx(card, skb);
854
855 return retval;
856 }
857
858 /* ------------------------------------------------------------- */
859
860 static int b1dmactl_proc_show(struct seq_file *m, void *v)
861 {
862 struct capi_ctr *ctrl = m->private;
863 avmctrl_info *cinfo = (avmctrl_info *)(ctrl->driverdata);
864 avmcard *card = cinfo->card;
865 u8 flag;
866 char *s;
867 u32 txoff, txlen, rxoff, rxlen, csr;
868 unsigned long flags;
869
870 seq_printf(m, "%-16s %s\n", "name", card->name);
871 seq_printf(m, "%-16s 0x%x\n", "io", card->port);
872 seq_printf(m, "%-16s %d\n", "irq", card->irq);
873 seq_printf(m, "%-16s 0x%lx\n", "membase", card->membase);
874 switch (card->cardtype) {
875 case avm_b1isa: s = "B1 ISA"; break;
876 case avm_b1pci: s = "B1 PCI"; break;
877 case avm_b1pcmcia: s = "B1 PCMCIA"; break;
878 case avm_m1: s = "M1"; break;
879 case avm_m2: s = "M2"; break;
880 case avm_t1isa: s = "T1 ISA (HEMA)"; break;
881 case avm_t1pci: s = "T1 PCI"; break;
882 case avm_c4: s = "C4"; break;
883 case avm_c2: s = "C2"; break;
884 default: s = "???"; break;
885 }
886 seq_printf(m, "%-16s %s\n", "type", s);
887 if ((s = cinfo->version[VER_DRIVER]) != NULL)
888 seq_printf(m, "%-16s %s\n", "ver_driver", s);
889 if ((s = cinfo->version[VER_CARDTYPE]) != NULL)
890 seq_printf(m, "%-16s %s\n", "ver_cardtype", s);
891 if ((s = cinfo->version[VER_SERIAL]) != NULL)
892 seq_printf(m, "%-16s %s\n", "ver_serial", s);
893
894 if (card->cardtype != avm_m1) {
895 flag = ((u8 *)(ctrl->profile.manu))[3];
896 if (flag)
897 seq_printf(m, "%-16s%s%s%s%s%s%s%s\n",
898 "protocol",
899 (flag & 0x01) ? " DSS1" : "",
900 (flag & 0x02) ? " CT1" : "",
901 (flag & 0x04) ? " VN3" : "",
902 (flag & 0x08) ? " NI1" : "",
903 (flag & 0x10) ? " AUSTEL" : "",
904 (flag & 0x20) ? " ESS" : "",
905 (flag & 0x40) ? " 1TR6" : ""
906 );
907 }
908 if (card->cardtype != avm_m1) {
909 flag = ((u8 *)(ctrl->profile.manu))[5];
910 if (flag)
911 seq_printf(m, "%-16s%s%s%s%s\n",
912 "linetype",
913 (flag & 0x01) ? " point to point" : "",
914 (flag & 0x02) ? " point to multipoint" : "",
915 (flag & 0x08) ? " leased line without D-channel" : "",
916 (flag & 0x04) ? " leased line with D-channel" : ""
917 );
918 }
919 seq_printf(m, "%-16s %s\n", "cardname", cinfo->cardname);
920
921
922 spin_lock_irqsave(&card->lock, flags);
923
924 txoff = (dma_addr_t)b1dma_readl(card, AMCC_TXPTR)-card->dma->sendbuf.dmaaddr;
925 txlen = b1dma_readl(card, AMCC_TXLEN);
926
927 rxoff = (dma_addr_t)b1dma_readl(card, AMCC_RXPTR)-card->dma->recvbuf.dmaaddr;
928 rxlen = b1dma_readl(card, AMCC_RXLEN);
929
930 csr = b1dma_readl(card, AMCC_INTCSR);
931
932 spin_unlock_irqrestore(&card->lock, flags);
933
934 seq_printf(m, "%-16s 0x%lx\n", "csr (cached)", (unsigned long)card->csr);
935 seq_printf(m, "%-16s 0x%lx\n", "csr", (unsigned long)csr);
936 seq_printf(m, "%-16s %lu\n", "txoff", (unsigned long)txoff);
937 seq_printf(m, "%-16s %lu\n", "txlen", (unsigned long)txlen);
938 seq_printf(m, "%-16s %lu\n", "rxoff", (unsigned long)rxoff);
939 seq_printf(m, "%-16s %lu\n", "rxlen", (unsigned long)rxlen);
940
941 return 0;
942 }
943
944 static int b1dmactl_proc_open(struct inode *inode, struct file *file)
945 {
946 return single_open(file, b1dmactl_proc_show, PDE(inode)->data);
947 }
948
949 const struct file_operations b1dmactl_proc_fops = {
950 .owner = THIS_MODULE,
951 .open = b1dmactl_proc_open,
952 .read = seq_read,
953 .llseek = seq_lseek,
954 .release = single_release,
955 };
956 EXPORT_SYMBOL(b1dmactl_proc_fops);
957
958 /* ------------------------------------------------------------- */
959
960 EXPORT_SYMBOL(b1dma_reset);
961 EXPORT_SYMBOL(t1pci_detect);
962 EXPORT_SYMBOL(b1pciv4_detect);
963 EXPORT_SYMBOL(b1dma_interrupt);
964
965 EXPORT_SYMBOL(b1dma_load_firmware);
966 EXPORT_SYMBOL(b1dma_reset_ctr);
967 EXPORT_SYMBOL(b1dma_register_appl);
968 EXPORT_SYMBOL(b1dma_release_appl);
969 EXPORT_SYMBOL(b1dma_send_message);
970
971 static int __init b1dma_init(void)
972 {
973 char *p;
974 char rev[32];
975
976 if ((p = strchr(revision, ':')) != NULL && p[1]) {
977 strlcpy(rev, p + 2, sizeof(rev));
978 if ((p = strchr(rev, '$')) != NULL && p > rev)
979 *(p-1) = 0;
980 } else
981 strcpy(rev, "1.0");
982
983 printk(KERN_INFO "b1dma: revision %s\n", rev);
984
985 return 0;
986 }
987
988 static void __exit b1dma_exit(void)
989 {
990 }
991
992 module_init(b1dma_init);
993 module_exit(b1dma_exit);