GNU Linux-libre 6.9.1-gnu
[releases.git] / drivers / isdn / hardware / mISDN / mISDNipac.c
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * isac.c   ISAC specific routines
4  *
5  * Author       Karsten Keil <keil@isdn4linux.de>
6  *
7  * Copyright 2009  by Karsten Keil <keil@isdn4linux.de>
8  */
9
10 #include <linux/irqreturn.h>
11 #include <linux/slab.h>
12 #include <linux/module.h>
13 #include <linux/mISDNhw.h>
14 #include "ipac.h"
15
16
17 #define DBUSY_TIMER_VALUE       80
18 #define ARCOFI_USE              1
19
20 #define ISAC_REV                "2.0"
21
22 MODULE_AUTHOR("Karsten Keil");
23 MODULE_VERSION(ISAC_REV);
24 MODULE_LICENSE("GPL v2");
25
26 #define ReadISAC(is, o)         (is->read_reg(is->dch.hw, o + is->off))
27 #define WriteISAC(is, o, v)     (is->write_reg(is->dch.hw, o + is->off, v))
28 #define ReadHSCX(h, o)          (h->ip->read_reg(h->ip->hw, h->off + o))
29 #define WriteHSCX(h, o, v)      (h->ip->write_reg(h->ip->hw, h->off + o, v))
30 #define ReadIPAC(ip, o)         (ip->read_reg(ip->hw, o))
31 #define WriteIPAC(ip, o, v)     (ip->write_reg(ip->hw, o, v))
32
33 static inline void
34 ph_command(struct isac_hw *isac, u8 command)
35 {
36         pr_debug("%s: ph_command %x\n", isac->name, command);
37         if (isac->type & IPAC_TYPE_ISACX)
38                 WriteISAC(isac, ISACX_CIX0, (command << 4) | 0xE);
39         else
40                 WriteISAC(isac, ISAC_CIX0, (command << 2) | 3);
41 }
42
43 static void
44 isac_ph_state_change(struct isac_hw *isac)
45 {
46         switch (isac->state) {
47         case (ISAC_IND_RS):
48         case (ISAC_IND_EI):
49                 ph_command(isac, ISAC_CMD_DUI);
50         }
51         schedule_event(&isac->dch, FLG_PHCHANGE);
52 }
53
54 static void
55 isac_ph_state_bh(struct dchannel *dch)
56 {
57         struct isac_hw *isac = container_of(dch, struct isac_hw, dch);
58
59         switch (isac->state) {
60         case ISAC_IND_RS:
61         case ISAC_IND_EI:
62                 dch->state = 0;
63                 l1_event(dch->l1, HW_RESET_IND);
64                 break;
65         case ISAC_IND_DID:
66                 dch->state = 3;
67                 l1_event(dch->l1, HW_DEACT_CNF);
68                 break;
69         case ISAC_IND_DR:
70         case ISAC_IND_DR6:
71                 dch->state = 3;
72                 l1_event(dch->l1, HW_DEACT_IND);
73                 break;
74         case ISAC_IND_PU:
75                 dch->state = 4;
76                 l1_event(dch->l1, HW_POWERUP_IND);
77                 break;
78         case ISAC_IND_RSY:
79                 if (dch->state <= 5) {
80                         dch->state = 5;
81                         l1_event(dch->l1, ANYSIGNAL);
82                 } else {
83                         dch->state = 8;
84                         l1_event(dch->l1, LOSTFRAMING);
85                 }
86                 break;
87         case ISAC_IND_ARD:
88                 dch->state = 6;
89                 l1_event(dch->l1, INFO2);
90                 break;
91         case ISAC_IND_AI8:
92                 dch->state = 7;
93                 l1_event(dch->l1, INFO4_P8);
94                 break;
95         case ISAC_IND_AI10:
96                 dch->state = 7;
97                 l1_event(dch->l1, INFO4_P10);
98                 break;
99         }
100         pr_debug("%s: TE newstate %x\n", isac->name, dch->state);
101 }
102
103 static void
104 isac_empty_fifo(struct isac_hw *isac, int count)
105 {
106         u8 *ptr;
107
108         pr_debug("%s: %s  %d\n", isac->name, __func__, count);
109
110         if (!isac->dch.rx_skb) {
111                 isac->dch.rx_skb = mI_alloc_skb(isac->dch.maxlen, GFP_ATOMIC);
112                 if (!isac->dch.rx_skb) {
113                         pr_info("%s: D receive out of memory\n", isac->name);
114                         WriteISAC(isac, ISAC_CMDR, 0x80);
115                         return;
116                 }
117         }
118         if ((isac->dch.rx_skb->len + count) >= isac->dch.maxlen) {
119                 pr_debug("%s: %s overrun %d\n", isac->name, __func__,
120                          isac->dch.rx_skb->len + count);
121                 WriteISAC(isac, ISAC_CMDR, 0x80);
122                 return;
123         }
124         ptr = skb_put(isac->dch.rx_skb, count);
125         isac->read_fifo(isac->dch.hw, isac->off, ptr, count);
126         WriteISAC(isac, ISAC_CMDR, 0x80);
127         if (isac->dch.debug & DEBUG_HW_DFIFO) {
128                 char    pfx[MISDN_MAX_IDLEN + 16];
129
130                 snprintf(pfx, MISDN_MAX_IDLEN + 15, "D-recv %s %d ",
131                          isac->name, count);
132                 print_hex_dump_bytes(pfx, DUMP_PREFIX_OFFSET, ptr, count);
133         }
134 }
135
136 static void
137 isac_fill_fifo(struct isac_hw *isac)
138 {
139         int count, more;
140         u8 *ptr;
141
142         if (!isac->dch.tx_skb)
143                 return;
144         count = isac->dch.tx_skb->len - isac->dch.tx_idx;
145         if (count <= 0)
146                 return;
147
148         more = 0;
149         if (count > 32) {
150                 more = !0;
151                 count = 32;
152         }
153         pr_debug("%s: %s  %d\n", isac->name, __func__, count);
154         ptr = isac->dch.tx_skb->data + isac->dch.tx_idx;
155         isac->dch.tx_idx += count;
156         isac->write_fifo(isac->dch.hw, isac->off, ptr, count);
157         WriteISAC(isac, ISAC_CMDR, more ? 0x8 : 0xa);
158         if (test_and_set_bit(FLG_BUSY_TIMER, &isac->dch.Flags)) {
159                 pr_debug("%s: %s dbusytimer running\n", isac->name, __func__);
160                 del_timer(&isac->dch.timer);
161         }
162         isac->dch.timer.expires = jiffies + ((DBUSY_TIMER_VALUE * HZ)/1000);
163         add_timer(&isac->dch.timer);
164         if (isac->dch.debug & DEBUG_HW_DFIFO) {
165                 char    pfx[MISDN_MAX_IDLEN + 16];
166
167                 snprintf(pfx, MISDN_MAX_IDLEN + 15, "D-send %s %d ",
168                          isac->name, count);
169                 print_hex_dump_bytes(pfx, DUMP_PREFIX_OFFSET, ptr, count);
170         }
171 }
172
173 static void
174 isac_rme_irq(struct isac_hw *isac)
175 {
176         u8 val, count;
177
178         val = ReadISAC(isac, ISAC_RSTA);
179         if ((val & 0x70) != 0x20) {
180                 if (val & 0x40) {
181                         pr_debug("%s: ISAC RDO\n", isac->name);
182 #ifdef ERROR_STATISTIC
183                         isac->dch.err_rx++;
184 #endif
185                 }
186                 if (!(val & 0x20)) {
187                         pr_debug("%s: ISAC CRC error\n", isac->name);
188 #ifdef ERROR_STATISTIC
189                         isac->dch.err_crc++;
190 #endif
191                 }
192                 WriteISAC(isac, ISAC_CMDR, 0x80);
193                 dev_kfree_skb(isac->dch.rx_skb);
194                 isac->dch.rx_skb = NULL;
195         } else {
196                 count = ReadISAC(isac, ISAC_RBCL) & 0x1f;
197                 if (count == 0)
198                         count = 32;
199                 isac_empty_fifo(isac, count);
200                 recv_Dchannel(&isac->dch);
201         }
202 }
203
204 static void
205 isac_xpr_irq(struct isac_hw *isac)
206 {
207         if (test_and_clear_bit(FLG_BUSY_TIMER, &isac->dch.Flags))
208                 del_timer(&isac->dch.timer);
209         if (isac->dch.tx_skb && isac->dch.tx_idx < isac->dch.tx_skb->len) {
210                 isac_fill_fifo(isac);
211         } else {
212                 dev_kfree_skb(isac->dch.tx_skb);
213                 if (get_next_dframe(&isac->dch))
214                         isac_fill_fifo(isac);
215         }
216 }
217
218 static void
219 isac_retransmit(struct isac_hw *isac)
220 {
221         if (test_and_clear_bit(FLG_BUSY_TIMER, &isac->dch.Flags))
222                 del_timer(&isac->dch.timer);
223         if (test_bit(FLG_TX_BUSY, &isac->dch.Flags)) {
224                 /* Restart frame */
225                 isac->dch.tx_idx = 0;
226                 isac_fill_fifo(isac);
227         } else if (isac->dch.tx_skb) { /* should not happen */
228                 pr_info("%s: tx_skb exist but not busy\n", isac->name);
229                 test_and_set_bit(FLG_TX_BUSY, &isac->dch.Flags);
230                 isac->dch.tx_idx = 0;
231                 isac_fill_fifo(isac);
232         } else {
233                 pr_info("%s: ISAC XDU no TX_BUSY\n", isac->name);
234                 if (get_next_dframe(&isac->dch))
235                         isac_fill_fifo(isac);
236         }
237 }
238
239 static void
240 isac_mos_irq(struct isac_hw *isac)
241 {
242         u8 val;
243         int ret;
244
245         val = ReadISAC(isac, ISAC_MOSR);
246         pr_debug("%s: ISAC MOSR %02x\n", isac->name, val);
247 #if ARCOFI_USE
248         if (val & 0x08) {
249                 if (!isac->mon_rx) {
250                         isac->mon_rx = kmalloc(MAX_MON_FRAME, GFP_ATOMIC);
251                         if (!isac->mon_rx) {
252                                 pr_info("%s: ISAC MON RX out of memory!\n",
253                                         isac->name);
254                                 isac->mocr &= 0xf0;
255                                 isac->mocr |= 0x0a;
256                                 WriteISAC(isac, ISAC_MOCR, isac->mocr);
257                                 goto afterMONR0;
258                         } else
259                                 isac->mon_rxp = 0;
260                 }
261                 if (isac->mon_rxp >= MAX_MON_FRAME) {
262                         isac->mocr &= 0xf0;
263                         isac->mocr |= 0x0a;
264                         WriteISAC(isac, ISAC_MOCR, isac->mocr);
265                         isac->mon_rxp = 0;
266                         pr_debug("%s: ISAC MON RX overflow!\n", isac->name);
267                         goto afterMONR0;
268                 }
269                 isac->mon_rx[isac->mon_rxp++] = ReadISAC(isac, ISAC_MOR0);
270                 pr_debug("%s: ISAC MOR0 %02x\n", isac->name,
271                          isac->mon_rx[isac->mon_rxp - 1]);
272                 if (isac->mon_rxp == 1) {
273                         isac->mocr |= 0x04;
274                         WriteISAC(isac, ISAC_MOCR, isac->mocr);
275                 }
276         }
277 afterMONR0:
278         if (val & 0x80) {
279                 if (!isac->mon_rx) {
280                         isac->mon_rx = kmalloc(MAX_MON_FRAME, GFP_ATOMIC);
281                         if (!isac->mon_rx) {
282                                 pr_info("%s: ISAC MON RX out of memory!\n",
283                                         isac->name);
284                                 isac->mocr &= 0x0f;
285                                 isac->mocr |= 0xa0;
286                                 WriteISAC(isac, ISAC_MOCR, isac->mocr);
287                                 goto afterMONR1;
288                         } else
289                                 isac->mon_rxp = 0;
290                 }
291                 if (isac->mon_rxp >= MAX_MON_FRAME) {
292                         isac->mocr &= 0x0f;
293                         isac->mocr |= 0xa0;
294                         WriteISAC(isac, ISAC_MOCR, isac->mocr);
295                         isac->mon_rxp = 0;
296                         pr_debug("%s: ISAC MON RX overflow!\n", isac->name);
297                         goto afterMONR1;
298                 }
299                 isac->mon_rx[isac->mon_rxp++] = ReadISAC(isac, ISAC_MOR1);
300                 pr_debug("%s: ISAC MOR1 %02x\n", isac->name,
301                          isac->mon_rx[isac->mon_rxp - 1]);
302                 isac->mocr |= 0x40;
303                 WriteISAC(isac, ISAC_MOCR, isac->mocr);
304         }
305 afterMONR1:
306         if (val & 0x04) {
307                 isac->mocr &= 0xf0;
308                 WriteISAC(isac, ISAC_MOCR, isac->mocr);
309                 isac->mocr |= 0x0a;
310                 WriteISAC(isac, ISAC_MOCR, isac->mocr);
311                 if (isac->monitor) {
312                         ret = isac->monitor(isac->dch.hw, MONITOR_RX_0,
313                                             isac->mon_rx, isac->mon_rxp);
314                         if (ret)
315                                 kfree(isac->mon_rx);
316                 } else {
317                         pr_info("%s: MONITOR 0 received %d but no user\n",
318                                 isac->name, isac->mon_rxp);
319                         kfree(isac->mon_rx);
320                 }
321                 isac->mon_rx = NULL;
322                 isac->mon_rxp = 0;
323         }
324         if (val & 0x40) {
325                 isac->mocr &= 0x0f;
326                 WriteISAC(isac, ISAC_MOCR, isac->mocr);
327                 isac->mocr |= 0xa0;
328                 WriteISAC(isac, ISAC_MOCR, isac->mocr);
329                 if (isac->monitor) {
330                         ret = isac->monitor(isac->dch.hw, MONITOR_RX_1,
331                                             isac->mon_rx, isac->mon_rxp);
332                         if (ret)
333                                 kfree(isac->mon_rx);
334                 } else {
335                         pr_info("%s: MONITOR 1 received %d but no user\n",
336                                 isac->name, isac->mon_rxp);
337                         kfree(isac->mon_rx);
338                 }
339                 isac->mon_rx = NULL;
340                 isac->mon_rxp = 0;
341         }
342         if (val & 0x02) {
343                 if ((!isac->mon_tx) || (isac->mon_txc &&
344                                         (isac->mon_txp >= isac->mon_txc) && !(val & 0x08))) {
345                         isac->mocr &= 0xf0;
346                         WriteISAC(isac, ISAC_MOCR, isac->mocr);
347                         isac->mocr |= 0x0a;
348                         WriteISAC(isac, ISAC_MOCR, isac->mocr);
349                         if (isac->mon_txc && (isac->mon_txp >= isac->mon_txc)) {
350                                 if (isac->monitor)
351                                         isac->monitor(isac->dch.hw,
352                                                       MONITOR_TX_0, NULL, 0);
353                         }
354                         kfree(isac->mon_tx);
355                         isac->mon_tx = NULL;
356                         isac->mon_txc = 0;
357                         isac->mon_txp = 0;
358                         goto AfterMOX0;
359                 }
360                 if (isac->mon_txc && (isac->mon_txp >= isac->mon_txc)) {
361                         if (isac->monitor)
362                                 isac->monitor(isac->dch.hw,
363                                               MONITOR_TX_0, NULL, 0);
364                         kfree(isac->mon_tx);
365                         isac->mon_tx = NULL;
366                         isac->mon_txc = 0;
367                         isac->mon_txp = 0;
368                         goto AfterMOX0;
369                 }
370                 WriteISAC(isac, ISAC_MOX0, isac->mon_tx[isac->mon_txp++]);
371                 pr_debug("%s: ISAC %02x -> MOX0\n", isac->name,
372                          isac->mon_tx[isac->mon_txp - 1]);
373         }
374 AfterMOX0:
375         if (val & 0x20) {
376                 if ((!isac->mon_tx) || (isac->mon_txc &&
377                                         (isac->mon_txp >= isac->mon_txc) && !(val & 0x80))) {
378                         isac->mocr &= 0x0f;
379                         WriteISAC(isac, ISAC_MOCR, isac->mocr);
380                         isac->mocr |= 0xa0;
381                         WriteISAC(isac, ISAC_MOCR, isac->mocr);
382                         if (isac->mon_txc && (isac->mon_txp >= isac->mon_txc)) {
383                                 if (isac->monitor)
384                                         isac->monitor(isac->dch.hw,
385                                                       MONITOR_TX_1, NULL, 0);
386                         }
387                         kfree(isac->mon_tx);
388                         isac->mon_tx = NULL;
389                         isac->mon_txc = 0;
390                         isac->mon_txp = 0;
391                         goto AfterMOX1;
392                 }
393                 if (isac->mon_txc && (isac->mon_txp >= isac->mon_txc)) {
394                         if (isac->monitor)
395                                 isac->monitor(isac->dch.hw,
396                                               MONITOR_TX_1, NULL, 0);
397                         kfree(isac->mon_tx);
398                         isac->mon_tx = NULL;
399                         isac->mon_txc = 0;
400                         isac->mon_txp = 0;
401                         goto AfterMOX1;
402                 }
403                 WriteISAC(isac, ISAC_MOX1, isac->mon_tx[isac->mon_txp++]);
404                 pr_debug("%s: ISAC %02x -> MOX1\n", isac->name,
405                          isac->mon_tx[isac->mon_txp - 1]);
406         }
407 AfterMOX1:
408         val = 0; /* dummy to avoid warning */
409 #endif
410 }
411
412 static void
413 isac_cisq_irq(struct isac_hw *isac) {
414         u8 val;
415
416         val = ReadISAC(isac, ISAC_CIR0);
417         pr_debug("%s: ISAC CIR0 %02X\n", isac->name, val);
418         if (val & 2) {
419                 pr_debug("%s: ph_state change %x->%x\n", isac->name,
420                          isac->state, (val >> 2) & 0xf);
421                 isac->state = (val >> 2) & 0xf;
422                 isac_ph_state_change(isac);
423         }
424         if (val & 1) {
425                 val = ReadISAC(isac, ISAC_CIR1);
426                 pr_debug("%s: ISAC CIR1 %02X\n", isac->name, val);
427         }
428 }
429
430 static void
431 isacsx_cic_irq(struct isac_hw *isac)
432 {
433         u8 val;
434
435         val = ReadISAC(isac, ISACX_CIR0);
436         pr_debug("%s: ISACX CIR0 %02X\n", isac->name, val);
437         if (val & ISACX_CIR0_CIC0) {
438                 pr_debug("%s: ph_state change %x->%x\n", isac->name,
439                          isac->state, val >> 4);
440                 isac->state = val >> 4;
441                 isac_ph_state_change(isac);
442         }
443 }
444
445 static void
446 isacsx_rme_irq(struct isac_hw *isac)
447 {
448         int count;
449         u8 val;
450
451         val = ReadISAC(isac, ISACX_RSTAD);
452         if ((val & (ISACX_RSTAD_VFR |
453                     ISACX_RSTAD_RDO |
454                     ISACX_RSTAD_CRC |
455                     ISACX_RSTAD_RAB))
456             != (ISACX_RSTAD_VFR | ISACX_RSTAD_CRC)) {
457                 pr_debug("%s: RSTAD %#x, dropped\n", isac->name, val);
458 #ifdef ERROR_STATISTIC
459                 if (val & ISACX_RSTAD_CRC)
460                         isac->dch.err_rx++;
461                 else
462                         isac->dch.err_crc++;
463 #endif
464                 WriteISAC(isac, ISACX_CMDRD, ISACX_CMDRD_RMC);
465                 dev_kfree_skb(isac->dch.rx_skb);
466                 isac->dch.rx_skb = NULL;
467         } else {
468                 count = ReadISAC(isac, ISACX_RBCLD) & 0x1f;
469                 if (count == 0)
470                         count = 32;
471                 isac_empty_fifo(isac, count);
472                 if (isac->dch.rx_skb) {
473                         skb_trim(isac->dch.rx_skb, isac->dch.rx_skb->len - 1);
474                         pr_debug("%s: dchannel received %d\n", isac->name,
475                                  isac->dch.rx_skb->len);
476                         recv_Dchannel(&isac->dch);
477                 }
478         }
479 }
480
481 irqreturn_t
482 mISDNisac_irq(struct isac_hw *isac, u8 val)
483 {
484         if (unlikely(!val))
485                 return IRQ_NONE;
486         pr_debug("%s: ISAC interrupt %02x\n", isac->name, val);
487         if (isac->type & IPAC_TYPE_ISACX) {
488                 if (val & ISACX__CIC)
489                         isacsx_cic_irq(isac);
490                 if (val & ISACX__ICD) {
491                         val = ReadISAC(isac, ISACX_ISTAD);
492                         pr_debug("%s: ISTAD %02x\n", isac->name, val);
493                         if (val & ISACX_D_XDU) {
494                                 pr_debug("%s: ISAC XDU\n", isac->name);
495 #ifdef ERROR_STATISTIC
496                                 isac->dch.err_tx++;
497 #endif
498                                 isac_retransmit(isac);
499                         }
500                         if (val & ISACX_D_XMR) {
501                                 pr_debug("%s: ISAC XMR\n", isac->name);
502 #ifdef ERROR_STATISTIC
503                                 isac->dch.err_tx++;
504 #endif
505                                 isac_retransmit(isac);
506                         }
507                         if (val & ISACX_D_XPR)
508                                 isac_xpr_irq(isac);
509                         if (val & ISACX_D_RFO) {
510                                 pr_debug("%s: ISAC RFO\n", isac->name);
511                                 WriteISAC(isac, ISACX_CMDRD, ISACX_CMDRD_RMC);
512                         }
513                         if (val & ISACX_D_RME)
514                                 isacsx_rme_irq(isac);
515                         if (val & ISACX_D_RPF)
516                                 isac_empty_fifo(isac, 0x20);
517                 }
518         } else {
519                 if (val & 0x80) /* RME */
520                         isac_rme_irq(isac);
521                 if (val & 0x40) /* RPF */
522                         isac_empty_fifo(isac, 32);
523                 if (val & 0x10) /* XPR */
524                         isac_xpr_irq(isac);
525                 if (val & 0x04) /* CISQ */
526                         isac_cisq_irq(isac);
527                 if (val & 0x20) /* RSC - never */
528                         pr_debug("%s: ISAC RSC interrupt\n", isac->name);
529                 if (val & 0x02) /* SIN - never */
530                         pr_debug("%s: ISAC SIN interrupt\n", isac->name);
531                 if (val & 0x01) {       /* EXI */
532                         val = ReadISAC(isac, ISAC_EXIR);
533                         pr_debug("%s: ISAC EXIR %02x\n", isac->name, val);
534                         if (val & 0x80) /* XMR */
535                                 pr_debug("%s: ISAC XMR\n", isac->name);
536                         if (val & 0x40) { /* XDU */
537                                 pr_debug("%s: ISAC XDU\n", isac->name);
538 #ifdef ERROR_STATISTIC
539                                 isac->dch.err_tx++;
540 #endif
541                                 isac_retransmit(isac);
542                         }
543                         if (val & 0x04) /* MOS */
544                                 isac_mos_irq(isac);
545                 }
546         }
547         return IRQ_HANDLED;
548 }
549 EXPORT_SYMBOL(mISDNisac_irq);
550
551 static int
552 isac_l1hw(struct mISDNchannel *ch, struct sk_buff *skb)
553 {
554         struct mISDNdevice      *dev = container_of(ch, struct mISDNdevice, D);
555         struct dchannel         *dch = container_of(dev, struct dchannel, dev);
556         struct isac_hw          *isac = container_of(dch, struct isac_hw, dch);
557         int                     ret = -EINVAL;
558         struct mISDNhead        *hh = mISDN_HEAD_P(skb);
559         u32                     id;
560         u_long                  flags;
561
562         switch (hh->prim) {
563         case PH_DATA_REQ:
564                 spin_lock_irqsave(isac->hwlock, flags);
565                 ret = dchannel_senddata(dch, skb);
566                 if (ret > 0) { /* direct TX */
567                         id = hh->id; /* skb can be freed */
568                         isac_fill_fifo(isac);
569                         ret = 0;
570                         spin_unlock_irqrestore(isac->hwlock, flags);
571                         queue_ch_frame(ch, PH_DATA_CNF, id, NULL);
572                 } else
573                         spin_unlock_irqrestore(isac->hwlock, flags);
574                 return ret;
575         case PH_ACTIVATE_REQ:
576                 ret = l1_event(dch->l1, hh->prim);
577                 break;
578         case PH_DEACTIVATE_REQ:
579                 test_and_clear_bit(FLG_L2_ACTIVATED, &dch->Flags);
580                 ret = l1_event(dch->l1, hh->prim);
581                 break;
582         }
583
584         if (!ret)
585                 dev_kfree_skb(skb);
586         return ret;
587 }
588
589 static int
590 isac_ctrl(struct isac_hw *isac, u32 cmd, unsigned long para)
591 {
592         u8 tl = 0;
593         unsigned long flags;
594         int ret = 0;
595
596         switch (cmd) {
597         case HW_TESTLOOP:
598                 spin_lock_irqsave(isac->hwlock, flags);
599                 if (!(isac->type & IPAC_TYPE_ISACX)) {
600                         /* TODO: implement for IPAC_TYPE_ISACX */
601                         if (para & 1) /* B1 */
602                                 tl |= 0x0c;
603                         else if (para & 2) /* B2 */
604                                 tl |= 0x3;
605                         /* we only support IOM2 mode */
606                         WriteISAC(isac, ISAC_SPCR, tl);
607                         if (tl)
608                                 WriteISAC(isac, ISAC_ADF1, 0x8);
609                         else
610                                 WriteISAC(isac, ISAC_ADF1, 0x0);
611                 }
612                 spin_unlock_irqrestore(isac->hwlock, flags);
613                 break;
614         case HW_TIMER3_VALUE:
615                 ret = l1_event(isac->dch.l1, HW_TIMER3_VALUE | (para & 0xff));
616                 break;
617         default:
618                 pr_debug("%s: %s unknown command %x %lx\n", isac->name,
619                          __func__, cmd, para);
620                 ret = -1;
621         }
622         return ret;
623 }
624
625 static int
626 isac_l1cmd(struct dchannel *dch, u32 cmd)
627 {
628         struct isac_hw *isac = container_of(dch, struct isac_hw, dch);
629         u_long flags;
630
631         pr_debug("%s: cmd(%x) state(%02x)\n", isac->name, cmd, isac->state);
632         switch (cmd) {
633         case INFO3_P8:
634                 spin_lock_irqsave(isac->hwlock, flags);
635                 ph_command(isac, ISAC_CMD_AR8);
636                 spin_unlock_irqrestore(isac->hwlock, flags);
637                 break;
638         case INFO3_P10:
639                 spin_lock_irqsave(isac->hwlock, flags);
640                 ph_command(isac, ISAC_CMD_AR10);
641                 spin_unlock_irqrestore(isac->hwlock, flags);
642                 break;
643         case HW_RESET_REQ:
644                 spin_lock_irqsave(isac->hwlock, flags);
645                 if ((isac->state == ISAC_IND_EI) ||
646                     (isac->state == ISAC_IND_DR) ||
647                     (isac->state == ISAC_IND_DR6) ||
648                     (isac->state == ISAC_IND_RS))
649                         ph_command(isac, ISAC_CMD_TIM);
650                 else
651                         ph_command(isac, ISAC_CMD_RS);
652                 spin_unlock_irqrestore(isac->hwlock, flags);
653                 break;
654         case HW_DEACT_REQ:
655                 skb_queue_purge(&dch->squeue);
656                 if (dch->tx_skb) {
657                         dev_kfree_skb(dch->tx_skb);
658                         dch->tx_skb = NULL;
659                 }
660                 dch->tx_idx = 0;
661                 if (dch->rx_skb) {
662                         dev_kfree_skb(dch->rx_skb);
663                         dch->rx_skb = NULL;
664                 }
665                 test_and_clear_bit(FLG_TX_BUSY, &dch->Flags);
666                 if (test_and_clear_bit(FLG_BUSY_TIMER, &dch->Flags))
667                         del_timer(&dch->timer);
668                 break;
669         case HW_POWERUP_REQ:
670                 spin_lock_irqsave(isac->hwlock, flags);
671                 ph_command(isac, ISAC_CMD_TIM);
672                 spin_unlock_irqrestore(isac->hwlock, flags);
673                 break;
674         case PH_ACTIVATE_IND:
675                 test_and_set_bit(FLG_ACTIVE, &dch->Flags);
676                 _queue_data(&dch->dev.D, cmd, MISDN_ID_ANY, 0, NULL,
677                             GFP_ATOMIC);
678                 break;
679         case PH_DEACTIVATE_IND:
680                 test_and_clear_bit(FLG_ACTIVE, &dch->Flags);
681                 _queue_data(&dch->dev.D, cmd, MISDN_ID_ANY, 0, NULL,
682                             GFP_ATOMIC);
683                 break;
684         default:
685                 pr_debug("%s: %s unknown command %x\n", isac->name,
686                          __func__, cmd);
687                 return -1;
688         }
689         return 0;
690 }
691
692 static void
693 isac_release(struct isac_hw *isac)
694 {
695         if (isac->type & IPAC_TYPE_ISACX)
696                 WriteISAC(isac, ISACX_MASK, 0xff);
697         else if (isac->type != 0)
698                 WriteISAC(isac, ISAC_MASK, 0xff);
699         if (isac->dch.timer.function != NULL) {
700                 del_timer(&isac->dch.timer);
701                 isac->dch.timer.function = NULL;
702         }
703         kfree(isac->mon_rx);
704         isac->mon_rx = NULL;
705         kfree(isac->mon_tx);
706         isac->mon_tx = NULL;
707         if (isac->dch.l1)
708                 l1_event(isac->dch.l1, CLOSE_CHANNEL);
709         mISDN_freedchannel(&isac->dch);
710 }
711
712 static void
713 dbusy_timer_handler(struct timer_list *t)
714 {
715         struct isac_hw *isac = from_timer(isac, t, dch.timer);
716         int rbch, star;
717         u_long flags;
718
719         if (test_bit(FLG_BUSY_TIMER, &isac->dch.Flags)) {
720                 spin_lock_irqsave(isac->hwlock, flags);
721                 rbch = ReadISAC(isac, ISAC_RBCH);
722                 star = ReadISAC(isac, ISAC_STAR);
723                 pr_debug("%s: D-Channel Busy RBCH %02x STAR %02x\n",
724                          isac->name, rbch, star);
725                 if (rbch & ISAC_RBCH_XAC) /* D-Channel Busy */
726                         test_and_set_bit(FLG_L1_BUSY, &isac->dch.Flags);
727                 else {
728                         /* discard frame; reset transceiver */
729                         test_and_clear_bit(FLG_BUSY_TIMER, &isac->dch.Flags);
730                         if (isac->dch.tx_idx)
731                                 isac->dch.tx_idx = 0;
732                         else
733                                 pr_info("%s: ISAC D-Channel Busy no tx_idx\n",
734                                         isac->name);
735                         /* Transmitter reset */
736                         WriteISAC(isac, ISAC_CMDR, 0x01);
737                 }
738                 spin_unlock_irqrestore(isac->hwlock, flags);
739         }
740 }
741
742 static int
743 open_dchannel_caller(struct isac_hw *isac, struct channel_req *rq, void *caller)
744 {
745         pr_debug("%s: %s dev(%d) open from %p\n", isac->name, __func__,
746                  isac->dch.dev.id, caller);
747         if (rq->protocol != ISDN_P_TE_S0)
748                 return -EINVAL;
749         if (rq->adr.channel == 1)
750                 /* E-Channel not supported */
751                 return -EINVAL;
752         rq->ch = &isac->dch.dev.D;
753         rq->ch->protocol = rq->protocol;
754         if (isac->dch.state == 7)
755                 _queue_data(rq->ch, PH_ACTIVATE_IND, MISDN_ID_ANY,
756                             0, NULL, GFP_KERNEL);
757         return 0;
758 }
759
760 static int
761 open_dchannel(struct isac_hw *isac, struct channel_req *rq)
762 {
763         return open_dchannel_caller(isac, rq, __builtin_return_address(0));
764 }
765
766 static const char *ISACVer[] =
767 {"2086/2186 V1.1", "2085 B1", "2085 B2",
768  "2085 V2.3"};
769
770 static int
771 isac_init(struct isac_hw *isac)
772 {
773         u8 val;
774         int err = 0;
775
776         if (!isac->dch.l1) {
777                 err = create_l1(&isac->dch, isac_l1cmd);
778                 if (err)
779                         return err;
780         }
781         isac->mon_tx = NULL;
782         isac->mon_rx = NULL;
783         timer_setup(&isac->dch.timer, dbusy_timer_handler, 0);
784         isac->mocr = 0xaa;
785         if (isac->type & IPAC_TYPE_ISACX) {
786                 /* Disable all IRQ */
787                 WriteISAC(isac, ISACX_MASK, 0xff);
788                 val = ReadISAC(isac, ISACX_STARD);
789                 pr_debug("%s: ISACX STARD %x\n", isac->name, val);
790                 val = ReadISAC(isac, ISACX_ISTAD);
791                 pr_debug("%s: ISACX ISTAD %x\n", isac->name, val);
792                 val = ReadISAC(isac, ISACX_ISTA);
793                 pr_debug("%s: ISACX ISTA %x\n", isac->name, val);
794                 /* clear LDD */
795                 WriteISAC(isac, ISACX_TR_CONF0, 0x00);
796                 /* enable transmitter */
797                 WriteISAC(isac, ISACX_TR_CONF2, 0x00);
798                 /* transparent mode 0, RAC, stop/go */
799                 WriteISAC(isac, ISACX_MODED, 0xc9);
800                 /* all HDLC IRQ unmasked */
801                 val = ReadISAC(isac, ISACX_ID);
802                 if (isac->dch.debug & DEBUG_HW)
803                         pr_notice("%s: ISACX Design ID %x\n",
804                                   isac->name, val & 0x3f);
805                 val = ReadISAC(isac, ISACX_CIR0);
806                 pr_debug("%s: ISACX CIR0 %02X\n", isac->name, val);
807                 isac->state = val >> 4;
808                 isac_ph_state_change(isac);
809                 ph_command(isac, ISAC_CMD_RS);
810                 WriteISAC(isac, ISACX_MASK, IPACX__ON);
811                 WriteISAC(isac, ISACX_MASKD, 0x00);
812         } else { /* old isac */
813                 WriteISAC(isac, ISAC_MASK, 0xff);
814                 val = ReadISAC(isac, ISAC_STAR);
815                 pr_debug("%s: ISAC STAR %x\n", isac->name, val);
816                 val = ReadISAC(isac, ISAC_MODE);
817                 pr_debug("%s: ISAC MODE %x\n", isac->name, val);
818                 val = ReadISAC(isac, ISAC_ADF2);
819                 pr_debug("%s: ISAC ADF2 %x\n", isac->name, val);
820                 val = ReadISAC(isac, ISAC_ISTA);
821                 pr_debug("%s: ISAC ISTA %x\n", isac->name, val);
822                 if (val & 0x01) {
823                         val = ReadISAC(isac, ISAC_EXIR);
824                         pr_debug("%s: ISAC EXIR %x\n", isac->name, val);
825                 }
826                 val = ReadISAC(isac, ISAC_RBCH);
827                 if (isac->dch.debug & DEBUG_HW)
828                         pr_notice("%s: ISAC version (%x): %s\n", isac->name,
829                                   val, ISACVer[(val >> 5) & 3]);
830                 isac->type |= ((val >> 5) & 3);
831                 if (!isac->adf2)
832                         isac->adf2 = 0x80;
833                 if (!(isac->adf2 & 0x80)) { /* only IOM 2 Mode */
834                         pr_info("%s: only support IOM2 mode but adf2=%02x\n",
835                                 isac->name, isac->adf2);
836                         isac_release(isac);
837                         return -EINVAL;
838                 }
839                 WriteISAC(isac, ISAC_ADF2, isac->adf2);
840                 WriteISAC(isac, ISAC_SQXR, 0x2f);
841                 WriteISAC(isac, ISAC_SPCR, 0x00);
842                 WriteISAC(isac, ISAC_STCR, 0x70);
843                 WriteISAC(isac, ISAC_MODE, 0xc9);
844                 WriteISAC(isac, ISAC_TIMR, 0x00);
845                 WriteISAC(isac, ISAC_ADF1, 0x00);
846                 val = ReadISAC(isac, ISAC_CIR0);
847                 pr_debug("%s: ISAC CIR0 %x\n", isac->name, val);
848                 isac->state = (val >> 2) & 0xf;
849                 isac_ph_state_change(isac);
850                 ph_command(isac, ISAC_CMD_RS);
851                 WriteISAC(isac, ISAC_MASK, 0);
852         }
853         return err;
854 }
855
856 int
857 mISDNisac_init(struct isac_hw *isac, void *hw)
858 {
859         mISDN_initdchannel(&isac->dch, MAX_DFRAME_LEN_L1, isac_ph_state_bh);
860         isac->dch.hw = hw;
861         isac->dch.dev.D.send = isac_l1hw;
862         isac->init = isac_init;
863         isac->release = isac_release;
864         isac->ctrl = isac_ctrl;
865         isac->open = open_dchannel;
866         isac->dch.dev.Dprotocols = (1 << ISDN_P_TE_S0);
867         isac->dch.dev.nrbchan = 2;
868         return 0;
869 }
870 EXPORT_SYMBOL(mISDNisac_init);
871
872 static void
873 waitforCEC(struct hscx_hw *hx)
874 {
875         u8 starb, to = 50;
876
877         while (to) {
878                 starb = ReadHSCX(hx, IPAC_STARB);
879                 if (!(starb & 0x04))
880                         break;
881                 udelay(1);
882                 to--;
883         }
884         if (to < 50)
885                 pr_debug("%s: B%1d CEC %d us\n", hx->ip->name, hx->bch.nr,
886                          50 - to);
887         if (!to)
888                 pr_info("%s: B%1d CEC timeout\n", hx->ip->name, hx->bch.nr);
889 }
890
891
892 static void
893 waitforXFW(struct hscx_hw *hx)
894 {
895         u8 starb, to = 50;
896
897         while (to) {
898                 starb = ReadHSCX(hx, IPAC_STARB);
899                 if ((starb & 0x44) == 0x40)
900                         break;
901                 udelay(1);
902                 to--;
903         }
904         if (to < 50)
905                 pr_debug("%s: B%1d XFW %d us\n", hx->ip->name, hx->bch.nr,
906                          50 - to);
907         if (!to)
908                 pr_info("%s: B%1d XFW timeout\n", hx->ip->name, hx->bch.nr);
909 }
910
911 static void
912 hscx_cmdr(struct hscx_hw *hx, u8 cmd)
913 {
914         if (hx->ip->type & IPAC_TYPE_IPACX)
915                 WriteHSCX(hx, IPACX_CMDRB, cmd);
916         else {
917                 waitforCEC(hx);
918                 WriteHSCX(hx, IPAC_CMDRB, cmd);
919         }
920 }
921
922 static void
923 hscx_empty_fifo(struct hscx_hw *hscx, u8 count)
924 {
925         u8 *p;
926         int maxlen;
927
928         pr_debug("%s: B%1d %d\n", hscx->ip->name, hscx->bch.nr, count);
929         if (test_bit(FLG_RX_OFF, &hscx->bch.Flags)) {
930                 hscx->bch.dropcnt += count;
931                 hscx_cmdr(hscx, 0x80); /* RMC */
932                 return;
933         }
934         maxlen = bchannel_get_rxbuf(&hscx->bch, count);
935         if (maxlen < 0) {
936                 hscx_cmdr(hscx, 0x80); /* RMC */
937                 if (hscx->bch.rx_skb)
938                         skb_trim(hscx->bch.rx_skb, 0);
939                 pr_warn("%s.B%d: No bufferspace for %d bytes\n",
940                         hscx->ip->name, hscx->bch.nr, count);
941                 return;
942         }
943         p = skb_put(hscx->bch.rx_skb, count);
944
945         if (hscx->ip->type & IPAC_TYPE_IPACX)
946                 hscx->ip->read_fifo(hscx->ip->hw,
947                                     hscx->off + IPACX_RFIFOB, p, count);
948         else
949                 hscx->ip->read_fifo(hscx->ip->hw,
950                                     hscx->off, p, count);
951
952         hscx_cmdr(hscx, 0x80); /* RMC */
953
954         if (hscx->bch.debug & DEBUG_HW_BFIFO) {
955                 snprintf(hscx->log, 64, "B%1d-recv %s %d ",
956                          hscx->bch.nr, hscx->ip->name, count);
957                 print_hex_dump_bytes(hscx->log, DUMP_PREFIX_OFFSET, p, count);
958         }
959 }
960
961 static void
962 hscx_fill_fifo(struct hscx_hw *hscx)
963 {
964         int count, more;
965         u8 *p;
966
967         if (!hscx->bch.tx_skb) {
968                 if (!test_bit(FLG_TX_EMPTY, &hscx->bch.Flags))
969                         return;
970                 count = hscx->fifo_size;
971                 more = 1;
972                 p = hscx->log;
973                 memset(p, hscx->bch.fill[0], count);
974         } else {
975                 count = hscx->bch.tx_skb->len - hscx->bch.tx_idx;
976                 if (count <= 0)
977                         return;
978                 p = hscx->bch.tx_skb->data + hscx->bch.tx_idx;
979
980                 more = test_bit(FLG_TRANSPARENT, &hscx->bch.Flags) ? 1 : 0;
981                 if (count > hscx->fifo_size) {
982                         count = hscx->fifo_size;
983                         more = 1;
984                 }
985                 pr_debug("%s: B%1d %d/%d/%d\n", hscx->ip->name, hscx->bch.nr,
986                          count, hscx->bch.tx_idx, hscx->bch.tx_skb->len);
987                 hscx->bch.tx_idx += count;
988         }
989         if (hscx->ip->type & IPAC_TYPE_IPACX)
990                 hscx->ip->write_fifo(hscx->ip->hw,
991                                      hscx->off + IPACX_XFIFOB, p, count);
992         else {
993                 waitforXFW(hscx);
994                 hscx->ip->write_fifo(hscx->ip->hw,
995                                      hscx->off, p, count);
996         }
997         hscx_cmdr(hscx, more ? 0x08 : 0x0a);
998
999         if (hscx->bch.tx_skb && (hscx->bch.debug & DEBUG_HW_BFIFO)) {
1000                 snprintf(hscx->log, 64, "B%1d-send %s %d ",
1001                          hscx->bch.nr, hscx->ip->name, count);
1002                 print_hex_dump_bytes(hscx->log, DUMP_PREFIX_OFFSET, p, count);
1003         }
1004 }
1005
1006 static void
1007 hscx_xpr(struct hscx_hw *hx)
1008 {
1009         if (hx->bch.tx_skb && hx->bch.tx_idx < hx->bch.tx_skb->len) {
1010                 hscx_fill_fifo(hx);
1011         } else {
1012                 dev_kfree_skb(hx->bch.tx_skb);
1013                 if (get_next_bframe(&hx->bch)) {
1014                         hscx_fill_fifo(hx);
1015                         test_and_clear_bit(FLG_TX_EMPTY, &hx->bch.Flags);
1016                 } else if (test_bit(FLG_TX_EMPTY, &hx->bch.Flags)) {
1017                         hscx_fill_fifo(hx);
1018                 }
1019         }
1020 }
1021
1022 static void
1023 ipac_rme(struct hscx_hw *hx)
1024 {
1025         int count;
1026         u8 rstab;
1027
1028         if (hx->ip->type & IPAC_TYPE_IPACX)
1029                 rstab = ReadHSCX(hx, IPACX_RSTAB);
1030         else
1031                 rstab = ReadHSCX(hx, IPAC_RSTAB);
1032         pr_debug("%s: B%1d RSTAB %02x\n", hx->ip->name, hx->bch.nr, rstab);
1033         if ((rstab & 0xf0) != 0xa0) {
1034                 /* !(VFR && !RDO && CRC && !RAB) */
1035                 if (!(rstab & 0x80)) {
1036                         if (hx->bch.debug & DEBUG_HW_BCHANNEL)
1037                                 pr_notice("%s: B%1d invalid frame\n",
1038                                           hx->ip->name, hx->bch.nr);
1039                 }
1040                 if (rstab & 0x40) {
1041                         if (hx->bch.debug & DEBUG_HW_BCHANNEL)
1042                                 pr_notice("%s: B%1d RDO proto=%x\n",
1043                                           hx->ip->name, hx->bch.nr,
1044                                           hx->bch.state);
1045                 }
1046                 if (!(rstab & 0x20)) {
1047                         if (hx->bch.debug & DEBUG_HW_BCHANNEL)
1048                                 pr_notice("%s: B%1d CRC error\n",
1049                                           hx->ip->name, hx->bch.nr);
1050                 }
1051                 hscx_cmdr(hx, 0x80); /* Do RMC */
1052                 return;
1053         }
1054         if (hx->ip->type & IPAC_TYPE_IPACX)
1055                 count = ReadHSCX(hx, IPACX_RBCLB);
1056         else
1057                 count = ReadHSCX(hx, IPAC_RBCLB);
1058         count &= (hx->fifo_size - 1);
1059         if (count == 0)
1060                 count = hx->fifo_size;
1061         hscx_empty_fifo(hx, count);
1062         if (!hx->bch.rx_skb)
1063                 return;
1064         if (hx->bch.rx_skb->len < 2) {
1065                 pr_debug("%s: B%1d frame too short %d\n",
1066                          hx->ip->name, hx->bch.nr, hx->bch.rx_skb->len);
1067                 skb_trim(hx->bch.rx_skb, 0);
1068         } else {
1069                 skb_trim(hx->bch.rx_skb, hx->bch.rx_skb->len - 1);
1070                 recv_Bchannel(&hx->bch, 0, false);
1071         }
1072 }
1073
1074 static void
1075 ipac_irq(struct hscx_hw *hx, u8 ista)
1076 {
1077         u8 istab, m, exirb = 0;
1078
1079         if (hx->ip->type & IPAC_TYPE_IPACX)
1080                 istab = ReadHSCX(hx, IPACX_ISTAB);
1081         else if (hx->ip->type & IPAC_TYPE_IPAC) {
1082                 istab = ReadHSCX(hx, IPAC_ISTAB);
1083                 m = (hx->bch.nr & 1) ? IPAC__EXA : IPAC__EXB;
1084                 if (m & ista) {
1085                         exirb = ReadHSCX(hx, IPAC_EXIRB);
1086                         pr_debug("%s: B%1d EXIRB %02x\n", hx->ip->name,
1087                                  hx->bch.nr, exirb);
1088                 }
1089         } else if (hx->bch.nr & 2) { /* HSCX B */
1090                 if (ista & (HSCX__EXA | HSCX__ICA))
1091                         ipac_irq(&hx->ip->hscx[0], ista);
1092                 if (ista & HSCX__EXB) {
1093                         exirb = ReadHSCX(hx, IPAC_EXIRB);
1094                         pr_debug("%s: B%1d EXIRB %02x\n", hx->ip->name,
1095                                  hx->bch.nr, exirb);
1096                 }
1097                 istab = ista & 0xF8;
1098         } else { /* HSCX A */
1099                 istab = ReadHSCX(hx, IPAC_ISTAB);
1100                 if (ista & HSCX__EXA) {
1101                         exirb = ReadHSCX(hx, IPAC_EXIRB);
1102                         pr_debug("%s: B%1d EXIRB %02x\n", hx->ip->name,
1103                                  hx->bch.nr, exirb);
1104                 }
1105                 istab = istab & 0xF8;
1106         }
1107         if (exirb & IPAC_B_XDU)
1108                 istab |= IPACX_B_XDU;
1109         if (exirb & IPAC_B_RFO)
1110                 istab |= IPACX_B_RFO;
1111         pr_debug("%s: B%1d ISTAB %02x\n", hx->ip->name, hx->bch.nr, istab);
1112
1113         if (!test_bit(FLG_ACTIVE, &hx->bch.Flags))
1114                 return;
1115
1116         if (istab & IPACX_B_RME)
1117                 ipac_rme(hx);
1118
1119         if (istab & IPACX_B_RPF) {
1120                 hscx_empty_fifo(hx, hx->fifo_size);
1121                 if (test_bit(FLG_TRANSPARENT, &hx->bch.Flags))
1122                         recv_Bchannel(&hx->bch, 0, false);
1123         }
1124
1125         if (istab & IPACX_B_RFO) {
1126                 pr_debug("%s: B%1d RFO error\n", hx->ip->name, hx->bch.nr);
1127                 hscx_cmdr(hx, 0x40);    /* RRES */
1128         }
1129
1130         if (istab & IPACX_B_XPR)
1131                 hscx_xpr(hx);
1132
1133         if (istab & IPACX_B_XDU) {
1134                 if (test_bit(FLG_TRANSPARENT, &hx->bch.Flags)) {
1135                         if (test_bit(FLG_FILLEMPTY, &hx->bch.Flags))
1136                                 test_and_set_bit(FLG_TX_EMPTY, &hx->bch.Flags);
1137                         hscx_xpr(hx);
1138                         return;
1139                 }
1140                 pr_debug("%s: B%1d XDU error at len %d\n", hx->ip->name,
1141                          hx->bch.nr, hx->bch.tx_idx);
1142                 hx->bch.tx_idx = 0;
1143                 hscx_cmdr(hx, 0x01);    /* XRES */
1144         }
1145 }
1146
1147 irqreturn_t
1148 mISDNipac_irq(struct ipac_hw *ipac, int maxloop)
1149 {
1150         int cnt = maxloop + 1;
1151         u8 ista, istad;
1152         struct isac_hw  *isac = &ipac->isac;
1153
1154         if (ipac->type & IPAC_TYPE_IPACX) {
1155                 ista = ReadIPAC(ipac, ISACX_ISTA);
1156                 while (ista && --cnt) {
1157                         pr_debug("%s: ISTA %02x\n", ipac->name, ista);
1158                         if (ista & IPACX__ICA)
1159                                 ipac_irq(&ipac->hscx[0], ista);
1160                         if (ista & IPACX__ICB)
1161                                 ipac_irq(&ipac->hscx[1], ista);
1162                         if (ista & (ISACX__ICD | ISACX__CIC))
1163                                 mISDNisac_irq(&ipac->isac, ista);
1164                         ista = ReadIPAC(ipac, ISACX_ISTA);
1165                 }
1166         } else if (ipac->type & IPAC_TYPE_IPAC) {
1167                 ista = ReadIPAC(ipac, IPAC_ISTA);
1168                 while (ista && --cnt) {
1169                         pr_debug("%s: ISTA %02x\n", ipac->name, ista);
1170                         if (ista & (IPAC__ICD | IPAC__EXD)) {
1171                                 istad = ReadISAC(isac, ISAC_ISTA);
1172                                 pr_debug("%s: ISTAD %02x\n", ipac->name, istad);
1173                                 if (istad & IPAC_D_TIN2)
1174                                         pr_debug("%s TIN2 irq\n", ipac->name);
1175                                 if (ista & IPAC__EXD)
1176                                         istad |= 1; /* ISAC EXI */
1177                                 mISDNisac_irq(isac, istad);
1178                         }
1179                         if (ista & (IPAC__ICA | IPAC__EXA))
1180                                 ipac_irq(&ipac->hscx[0], ista);
1181                         if (ista & (IPAC__ICB | IPAC__EXB))
1182                                 ipac_irq(&ipac->hscx[1], ista);
1183                         ista = ReadIPAC(ipac, IPAC_ISTA);
1184                 }
1185         } else if (ipac->type & IPAC_TYPE_HSCX) {
1186                 while (--cnt) {
1187                         ista = ReadIPAC(ipac, IPAC_ISTAB + ipac->hscx[1].off);
1188                         pr_debug("%s: B2 ISTA %02x\n", ipac->name, ista);
1189                         if (ista)
1190                                 ipac_irq(&ipac->hscx[1], ista);
1191                         istad = ReadISAC(isac, ISAC_ISTA);
1192                         pr_debug("%s: ISTAD %02x\n", ipac->name, istad);
1193                         if (istad)
1194                                 mISDNisac_irq(isac, istad);
1195                         if (0 == (ista | istad))
1196                                 break;
1197                 }
1198         }
1199         if (cnt > maxloop) /* only for ISAC/HSCX without PCI IRQ test */
1200                 return IRQ_NONE;
1201         if (cnt < maxloop)
1202                 pr_debug("%s: %d irqloops cpu%d\n", ipac->name,
1203                          maxloop - cnt, smp_processor_id());
1204         if (maxloop && !cnt)
1205                 pr_notice("%s: %d IRQ LOOP cpu%d\n", ipac->name,
1206                           maxloop, smp_processor_id());
1207         return IRQ_HANDLED;
1208 }
1209 EXPORT_SYMBOL(mISDNipac_irq);
1210
1211 static int
1212 hscx_mode(struct hscx_hw *hscx, u32 bprotocol)
1213 {
1214         pr_debug("%s: HSCX %c protocol %x-->%x ch %d\n", hscx->ip->name,
1215                  '@' + hscx->bch.nr, hscx->bch.state, bprotocol, hscx->bch.nr);
1216         if (hscx->ip->type & IPAC_TYPE_IPACX) {
1217                 if (hscx->bch.nr & 1) { /* B1 and ICA */
1218                         WriteIPAC(hscx->ip, ISACX_BCHA_TSDP_BC1, 0x80);
1219                         WriteIPAC(hscx->ip, ISACX_BCHA_CR, 0x88);
1220                 } else { /* B2 and ICB */
1221                         WriteIPAC(hscx->ip, ISACX_BCHB_TSDP_BC1, 0x81);
1222                         WriteIPAC(hscx->ip, ISACX_BCHB_CR, 0x88);
1223                 }
1224                 switch (bprotocol) {
1225                 case ISDN_P_NONE: /* init */
1226                         WriteHSCX(hscx, IPACX_MODEB, 0xC0);     /* rec off */
1227                         WriteHSCX(hscx, IPACX_EXMB,  0x30);     /* std adj. */
1228                         WriteHSCX(hscx, IPACX_MASKB, 0xFF);     /* ints off */
1229                         hscx_cmdr(hscx, 0x41);
1230                         test_and_clear_bit(FLG_HDLC, &hscx->bch.Flags);
1231                         test_and_clear_bit(FLG_TRANSPARENT, &hscx->bch.Flags);
1232                         break;
1233                 case ISDN_P_B_RAW:
1234                         WriteHSCX(hscx, IPACX_MODEB, 0x88);     /* ex trans */
1235                         WriteHSCX(hscx, IPACX_EXMB,  0x00);     /* trans */
1236                         hscx_cmdr(hscx, 0x41);
1237                         WriteHSCX(hscx, IPACX_MASKB, IPACX_B_ON);
1238                         test_and_set_bit(FLG_TRANSPARENT, &hscx->bch.Flags);
1239                         break;
1240                 case ISDN_P_B_HDLC:
1241                         WriteHSCX(hscx, IPACX_MODEB, 0xC0);     /* trans */
1242                         WriteHSCX(hscx, IPACX_EXMB,  0x00);     /* hdlc,crc */
1243                         hscx_cmdr(hscx, 0x41);
1244                         WriteHSCX(hscx, IPACX_MASKB, IPACX_B_ON);
1245                         test_and_set_bit(FLG_HDLC, &hscx->bch.Flags);
1246                         break;
1247                 default:
1248                         pr_info("%s: protocol not known %x\n", hscx->ip->name,
1249                                 bprotocol);
1250                         return -ENOPROTOOPT;
1251                 }
1252         } else if (hscx->ip->type & IPAC_TYPE_IPAC) { /* IPAC */
1253                 WriteHSCX(hscx, IPAC_CCR1, 0x82);
1254                 WriteHSCX(hscx, IPAC_CCR2, 0x30);
1255                 WriteHSCX(hscx, IPAC_XCCR, 0x07);
1256                 WriteHSCX(hscx, IPAC_RCCR, 0x07);
1257                 WriteHSCX(hscx, IPAC_TSAX, hscx->slot);
1258                 WriteHSCX(hscx, IPAC_TSAR, hscx->slot);
1259                 switch (bprotocol) {
1260                 case ISDN_P_NONE:
1261                         WriteHSCX(hscx, IPAC_TSAX, 0x1F);
1262                         WriteHSCX(hscx, IPAC_TSAR, 0x1F);
1263                         WriteHSCX(hscx, IPAC_MODEB, 0x84);
1264                         WriteHSCX(hscx, IPAC_CCR1, 0x82);
1265                         WriteHSCX(hscx, IPAC_MASKB, 0xFF);      /* ints off */
1266                         test_and_clear_bit(FLG_HDLC, &hscx->bch.Flags);
1267                         test_and_clear_bit(FLG_TRANSPARENT, &hscx->bch.Flags);
1268                         break;
1269                 case ISDN_P_B_RAW:
1270                         WriteHSCX(hscx, IPAC_MODEB, 0xe4);      /* ex trans */
1271                         WriteHSCX(hscx, IPAC_CCR1, 0x82);
1272                         hscx_cmdr(hscx, 0x41);
1273                         WriteHSCX(hscx, IPAC_MASKB, 0);
1274                         test_and_set_bit(FLG_TRANSPARENT, &hscx->bch.Flags);
1275                         break;
1276                 case ISDN_P_B_HDLC:
1277                         WriteHSCX(hscx, IPAC_MODEB, 0x8c);
1278                         WriteHSCX(hscx, IPAC_CCR1, 0x8a);
1279                         hscx_cmdr(hscx, 0x41);
1280                         WriteHSCX(hscx, IPAC_MASKB, 0);
1281                         test_and_set_bit(FLG_HDLC, &hscx->bch.Flags);
1282                         break;
1283                 default:
1284                         pr_info("%s: protocol not known %x\n", hscx->ip->name,
1285                                 bprotocol);
1286                         return -ENOPROTOOPT;
1287                 }
1288         } else if (hscx->ip->type & IPAC_TYPE_HSCX) { /* HSCX */
1289                 WriteHSCX(hscx, IPAC_CCR1, 0x85);
1290                 WriteHSCX(hscx, IPAC_CCR2, 0x30);
1291                 WriteHSCX(hscx, IPAC_XCCR, 0x07);
1292                 WriteHSCX(hscx, IPAC_RCCR, 0x07);
1293                 WriteHSCX(hscx, IPAC_TSAX, hscx->slot);
1294                 WriteHSCX(hscx, IPAC_TSAR, hscx->slot);
1295                 switch (bprotocol) {
1296                 case ISDN_P_NONE:
1297                         WriteHSCX(hscx, IPAC_TSAX, 0x1F);
1298                         WriteHSCX(hscx, IPAC_TSAR, 0x1F);
1299                         WriteHSCX(hscx, IPAC_MODEB, 0x84);
1300                         WriteHSCX(hscx, IPAC_CCR1, 0x85);
1301                         WriteHSCX(hscx, IPAC_MASKB, 0xFF);      /* ints off */
1302                         test_and_clear_bit(FLG_HDLC, &hscx->bch.Flags);
1303                         test_and_clear_bit(FLG_TRANSPARENT, &hscx->bch.Flags);
1304                         break;
1305                 case ISDN_P_B_RAW:
1306                         WriteHSCX(hscx, IPAC_MODEB, 0xe4);      /* ex trans */
1307                         WriteHSCX(hscx, IPAC_CCR1, 0x85);
1308                         hscx_cmdr(hscx, 0x41);
1309                         WriteHSCX(hscx, IPAC_MASKB, 0);
1310                         test_and_set_bit(FLG_TRANSPARENT, &hscx->bch.Flags);
1311                         break;
1312                 case ISDN_P_B_HDLC:
1313                         WriteHSCX(hscx, IPAC_MODEB, 0x8c);
1314                         WriteHSCX(hscx, IPAC_CCR1, 0x8d);
1315                         hscx_cmdr(hscx, 0x41);
1316                         WriteHSCX(hscx, IPAC_MASKB, 0);
1317                         test_and_set_bit(FLG_HDLC, &hscx->bch.Flags);
1318                         break;
1319                 default:
1320                         pr_info("%s: protocol not known %x\n", hscx->ip->name,
1321                                 bprotocol);
1322                         return -ENOPROTOOPT;
1323                 }
1324         } else
1325                 return -EINVAL;
1326         hscx->bch.state = bprotocol;
1327         return 0;
1328 }
1329
1330 static int
1331 hscx_l2l1(struct mISDNchannel *ch, struct sk_buff *skb)
1332 {
1333         struct bchannel *bch = container_of(ch, struct bchannel, ch);
1334         struct hscx_hw  *hx = container_of(bch, struct hscx_hw, bch);
1335         int ret = -EINVAL;
1336         struct mISDNhead *hh = mISDN_HEAD_P(skb);
1337         unsigned long flags;
1338
1339         switch (hh->prim) {
1340         case PH_DATA_REQ:
1341                 spin_lock_irqsave(hx->ip->hwlock, flags);
1342                 ret = bchannel_senddata(bch, skb);
1343                 if (ret > 0) { /* direct TX */
1344                         ret = 0;
1345                         hscx_fill_fifo(hx);
1346                 }
1347                 spin_unlock_irqrestore(hx->ip->hwlock, flags);
1348                 return ret;
1349         case PH_ACTIVATE_REQ:
1350                 spin_lock_irqsave(hx->ip->hwlock, flags);
1351                 if (!test_and_set_bit(FLG_ACTIVE, &bch->Flags))
1352                         ret = hscx_mode(hx, ch->protocol);
1353                 else
1354                         ret = 0;
1355                 spin_unlock_irqrestore(hx->ip->hwlock, flags);
1356                 if (!ret)
1357                         _queue_data(ch, PH_ACTIVATE_IND, MISDN_ID_ANY, 0,
1358                                     NULL, GFP_KERNEL);
1359                 break;
1360         case PH_DEACTIVATE_REQ:
1361                 spin_lock_irqsave(hx->ip->hwlock, flags);
1362                 mISDN_clear_bchannel(bch);
1363                 hscx_mode(hx, ISDN_P_NONE);
1364                 spin_unlock_irqrestore(hx->ip->hwlock, flags);
1365                 _queue_data(ch, PH_DEACTIVATE_IND, MISDN_ID_ANY, 0,
1366                             NULL, GFP_KERNEL);
1367                 ret = 0;
1368                 break;
1369         default:
1370                 pr_info("%s: %s unknown prim(%x,%x)\n",
1371                         hx->ip->name, __func__, hh->prim, hh->id);
1372                 ret = -EINVAL;
1373         }
1374         if (!ret)
1375                 dev_kfree_skb(skb);
1376         return ret;
1377 }
1378
1379 static int
1380 channel_bctrl(struct bchannel *bch, struct mISDN_ctrl_req *cq)
1381 {
1382         return mISDN_ctrl_bchannel(bch, cq);
1383 }
1384
1385 static int
1386 hscx_bctrl(struct mISDNchannel *ch, u32 cmd, void *arg)
1387 {
1388         struct bchannel *bch = container_of(ch, struct bchannel, ch);
1389         struct hscx_hw  *hx = container_of(bch, struct hscx_hw, bch);
1390         int ret = -EINVAL;
1391         u_long flags;
1392
1393         pr_debug("%s: %s cmd:%x %p\n", hx->ip->name, __func__, cmd, arg);
1394         switch (cmd) {
1395         case CLOSE_CHANNEL:
1396                 test_and_clear_bit(FLG_OPEN, &bch->Flags);
1397                 cancel_work_sync(&bch->workq);
1398                 spin_lock_irqsave(hx->ip->hwlock, flags);
1399                 mISDN_clear_bchannel(bch);
1400                 hscx_mode(hx, ISDN_P_NONE);
1401                 spin_unlock_irqrestore(hx->ip->hwlock, flags);
1402                 ch->protocol = ISDN_P_NONE;
1403                 ch->peer = NULL;
1404                 module_put(hx->ip->owner);
1405                 ret = 0;
1406                 break;
1407         case CONTROL_CHANNEL:
1408                 ret = channel_bctrl(bch, arg);
1409                 break;
1410         default:
1411                 pr_info("%s: %s unknown prim(%x)\n",
1412                         hx->ip->name, __func__, cmd);
1413         }
1414         return ret;
1415 }
1416
1417 static void
1418 free_ipac(struct ipac_hw *ipac)
1419 {
1420         isac_release(&ipac->isac);
1421 }
1422
1423 static const char *HSCXVer[] =
1424 {"A1", "?1", "A2", "?3", "A3", "V2.1", "?6", "?7",
1425  "?8", "?9", "?10", "?11", "?12", "?13", "?14", "???"};
1426
1427
1428
1429 static void
1430 hscx_init(struct hscx_hw *hx)
1431 {
1432         u8 val;
1433
1434         WriteHSCX(hx, IPAC_RAH2, 0xFF);
1435         WriteHSCX(hx, IPAC_XBCH, 0x00);
1436         WriteHSCX(hx, IPAC_RLCR, 0x00);
1437
1438         if (hx->ip->type & IPAC_TYPE_HSCX) {
1439                 WriteHSCX(hx, IPAC_CCR1, 0x85);
1440                 val = ReadHSCX(hx, HSCX_VSTR);
1441                 pr_debug("%s: HSCX VSTR %02x\n", hx->ip->name, val);
1442                 if (hx->bch.debug & DEBUG_HW)
1443                         pr_notice("%s: HSCX version %s\n", hx->ip->name,
1444                                   HSCXVer[val & 0x0f]);
1445         } else
1446                 WriteHSCX(hx, IPAC_CCR1, 0x82);
1447         WriteHSCX(hx, IPAC_CCR2, 0x30);
1448         WriteHSCX(hx, IPAC_XCCR, 0x07);
1449         WriteHSCX(hx, IPAC_RCCR, 0x07);
1450 }
1451
1452 static int
1453 ipac_init(struct ipac_hw *ipac)
1454 {
1455         u8 val;
1456
1457         if (ipac->type & IPAC_TYPE_HSCX) {
1458                 hscx_init(&ipac->hscx[0]);
1459                 hscx_init(&ipac->hscx[1]);
1460                 val = ReadIPAC(ipac, IPAC_ID);
1461         } else if (ipac->type & IPAC_TYPE_IPAC) {
1462                 hscx_init(&ipac->hscx[0]);
1463                 hscx_init(&ipac->hscx[1]);
1464                 WriteIPAC(ipac, IPAC_MASK, IPAC__ON);
1465                 val = ReadIPAC(ipac, IPAC_CONF);
1466                 /* conf is default 0, but can be overwritten by card setup */
1467                 pr_debug("%s: IPAC CONF %02x/%02x\n", ipac->name,
1468                          val, ipac->conf);
1469                 WriteIPAC(ipac, IPAC_CONF, ipac->conf);
1470                 val = ReadIPAC(ipac, IPAC_ID);
1471                 if (ipac->hscx[0].bch.debug & DEBUG_HW)
1472                         pr_notice("%s: IPAC Design ID %02x\n", ipac->name, val);
1473         }
1474         /* nothing special for IPACX to do here */
1475         return isac_init(&ipac->isac);
1476 }
1477
1478 static int
1479 open_bchannel(struct ipac_hw *ipac, struct channel_req *rq)
1480 {
1481         struct bchannel         *bch;
1482
1483         if (rq->adr.channel == 0 || rq->adr.channel > 2)
1484                 return -EINVAL;
1485         if (rq->protocol == ISDN_P_NONE)
1486                 return -EINVAL;
1487         bch = &ipac->hscx[rq->adr.channel - 1].bch;
1488         if (test_and_set_bit(FLG_OPEN, &bch->Flags))
1489                 return -EBUSY; /* b-channel can be only open once */
1490         test_and_clear_bit(FLG_FILLEMPTY, &bch->Flags);
1491         bch->ch.protocol = rq->protocol;
1492         rq->ch = &bch->ch;
1493         return 0;
1494 }
1495
1496 static int
1497 channel_ctrl(struct ipac_hw *ipac, struct mISDN_ctrl_req *cq)
1498 {
1499         int     ret = 0;
1500
1501         switch (cq->op) {
1502         case MISDN_CTRL_GETOP:
1503                 cq->op = MISDN_CTRL_LOOP | MISDN_CTRL_L1_TIMER3;
1504                 break;
1505         case MISDN_CTRL_LOOP:
1506                 /* cq->channel: 0 disable, 1 B1 loop 2 B2 loop, 3 both */
1507                 if (cq->channel < 0 || cq->channel > 3) {
1508                         ret = -EINVAL;
1509                         break;
1510                 }
1511                 ret = ipac->ctrl(ipac, HW_TESTLOOP, cq->channel);
1512                 break;
1513         case MISDN_CTRL_L1_TIMER3:
1514                 ret = ipac->isac.ctrl(&ipac->isac, HW_TIMER3_VALUE, cq->p1);
1515                 break;
1516         default:
1517                 pr_info("%s: unknown CTRL OP %x\n", ipac->name, cq->op);
1518                 ret = -EINVAL;
1519                 break;
1520         }
1521         return ret;
1522 }
1523
1524 static int
1525 ipac_dctrl(struct mISDNchannel *ch, u32 cmd, void *arg)
1526 {
1527         struct mISDNdevice *dev = container_of(ch, struct mISDNdevice, D);
1528         struct dchannel *dch = container_of(dev, struct dchannel, dev);
1529         struct isac_hw *isac = container_of(dch, struct isac_hw, dch);
1530         struct ipac_hw *ipac = container_of(isac, struct ipac_hw, isac);
1531         struct channel_req *rq;
1532         int err = 0;
1533
1534         pr_debug("%s: DCTRL: %x %p\n", ipac->name, cmd, arg);
1535         switch (cmd) {
1536         case OPEN_CHANNEL:
1537                 rq = arg;
1538                 if (rq->protocol == ISDN_P_TE_S0)
1539                         err = open_dchannel_caller(isac, rq, __builtin_return_address(0));
1540                 else
1541                         err = open_bchannel(ipac, rq);
1542                 if (err)
1543                         break;
1544                 if (!try_module_get(ipac->owner))
1545                         pr_info("%s: cannot get module\n", ipac->name);
1546                 break;
1547         case CLOSE_CHANNEL:
1548                 pr_debug("%s: dev(%d) close from %p\n", ipac->name,
1549                          dch->dev.id, __builtin_return_address(0));
1550                 module_put(ipac->owner);
1551                 break;
1552         case CONTROL_CHANNEL:
1553                 err = channel_ctrl(ipac, arg);
1554                 break;
1555         default:
1556                 pr_debug("%s: unknown DCTRL command %x\n", ipac->name, cmd);
1557                 return -EINVAL;
1558         }
1559         return err;
1560 }
1561
1562 u32
1563 mISDNipac_init(struct ipac_hw *ipac, void *hw)
1564 {
1565         u32 ret;
1566         u8 i;
1567
1568         ipac->hw = hw;
1569         if (ipac->isac.dch.debug & DEBUG_HW)
1570                 pr_notice("%s: ipac type %x\n", ipac->name, ipac->type);
1571         if (ipac->type & IPAC_TYPE_HSCX) {
1572                 ipac->isac.type = IPAC_TYPE_ISAC;
1573                 ipac->hscx[0].off = 0;
1574                 ipac->hscx[1].off = 0x40;
1575                 ipac->hscx[0].fifo_size = 32;
1576                 ipac->hscx[1].fifo_size = 32;
1577         } else if (ipac->type & IPAC_TYPE_IPAC) {
1578                 ipac->isac.type = IPAC_TYPE_IPAC | IPAC_TYPE_ISAC;
1579                 ipac->hscx[0].off = 0;
1580                 ipac->hscx[1].off = 0x40;
1581                 ipac->hscx[0].fifo_size = 64;
1582                 ipac->hscx[1].fifo_size = 64;
1583         } else if (ipac->type & IPAC_TYPE_IPACX) {
1584                 ipac->isac.type = IPAC_TYPE_IPACX | IPAC_TYPE_ISACX;
1585                 ipac->hscx[0].off = IPACX_OFF_ICA;
1586                 ipac->hscx[1].off = IPACX_OFF_ICB;
1587                 ipac->hscx[0].fifo_size = 64;
1588                 ipac->hscx[1].fifo_size = 64;
1589         } else
1590                 return 0;
1591
1592         mISDNisac_init(&ipac->isac, hw);
1593
1594         ipac->isac.dch.dev.D.ctrl = ipac_dctrl;
1595
1596         for (i = 0; i < 2; i++) {
1597                 ipac->hscx[i].bch.nr = i + 1;
1598                 set_channelmap(i + 1, ipac->isac.dch.dev.channelmap);
1599                 list_add(&ipac->hscx[i].bch.ch.list,
1600                          &ipac->isac.dch.dev.bchannels);
1601                 mISDN_initbchannel(&ipac->hscx[i].bch, MAX_DATA_MEM,
1602                                    ipac->hscx[i].fifo_size);
1603                 ipac->hscx[i].bch.ch.nr = i + 1;
1604                 ipac->hscx[i].bch.ch.send = &hscx_l2l1;
1605                 ipac->hscx[i].bch.ch.ctrl = hscx_bctrl;
1606                 ipac->hscx[i].bch.hw = hw;
1607                 ipac->hscx[i].ip = ipac;
1608                 /* default values for IOM time slots
1609                  * can be overwritten by card */
1610                 ipac->hscx[i].slot = (i == 0) ? 0x2f : 0x03;
1611         }
1612
1613         ipac->init = ipac_init;
1614         ipac->release = free_ipac;
1615
1616         ret =   (1 << (ISDN_P_B_RAW & ISDN_P_B_MASK)) |
1617                 (1 << (ISDN_P_B_HDLC & ISDN_P_B_MASK));
1618         return ret;
1619 }
1620 EXPORT_SYMBOL(mISDNipac_init);
1621
1622 static int __init
1623 isac_mod_init(void)
1624 {
1625         pr_notice("mISDNipac module version %s\n", ISAC_REV);
1626         return 0;
1627 }
1628
1629 static void __exit
1630 isac_mod_cleanup(void)
1631 {
1632         pr_notice("mISDNipac module unloaded\n");
1633 }
1634 module_init(isac_mod_init);
1635 module_exit(isac_mod_cleanup);