1 /* $Id: isac.c,v 1.28.6.3 2001/09/23 22:24:49 kai Exp $
3 * ISAC specific routines
6 * Copyright by Karsten Keil <keil@isdn4linux.de>
8 * This software may be used and distributed according to the terms
9 * of the GNU General Public License, incorporated herein by reference.
11 * For changes and modifications please read
12 * ../../../Documentation/isdn/HiSax.cert
20 #include <linux/interrupt.h>
21 #include <linux/init.h>
23 #define DBUSY_TIMER_VALUE 80
26 static char *ISACVer
[] __devinitdata
=
27 {"2086/2186 V1.1", "2085 B1", "2085 B2",
31 isac_read(struct IsdnCardState
*cs
, u8 addr
)
33 return cs
->dc_hw_ops
->read_reg(cs
, addr
);
37 isac_write(struct IsdnCardState
*cs
, u8 addr
, u8 val
)
39 cs
->dc_hw_ops
->write_reg(cs
, addr
, val
);
43 isac_write_fifo(struct IsdnCardState
*cs
, u8
*p
, int len
)
45 return cs
->dc_hw_ops
->write_fifo(cs
, p
, len
);
49 ISACVersion(struct IsdnCardState
*cs
, char *s
)
53 val
= isac_read(cs
, ISAC_RBCH
);
54 printk(KERN_INFO
"%s ISAC version (%x): %s\n", s
, val
, ISACVer
[(val
>> 5) & 3]);
58 ph_command(struct IsdnCardState
*cs
, unsigned int command
)
60 if (cs
->debug
& L1_DEB_ISAC
)
61 debugl1(cs
, "ph_command %x", command
);
62 isac_write(cs
, ISAC_CIX0
, (command
<< 2) | 3);
67 isac_new_ph(struct IsdnCardState
*cs
)
69 switch (cs
->dc
.isac
.ph_state
) {
72 ph_command(cs
, ISAC_CMD_DUI
);
73 l1_msg(cs
, HW_RESET
| INDICATION
, NULL
);
76 l1_msg(cs
, HW_DEACTIVATE
| CONFIRM
, NULL
);
79 l1_msg(cs
, HW_DEACTIVATE
| INDICATION
, NULL
);
82 l1_msg(cs
, HW_POWERUP
| CONFIRM
, NULL
);
85 l1_msg(cs
, HW_RSYNC
| INDICATION
, NULL
);
88 l1_msg(cs
, HW_INFO2
| INDICATION
, NULL
);
91 l1_msg(cs
, HW_INFO4_P8
| INDICATION
, NULL
);
94 l1_msg(cs
, HW_INFO4_P10
| INDICATION
, NULL
);
104 struct IsdnCardState
*cs
= data
;
105 struct PStack
*stptr
;
109 if (test_and_clear_bit(D_CLEARBUSY
, &cs
->event
)) {
111 debugl1(cs
, "D-Channel Busy cleared");
113 while (stptr
!= NULL
) {
114 L1L2(stptr
, PH_PAUSE
| CONFIRM
, NULL
);
118 if (test_and_clear_bit(D_L1STATECHANGE
, &cs
->event
))
120 if (test_and_clear_bit(D_RCVBUFREADY
, &cs
->event
))
121 DChannel_proc_rcv(cs
);
122 if (test_and_clear_bit(D_XMTBUFREADY
, &cs
->event
))
123 DChannel_proc_xmt(cs
);
125 if (!test_bit(HW_ARCOFI
, &cs
->HW_Flags
))
127 if (test_and_clear_bit(D_RX_MON1
, &cs
->event
))
128 arcofi_fsm(cs
, ARCOFI_RX_END
, NULL
);
129 if (test_and_clear_bit(D_TX_MON1
, &cs
->event
))
130 arcofi_fsm(cs
, ARCOFI_TX_END
, NULL
);
135 isac_empty_fifo(struct IsdnCardState
*cs
, int count
)
137 recv_empty_fifo_d(cs
, count
);
138 isac_write(cs
, ISAC_CMDR
, 0x80);
142 isac_fill_fifo(struct IsdnCardState
*cs
)
147 p
= xmit_fill_fifo_d(cs
, 32, &count
, &more
);
151 isac_write_fifo(cs
, p
, count
);
152 isac_write(cs
, ISAC_CMDR
, more
? 0x8 : 0xa);
153 if (test_and_set_bit(FLG_DBUSY_TIMER
, &cs
->HW_Flags
)) {
154 debugl1(cs
, "isac_fill_fifo dbusytimer running");
155 del_timer(&cs
->dbusytimer
);
157 init_timer(&cs
->dbusytimer
);
158 cs
->dbusytimer
.expires
= jiffies
+ ((DBUSY_TIMER_VALUE
* HZ
)/1000);
159 add_timer(&cs
->dbusytimer
);
163 isac_interrupt(struct IsdnCardState
*cs
, u8 val
)
168 if (cs
->debug
& L1_DEB_ISAC
)
169 debugl1(cs
, "ISAC interrupt %x", val
);
170 if (val
& 0x80) { /* RME */
171 exval
= isac_read(cs
, ISAC_RSTA
);
172 if ((exval
& 0x70) != 0x20) {
174 if (cs
->debug
& L1_DEB_WARN
)
175 debugl1(cs
, "ISAC RDO");
176 #ifdef ERROR_STATISTIC
180 if (!(exval
& 0x20)) {
181 if (cs
->debug
& L1_DEB_WARN
)
182 debugl1(cs
, "ISAC CRC error");
183 #ifdef ERROR_STATISTIC
187 isac_write(cs
, ISAC_CMDR
, 0x80);
190 count
= isac_read(cs
, ISAC_RBCL
) & 0x1f;
193 isac_empty_fifo(cs
, count
);
197 sched_d_event(cs
, D_RCVBUFREADY
);
199 if (val
& 0x40) { /* RPF */
200 isac_empty_fifo(cs
, 32);
202 if (val
& 0x20) { /* RSC */
204 if (cs
->debug
& L1_DEB_WARN
)
205 debugl1(cs
, "ISAC RSC interrupt");
207 if (val
& 0x10) { /* XPR */
210 if (val
& 0x04) { /* CISQ */
211 exval
= isac_read(cs
, ISAC_CIR0
);
212 if (cs
->debug
& L1_DEB_ISAC
)
213 debugl1(cs
, "ISAC CIR0 %02X", exval
);
215 cs
->dc
.isac
.ph_state
= (exval
>> 2) & 0xf;
216 if (cs
->debug
& L1_DEB_ISAC
)
217 debugl1(cs
, "ph_state change %x", cs
->dc
.isac
.ph_state
);
218 sched_d_event(cs
, D_L1STATECHANGE
);
221 exval
= isac_read(cs
, ISAC_CIR1
);
222 if (cs
->debug
& L1_DEB_ISAC
)
223 debugl1(cs
, "ISAC CIR1 %02X", exval
);
226 if (val
& 0x02) { /* SIN */
228 if (cs
->debug
& L1_DEB_WARN
)
229 debugl1(cs
, "ISAC SIN interrupt");
231 if (val
& 0x01) { /* EXI */
232 exval
= isac_read(cs
, ISAC_EXIR
);
233 if (cs
->debug
& L1_DEB_WARN
)
234 debugl1(cs
, "ISAC EXIR %02x", exval
);
235 if (exval
& 0x80) { /* XMR */
236 debugl1(cs
, "ISAC XMR");
237 printk(KERN_WARNING
"HiSax: ISAC XMR\n");
239 if (exval
& 0x40) { /* XDU */
240 xmit_xdu_d(cs
, NULL
);
242 if (exval
& 0x04) { /* MOS */
243 v1
= isac_read(cs
, ISAC_MOSR
);
244 if (cs
->debug
& L1_DEB_MONITOR
)
245 debugl1(cs
, "ISAC MOSR %02x", v1
);
248 if (!cs
->dc
.isac
.mon_rx
) {
249 if (!(cs
->dc
.isac
.mon_rx
= kmalloc(MAX_MON_FRAME
, GFP_ATOMIC
))) {
250 if (cs
->debug
& L1_DEB_WARN
)
251 debugl1(cs
, "ISAC MON RX out of memory!");
252 cs
->dc
.isac
.mocr
&= 0xf0;
253 cs
->dc
.isac
.mocr
|= 0x0a;
254 isac_write(cs
, ISAC_MOCR
, cs
->dc
.isac
.mocr
);
257 cs
->dc
.isac
.mon_rxp
= 0;
259 if (cs
->dc
.isac
.mon_rxp
>= MAX_MON_FRAME
) {
260 cs
->dc
.isac
.mocr
&= 0xf0;
261 cs
->dc
.isac
.mocr
|= 0x0a;
262 isac_write(cs
, ISAC_MOCR
, cs
->dc
.isac
.mocr
);
263 cs
->dc
.isac
.mon_rxp
= 0;
264 if (cs
->debug
& L1_DEB_WARN
)
265 debugl1(cs
, "ISAC MON RX overflow!");
268 cs
->dc
.isac
.mon_rx
[cs
->dc
.isac
.mon_rxp
++] = isac_read(cs
, ISAC_MOR0
);
269 if (cs
->debug
& L1_DEB_MONITOR
)
270 debugl1(cs
, "ISAC MOR0 %02x", cs
->dc
.isac
.mon_rx
[cs
->dc
.isac
.mon_rxp
-1]);
271 if (cs
->dc
.isac
.mon_rxp
== 1) {
272 cs
->dc
.isac
.mocr
|= 0x04;
273 isac_write(cs
, ISAC_MOCR
, cs
->dc
.isac
.mocr
);
278 if (!cs
->dc
.isac
.mon_rx
) {
279 if (!(cs
->dc
.isac
.mon_rx
= kmalloc(MAX_MON_FRAME
, GFP_ATOMIC
))) {
280 if (cs
->debug
& L1_DEB_WARN
)
281 debugl1(cs
, "ISAC MON RX out of memory!");
282 cs
->dc
.isac
.mocr
&= 0x0f;
283 cs
->dc
.isac
.mocr
|= 0xa0;
284 isac_write(cs
, ISAC_MOCR
, cs
->dc
.isac
.mocr
);
287 cs
->dc
.isac
.mon_rxp
= 0;
289 if (cs
->dc
.isac
.mon_rxp
>= MAX_MON_FRAME
) {
290 cs
->dc
.isac
.mocr
&= 0x0f;
291 cs
->dc
.isac
.mocr
|= 0xa0;
292 isac_write(cs
, ISAC_MOCR
, cs
->dc
.isac
.mocr
);
293 cs
->dc
.isac
.mon_rxp
= 0;
294 if (cs
->debug
& L1_DEB_WARN
)
295 debugl1(cs
, "ISAC MON RX overflow!");
298 cs
->dc
.isac
.mon_rx
[cs
->dc
.isac
.mon_rxp
++] = isac_read(cs
, ISAC_MOR1
);
299 if (cs
->debug
& L1_DEB_MONITOR
)
300 debugl1(cs
, "ISAC MOR1 %02x", cs
->dc
.isac
.mon_rx
[cs
->dc
.isac
.mon_rxp
-1]);
301 cs
->dc
.isac
.mocr
|= 0x40;
302 isac_write(cs
, ISAC_MOCR
, cs
->dc
.isac
.mocr
);
306 cs
->dc
.isac
.mocr
&= 0xf0;
307 isac_write(cs
, ISAC_MOCR
, cs
->dc
.isac
.mocr
);
308 cs
->dc
.isac
.mocr
|= 0x0a;
309 isac_write(cs
, ISAC_MOCR
, cs
->dc
.isac
.mocr
);
310 sched_d_event(cs
, D_RX_MON0
);
313 cs
->dc
.isac
.mocr
&= 0x0f;
314 isac_write(cs
, ISAC_MOCR
, cs
->dc
.isac
.mocr
);
315 cs
->dc
.isac
.mocr
|= 0xa0;
316 isac_write(cs
, ISAC_MOCR
, cs
->dc
.isac
.mocr
);
317 sched_d_event(cs
, D_RX_MON1
);
320 if ((!cs
->dc
.isac
.mon_tx
) || (cs
->dc
.isac
.mon_txc
&&
321 (cs
->dc
.isac
.mon_txp
>= cs
->dc
.isac
.mon_txc
) &&
323 cs
->dc
.isac
.mocr
&= 0xf0;
324 isac_write(cs
, ISAC_MOCR
, cs
->dc
.isac
.mocr
);
325 cs
->dc
.isac
.mocr
|= 0x0a;
326 isac_write(cs
, ISAC_MOCR
, cs
->dc
.isac
.mocr
);
327 if (cs
->dc
.isac
.mon_txc
&&
328 (cs
->dc
.isac
.mon_txp
>= cs
->dc
.isac
.mon_txc
))
329 sched_d_event(cs
, D_TX_MON0
);
332 if (cs
->dc
.isac
.mon_txc
&& (cs
->dc
.isac
.mon_txp
>= cs
->dc
.isac
.mon_txc
)) {
333 sched_d_event(cs
, D_TX_MON0
);
336 isac_write(cs
, ISAC_MOX0
,
337 cs
->dc
.isac
.mon_tx
[cs
->dc
.isac
.mon_txp
++]);
338 if (cs
->debug
& L1_DEB_MONITOR
)
339 debugl1(cs
, "ISAC %02x -> MOX0", cs
->dc
.isac
.mon_tx
[cs
->dc
.isac
.mon_txp
-1]);
343 if ((!cs
->dc
.isac
.mon_tx
) || (cs
->dc
.isac
.mon_txc
&&
344 (cs
->dc
.isac
.mon_txp
>= cs
->dc
.isac
.mon_txc
) &&
346 cs
->dc
.isac
.mocr
&= 0x0f;
347 isac_write(cs
, ISAC_MOCR
, cs
->dc
.isac
.mocr
);
348 cs
->dc
.isac
.mocr
|= 0xa0;
349 isac_write(cs
, ISAC_MOCR
, cs
->dc
.isac
.mocr
);
350 if (cs
->dc
.isac
.mon_txc
&&
351 (cs
->dc
.isac
.mon_txp
>= cs
->dc
.isac
.mon_txc
))
352 sched_d_event(cs
, D_TX_MON1
);
355 if (cs
->dc
.isac
.mon_txc
&& (cs
->dc
.isac
.mon_txp
>= cs
->dc
.isac
.mon_txc
)) {
356 sched_d_event(cs
, D_TX_MON1
);
359 isac_write(cs
, ISAC_MOX1
,
360 cs
->dc
.isac
.mon_tx
[cs
->dc
.isac
.mon_txp
++]);
361 if (cs
->debug
& L1_DEB_MONITOR
)
362 debugl1(cs
, "ISAC %02x -> MOX1", cs
->dc
.isac
.mon_tx
[cs
->dc
.isac
.mon_txp
-1]);
371 ISAC_l1hw(struct PStack
*st
, int pr
, void *arg
)
373 struct IsdnCardState
*cs
= (struct IsdnCardState
*) st
->l1
.hardware
;
374 struct sk_buff
*skb
= arg
;
378 case (PH_DATA
|REQUEST
):
379 xmit_data_req_d(cs
, skb
);
381 case (PH_PULL
|INDICATION
):
382 xmit_pull_ind_d(cs
, skb
);
384 case (PH_PULL
| REQUEST
):
387 case (HW_RESET
| REQUEST
):
388 if ((cs
->dc
.isac
.ph_state
== ISAC_IND_EI
) ||
389 (cs
->dc
.isac
.ph_state
== ISAC_IND_DR
) ||
390 (cs
->dc
.isac
.ph_state
== ISAC_IND_RS
))
391 ph_command(cs
, ISAC_CMD_TIM
);
393 ph_command(cs
, ISAC_CMD_RS
);
395 case (HW_ENABLE
| REQUEST
):
396 ph_command(cs
, ISAC_CMD_TIM
);
398 case (HW_INFO3
| REQUEST
):
399 ph_command(cs
, ISAC_CMD_AR8
);
401 case (HW_TESTLOOP
| REQUEST
):
407 if (test_bit(HW_IOM1
, &cs
->HW_Flags
)) {
410 isac_write(cs
, ISAC_SPCR
, 0xa);
411 isac_write(cs
, ISAC_ADF1
, 0x2);
413 isac_write(cs
, ISAC_SPCR
, val
);
414 isac_write(cs
, ISAC_ADF1
, 0xa);
418 isac_write(cs
, ISAC_SPCR
, val
);
420 isac_write(cs
, ISAC_ADF1
, 0x8);
422 isac_write(cs
, ISAC_ADF1
, 0x0);
425 case (HW_DEACTIVATE
| RESPONSE
):
426 skb_queue_purge(&cs
->rq
);
427 skb_queue_purge(&cs
->sq
);
429 dev_kfree_skb_any(cs
->tx_skb
);
432 if (test_and_clear_bit(FLG_DBUSY_TIMER
, &cs
->HW_Flags
))
433 del_timer(&cs
->dbusytimer
);
434 if (test_and_clear_bit(FLG_L1_DBUSY
, &cs
->HW_Flags
))
435 sched_d_event(cs
, D_CLEARBUSY
);
438 if (cs
->debug
& L1_DEB_WARN
)
439 debugl1(cs
, "isac_l1hw unknown %04x", pr
);
445 setstack_isac(struct PStack
*st
, struct IsdnCardState
*cs
)
447 st
->l1
.l1hw
= ISAC_l1hw
;
452 DC_Close_isac(struct IsdnCardState
*cs
) {
453 if (cs
->dc
.isac
.mon_rx
) {
454 kfree(cs
->dc
.isac
.mon_rx
);
455 cs
->dc
.isac
.mon_rx
= NULL
;
457 if (cs
->dc
.isac
.mon_tx
) {
458 kfree(cs
->dc
.isac
.mon_tx
);
459 cs
->dc
.isac
.mon_tx
= NULL
;
464 dbusy_timer_handler(struct IsdnCardState
*cs
)
466 struct PStack
*stptr
;
469 if (test_bit(FLG_DBUSY_TIMER
, &cs
->HW_Flags
)) {
470 rbch
= isac_read(cs
, ISAC_RBCH
);
471 star
= isac_read(cs
, ISAC_STAR
);
473 debugl1(cs
, "D-Channel Busy RBCH %02x STAR %02x",
475 if (rbch
& ISAC_RBCH_XAC
) { /* D-Channel Busy */
476 test_and_set_bit(FLG_L1_DBUSY
, &cs
->HW_Flags
);
478 while (stptr
!= NULL
) {
479 L1L2(stptr
, PH_PAUSE
| INDICATION
, NULL
);
483 /* discard frame; reset transceiver */
484 test_and_clear_bit(FLG_DBUSY_TIMER
, &cs
->HW_Flags
);
486 dev_kfree_skb_any(cs
->tx_skb
);
490 printk(KERN_WARNING
"HiSax: ISAC D-Channel Busy no skb\n");
491 debugl1(cs
, "D-Channel Busy no skb");
493 isac_write(cs
, ISAC_CMDR
, 0x01); /* Transmitter reset */
494 cs
->card_ops
->irq_func(cs
->irq
, cs
, NULL
);
499 static struct dc_l1_ops isac_l1_ops
= {
500 .fill_fifo
= isac_fill_fifo
,
501 .open
= setstack_isac
,
502 .close
= DC_Close_isac
,
504 .dbusy_func
= dbusy_timer_handler
,
508 initisac(struct IsdnCardState
*cs
)
512 dc_l1_init(cs
, &isac_l1_ops
);
514 val
= isac_read(cs
, ISAC_STAR
);
515 debugl1(cs
, "ISAC STAR %x", val
);
516 val
= isac_read(cs
, ISAC_MODE
);
517 debugl1(cs
, "ISAC MODE %x", val
);
518 val
= isac_read(cs
, ISAC_ADF2
);
519 debugl1(cs
, "ISAC ADF2 %x", val
);
520 val
= isac_read(cs
, ISAC_ISTA
);
521 debugl1(cs
, "ISAC ISTA %x", val
);
523 eval
= isac_read(cs
, ISAC_EXIR
);
524 debugl1(cs
, "ISAC EXIR %x", eval
);
526 /* Disable all IRQ */
527 isac_write(cs
, ISAC_MASK
, 0xFF);
529 cs
->dc
.isac
.mon_tx
= NULL
;
530 cs
->dc
.isac
.mon_rx
= NULL
;
531 cs
->dc
.isac
.mocr
= 0xaa;
532 if (test_bit(HW_IOM1
, &cs
->HW_Flags
)) {
534 isac_write(cs
, ISAC_ADF2
, 0x0);
535 isac_write(cs
, ISAC_SPCR
, 0xa);
536 isac_write(cs
, ISAC_ADF1
, 0x2);
537 isac_write(cs
, ISAC_STCR
, 0x70);
538 isac_write(cs
, ISAC_MODE
, 0xc9);
541 if (!cs
->dc
.isac
.adf2
)
542 cs
->dc
.isac
.adf2
= 0x80;
543 isac_write(cs
, ISAC_ADF2
, cs
->dc
.isac
.adf2
);
544 isac_write(cs
, ISAC_SQXR
, 0x2f);
545 isac_write(cs
, ISAC_SPCR
, 0x00);
546 isac_write(cs
, ISAC_STCR
, 0x70);
547 isac_write(cs
, ISAC_MODE
, 0xc9);
548 isac_write(cs
, ISAC_TIMR
, 0x00);
549 isac_write(cs
, ISAC_ADF1
, 0x00);
551 ph_command(cs
, ISAC_CMD_RS
);
552 isac_write(cs
, ISAC_MASK
, 0x0);
554 val
= isac_read(cs
, ISAC_CIR0
);
555 debugl1(cs
, "ISAC CIR0 %x", val
);
556 cs
->dc
.isac
.ph_state
= (val
>> 2) & 0xf;
557 sched_d_event(cs
, D_L1STATECHANGE
);
559 /* RESET Receiver and Transmitter */
560 isac_write(cs
, ISAC_CMDR
, 0x41);
564 isac_setup(struct IsdnCardState
*cs
, struct dc_hw_ops
*isac_ops
)
566 cs
->dc_hw_ops
= isac_ops
;
567 ISACVersion(cs
, "HiSax:");