drivers/isdn/hisax/icc.c

   1 /* $Id: icc.c,v 1.8.2.3 2004/01/13 14:31:25 keil Exp $
   2  *
   3  * ICC specific routines
   4  *
   5  * Author       Matt Henderson & Guy Ellis
   6  * Copyright    by Traverse Technologies Pty Ltd, www.travers.com.au
   7  *
   8  * This software may be used and distributed according to the terms
   9  * of the GNU General Public License, incorporated herein by reference.
  10  *
  11  * 1999.6.25 Initial implementation of routines for Siemens ISDN
  12  * Communication Controller PEB 2070 based on the ISAC routines
  13  * written by Karsten Keil.
  14  *
  15  */
  16
  17 #include <linux/init.h>
  18 #include "hisax.h"
  19 #include "icc.h"
  20 // #include "arcofi.h"
  21 #include "isdnl1.h"
  22 #include <linux/interrupt.h>
  23
  24 #define DBUSY_TIMER_VALUE 80
  25 #define ARCOFI_USE 0
  26
  27 static char *ICCVer[] __initdata =
  28 {"2070 A1/A3", "2070 B1", "2070 B2/B3", "2070 V2.4"};
  29
  30 void __init
  31 ICCVersion(struct IsdnCardState *cs, char *s)
  32 {
  33         int val;
  34
  35         val = cs->readisac(cs, ICC_RBCH);
  36         printk(KERN_INFO "%s ICC version (%x): %s\n", s, val, ICCVer[(val >> 5) & 3]);
  37 }
  38
  39 static void
  40 ph_command(struct IsdnCardState *cs, unsigned int command)
  41 {
  42         if (cs->debug & L1_DEB_ISAC)
  43                 debugl1(cs, "ph_command %x", command);
  44         cs->writeisac(cs, ICC_CIX0, (command << 2) | 3);
  45 }
  46
  47
  48 static void
  49 icc_new_ph(struct IsdnCardState *cs)
  50 {
  51         switch (cs->dc.icc.ph_state) {
  52                 case (ICC_IND_EI1):
  53                         ph_command(cs, ICC_CMD_DI);
  54                         l1_msg(cs, HW_RESET | INDICATION, NULL);
  55                         break;
  56                 case (ICC_IND_DC):
  57                         l1_msg(cs, HW_DEACTIVATE | CONFIRM, NULL);
  58                         break;
  59                 case (ICC_IND_DR):
  60                         l1_msg(cs, HW_DEACTIVATE | INDICATION, NULL);
  61                         break;
  62                 case (ICC_IND_PU):
  63                         l1_msg(cs, HW_POWERUP | CONFIRM, NULL);
  64                         break;
  65                 case (ICC_IND_FJ):
  66                         l1_msg(cs, HW_RSYNC | INDICATION, NULL);
  67                         break;
  68                 case (ICC_IND_AR):
  69                         l1_msg(cs, HW_INFO2 | INDICATION, NULL);
  70                         break;
  71                 case (ICC_IND_AI):
  72                         l1_msg(cs, HW_INFO4 | INDICATION, NULL);
  73                         break;
  74                 default:
  75                         break;
  76         }
  77 }
  78
  79 static void
  80 icc_bh(struct IsdnCardState *cs)
  81 {
  82         struct PStack *stptr;
  83
  84         if (!cs)
  85                 return;
  86         if (test_and_clear_bit(D_CLEARBUSY, &cs->event)) {
  87                 if (cs->debug)
  88                         debugl1(cs, "D-Channel Busy cleared");
  89                 stptr = cs->stlist;
  90                 while (stptr != NULL) {
  91                         stptr->l1.l1l2(stptr, PH_PAUSE | CONFIRM, NULL);
  92                         stptr = stptr->next;
  93                 }
  94         }
  95         if (test_and_clear_bit(D_L1STATECHANGE, &cs->event))
  96                 icc_new_ph(cs);
  97         if (test_and_clear_bit(D_RCVBUFREADY, &cs->event))
  98                 DChannel_proc_rcv(cs);
  99         if (test_and_clear_bit(D_XMTBUFREADY, &cs->event))
 100                 DChannel_proc_xmt(cs);
 101 #if ARCOFI_USE
 102         if (!test_bit(HW_ARCOFI, &cs->HW_Flags))
 103                 return;
 104         if (test_and_clear_bit(D_RX_MON1, &cs->event))
 105                 arcofi_fsm(cs, ARCOFI_RX_END, NULL);
 106         if (test_and_clear_bit(D_TX_MON1, &cs->event))
 107                 arcofi_fsm(cs, ARCOFI_TX_END, NULL);
 108 #endif
 109 }
 110
 111 static void
 112 icc_empty_fifo(struct IsdnCardState *cs, int count)
 113 {
 114         u_char *ptr;
 115
 116         if ((cs->debug & L1_DEB_ISAC) && !(cs->debug & L1_DEB_ISAC_FIFO))
 117                 debugl1(cs, "icc_empty_fifo");
 118
 119         if ((cs->rcvidx + count) >= MAX_DFRAME_LEN_L1) {
 120                 if (cs->debug & L1_DEB_WARN)
 121                         debugl1(cs, "icc_empty_fifo overrun %d",
 122                                 cs->rcvidx + count);
 123                 cs->writeisac(cs, ICC_CMDR, 0x80);
 124                 cs->rcvidx = 0;
 125                 return;
 126         }
 127         ptr = cs->rcvbuf + cs->rcvidx;
 128         cs->rcvidx += count;
 129         cs->readisacfifo(cs, ptr, count);
 130         cs->writeisac(cs, ICC_CMDR, 0x80);
 131         if (cs->debug & L1_DEB_ISAC_FIFO) {
 132                 char *t = cs->dlog;
 133
 134                 t += sprintf(t, "icc_empty_fifo cnt %d", count);
 135                 QuickHex(t, ptr, count);
 136                 debugl1(cs, cs->dlog);
 137         }
 138 }
 139
 140 static void
 141 icc_fill_fifo(struct IsdnCardState *cs)
 142 {
 143         int count, more;
 144         u_char *ptr;
 145
 146         if ((cs->debug & L1_DEB_ISAC) && !(cs->debug & L1_DEB_ISAC_FIFO))
 147                 debugl1(cs, "icc_fill_fifo");
 148
 149         if (!cs->tx_skb)
 150                 return;
 151
 152         count = cs->tx_skb->len;
 153         if (count <= 0)
 154                 return;
 155
 156         more = 0;
 157         if (count > 32) {
 158                 more = !0;
 159                 count = 32;
 160         }
 161         ptr = cs->tx_skb->data;
 162         skb_pull(cs->tx_skb, count);
 163         cs->tx_cnt += count;
 164         cs->writeisacfifo(cs, ptr, count);
 165         cs->writeisac(cs, ICC_CMDR, more ? 0x8 : 0xa);
 166         if (test_and_set_bit(FLG_DBUSY_TIMER, &cs->HW_Flags)) {
 167                 debugl1(cs, "icc_fill_fifo dbusytimer running");
 168                 del_timer(&cs->dbusytimer);
 169         }
 170         init_timer(&cs->dbusytimer);
 171         cs->dbusytimer.expires = jiffies + ((DBUSY_TIMER_VALUE * HZ)/1000);
 172         add_timer(&cs->dbusytimer);
 173         if (cs->debug & L1_DEB_ISAC_FIFO) {
 174                 char *t = cs->dlog;
 175
 176                 t += sprintf(t, "icc_fill_fifo cnt %d", count);
 177                 QuickHex(t, ptr, count);
 178                 debugl1(cs, cs->dlog);
 179         }
 180 }
 181
 182 void
 183 icc_interrupt(struct IsdnCardState *cs, u_char val)
 184 {
 185         u_char exval, v1;
 186         struct sk_buff *skb;
 187         unsigned int count;
 188
 189         if (cs->debug & L1_DEB_ISAC)
 190                 debugl1(cs, "ICC interrupt %x", val);
 191         if (val & 0x80) {       /* RME */
 192                 exval = cs->readisac(cs, ICC_RSTA);
 193                 if ((exval & 0x70) != 0x20) {
 194                         if (exval & 0x40) {
 195                                 if (cs->debug & L1_DEB_WARN)
 196                                         debugl1(cs, "ICC RDO");
 197 #ifdef ERROR_STATISTIC
 198                                 cs->err_rx++;
 199 #endif
 200                         }
 201                         if (!(exval & 0x20)) {
 202                                 if (cs->debug & L1_DEB_WARN)
 203                                         debugl1(cs, "ICC CRC error");
 204 #ifdef ERROR_STATISTIC
 205                                 cs->err_crc++;
 206 #endif
 207                         }
 208                         cs->writeisac(cs, ICC_CMDR, 0x80);
 209                 } else {
 210                         count = cs->readisac(cs, ICC_RBCL) & 0x1f;
 211                         if (count == 0)
 212                                 count = 32;
 213                         icc_empty_fifo(cs, count);
 214                         if ((count = cs->rcvidx) > 0) {
 215                                 cs->rcvidx = 0;
 216                                 if (!(skb = alloc_skb(count, GFP_ATOMIC)))
 217                                         printk(KERN_WARNING "HiSax: D receive out of memory\n");
 218                                 else {
 219                                         memcpy(skb_put(skb, count), cs->rcvbuf, count);
 220                                         skb_queue_tail(&cs->rq, skb);
 221                                 }
 222                         }
 223                 }
 224                 cs->rcvidx = 0;
 225                 schedule_event(cs, D_RCVBUFREADY);
 226         }
 227         if (val & 0x40) {       /* RPF */
 228                 icc_empty_fifo(cs, 32);
 229         }
 230         if (val & 0x20) {       /* RSC */
 231                 /* never */
 232                 if (cs->debug & L1_DEB_WARN)
 233                         debugl1(cs, "ICC RSC interrupt");
 234         }
 235         if (val & 0x10) {       /* XPR */
 236                 if (test_and_clear_bit(FLG_DBUSY_TIMER, &cs->HW_Flags))
 237                         del_timer(&cs->dbusytimer);
 238                 if (test_and_clear_bit(FLG_L1_DBUSY, &cs->HW_Flags))
 239                         schedule_event(cs, D_CLEARBUSY);
 240                 if (cs->tx_skb) {
 241                         if (cs->tx_skb->len) {
 242                                 icc_fill_fifo(cs);
 243                                 goto afterXPR;
 244                         } else {
 245                                 dev_kfree_skb_irq(cs->tx_skb);
 246                                 cs->tx_cnt = 0;
 247                                 cs->tx_skb = NULL;
 248                         }
 249                 }
 250                 if ((cs->tx_skb = skb_dequeue(&cs->sq))) {
 251                         cs->tx_cnt = 0;
 252                         icc_fill_fifo(cs);
 253                 } else
 254                         schedule_event(cs, D_XMTBUFREADY);
 255         }
 256       afterXPR:
 257         if (val & 0x04) {       /* CISQ */
 258                 exval = cs->readisac(cs, ICC_CIR0);
 259                 if (cs->debug & L1_DEB_ISAC)
 260                         debugl1(cs, "ICC CIR0 %02X", exval );
 261                 if (exval & 2) {
 262                         cs->dc.icc.ph_state = (exval >> 2) & 0xf;
 263                         if (cs->debug & L1_DEB_ISAC)
 264                                 debugl1(cs, "ph_state change %x", cs->dc.icc.ph_state);
 265                         schedule_event(cs, D_L1STATECHANGE);
 266                 }
 267                 if (exval & 1) {
 268                         exval = cs->readisac(cs, ICC_CIR1);
 269                         if (cs->debug & L1_DEB_ISAC)
 270                                 debugl1(cs, "ICC CIR1 %02X", exval );
 271                 }
 272         }
 273         if (val & 0x02) {       /* SIN */
 274                 /* never */
 275                 if (cs->debug & L1_DEB_WARN)
 276                         debugl1(cs, "ICC SIN interrupt");
 277         }
 278         if (val & 0x01) {       /* EXI */
 279                 exval = cs->readisac(cs, ICC_EXIR);
 280                 if (cs->debug & L1_DEB_WARN)
 281                         debugl1(cs, "ICC EXIR %02x", exval);
 282                 if (exval & 0x80) {  /* XMR */
 283                         debugl1(cs, "ICC XMR");
 284                         printk(KERN_WARNING "HiSax: ICC XMR\n");
 285                 }
 286                 if (exval & 0x40) {  /* XDU */
 287                         debugl1(cs, "ICC XDU");
 288                         printk(KERN_WARNING "HiSax: ICC XDU\n");
 289 #ifdef ERROR_STATISTIC
 290                         cs->err_tx++;
 291 #endif
 292                         if (test_and_clear_bit(FLG_DBUSY_TIMER, &cs->HW_Flags))
 293                                 del_timer(&cs->dbusytimer);
 294                         if (test_and_clear_bit(FLG_L1_DBUSY, &cs->HW_Flags))
 295                                 schedule_event(cs, D_CLEARBUSY);
 296                         if (cs->tx_skb) { /* Restart frame */
 297                                 skb_push(cs->tx_skb, cs->tx_cnt);
 298                                 cs->tx_cnt = 0;
 299                                 icc_fill_fifo(cs);
 300                         } else {
 301                                 printk(KERN_WARNING "HiSax: ICC XDU no skb\n");
 302                                 debugl1(cs, "ICC XDU no skb");
 303                         }
 304                 }
 305                 if (exval & 0x04) {  /* MOS */
 306                         v1 = cs->readisac(cs, ICC_MOSR);
 307                         if (cs->debug & L1_DEB_MONITOR)
 308                                 debugl1(cs, "ICC MOSR %02x", v1);
 309 #if ARCOFI_USE
 310                         if (v1 & 0x08) {
 311                                 if (!cs->dc.icc.mon_rx) {
 312                                         if (!(cs->dc.icc.mon_rx = kmalloc(MAX_MON_FRAME, GFP_ATOMIC))) {
 313                                                 if (cs->debug & L1_DEB_WARN)
 314                                                         debugl1(cs, "ICC MON RX out of memory!");
 315                                                 cs->dc.icc.mocr &= 0xf0;
 316                                                 cs->dc.icc.mocr |= 0x0a;
 317                                                 cs->writeisac(cs, ICC_MOCR, cs->dc.icc.mocr);
 318                                                 goto afterMONR0;
 319                                         } else
 320                                                 cs->dc.icc.mon_rxp = 0;
 321                                 }
 322                                 if (cs->dc.icc.mon_rxp >= MAX_MON_FRAME) {
 323                                         cs->dc.icc.mocr &= 0xf0;
 324                                         cs->dc.icc.mocr |= 0x0a;
 325                                         cs->writeisac(cs, ICC_MOCR, cs->dc.icc.mocr);
 326                                         cs->dc.icc.mon_rxp = 0;
 327                                         if (cs->debug & L1_DEB_WARN)
 328                                                 debugl1(cs, "ICC MON RX overflow!");
 329                                         goto afterMONR0;
 330                                 }
 331                                 cs->dc.icc.mon_rx[cs->dc.icc.mon_rxp++] = cs->readisac(cs, ICC_MOR0);
 332                                 if (cs->debug & L1_DEB_MONITOR)
 333                                         debugl1(cs, "ICC MOR0 %02x", cs->dc.icc.mon_rx[cs->dc.icc.mon_rxp -1]);
 334                                 if (cs->dc.icc.mon_rxp == 1) {
 335                                         cs->dc.icc.mocr |= 0x04;
 336                                         cs->writeisac(cs, ICC_MOCR, cs->dc.icc.mocr);
 337                                 }
 338                         }
 339                       afterMONR0:
 340                         if (v1 & 0x80) {
 341                                 if (!cs->dc.icc.mon_rx) {
 342                                         if (!(cs->dc.icc.mon_rx = kmalloc(MAX_MON_FRAME, GFP_ATOMIC))) {
 343                                                 if (cs->debug & L1_DEB_WARN)
 344                                                         debugl1(cs, "ICC MON RX out of memory!");
 345                                                 cs->dc.icc.mocr &= 0x0f;
 346                                                 cs->dc.icc.mocr |= 0xa0;
 347                                                 cs->writeisac(cs, ICC_MOCR, cs->dc.icc.mocr);
 348                                                 goto afterMONR1;
 349                                         } else
 350                                                 cs->dc.icc.mon_rxp = 0;
 351                                 }
 352                                 if (cs->dc.icc.mon_rxp >= MAX_MON_FRAME) {
 353                                         cs->dc.icc.mocr &= 0x0f;
 354                                         cs->dc.icc.mocr |= 0xa0;
 355                                         cs->writeisac(cs, ICC_MOCR, cs->dc.icc.mocr);
 356                                         cs->dc.icc.mon_rxp = 0;
 357                                         if (cs->debug & L1_DEB_WARN)
 358                                                 debugl1(cs, "ICC MON RX overflow!");
 359                                         goto afterMONR1;
 360                                 }
 361                                 cs->dc.icc.mon_rx[cs->dc.icc.mon_rxp++] = cs->readisac(cs, ICC_MOR1);
 362                                 if (cs->debug & L1_DEB_MONITOR)
 363                                         debugl1(cs, "ICC MOR1 %02x", cs->dc.icc.mon_rx[cs->dc.icc.mon_rxp -1]);
 364                                 cs->dc.icc.mocr |= 0x40;
 365                                 cs->writeisac(cs, ICC_MOCR, cs->dc.icc.mocr);
 366                         }
 367                       afterMONR1:
 368                         if (v1 & 0x04) {
 369                                 cs->dc.icc.mocr &= 0xf0;
 370                                 cs->writeisac(cs, ICC_MOCR, cs->dc.icc.mocr);
 371                                 cs->dc.icc.mocr |= 0x0a;
 372                                 cs->writeisac(cs, ICC_MOCR, cs->dc.icc.mocr);
 373                                 schedule_event(cs, D_RX_MON0);
 374                         }
 375                         if (v1 & 0x40) {
 376                                 cs->dc.icc.mocr &= 0x0f;
 377                                 cs->writeisac(cs, ICC_MOCR, cs->dc.icc.mocr);
 378                                 cs->dc.icc.mocr |= 0xa0;
 379                                 cs->writeisac(cs, ICC_MOCR, cs->dc.icc.mocr);
 380                                 schedule_event(cs, D_RX_MON1);
 381                         }
 382                         if (v1 & 0x02) {
 383                                 if ((!cs->dc.icc.mon_tx) || (cs->dc.icc.mon_txc &&
 384                                         (cs->dc.icc.mon_txp >= cs->dc.icc.mon_txc) &&
 385                                         !(v1 & 0x08))) {
 386                                         cs->dc.icc.mocr &= 0xf0;
 387                                         cs->writeisac(cs, ICC_MOCR, cs->dc.icc.mocr);
 388                                         cs->dc.icc.mocr |= 0x0a;
 389                                         cs->writeisac(cs, ICC_MOCR, cs->dc.icc.mocr);
 390                                         if (cs->dc.icc.mon_txc &&
 391                                                 (cs->dc.icc.mon_txp >= cs->dc.icc.mon_txc))
 392                                                 schedule_event(cs, D_TX_MON0);
 393                                         goto AfterMOX0;
 394                                 }
 395                                 if (cs->dc.icc.mon_txc && (cs->dc.icc.mon_txp >= cs->dc.icc.mon_txc)) {
 396                                         schedule_event(cs, D_TX_MON0);
 397                                         goto AfterMOX0;
 398                                 }
 399                                 cs->writeisac(cs, ICC_MOX0,
 400                                         cs->dc.icc.mon_tx[cs->dc.icc.mon_txp++]);
 401                                 if (cs->debug & L1_DEB_MONITOR)
 402                                         debugl1(cs, "ICC %02x -> MOX0", cs->dc.icc.mon_tx[cs->dc.icc.mon_txp -1]);
 403                         }
 404                       AfterMOX0:
 405                         if (v1 & 0x20) {
 406                                 if ((!cs->dc.icc.mon_tx) || (cs->dc.icc.mon_txc &&
 407                                         (cs->dc.icc.mon_txp >= cs->dc.icc.mon_txc) &&
 408                                         !(v1 & 0x80))) {
 409                                         cs->dc.icc.mocr &= 0x0f;
 410                                         cs->writeisac(cs, ICC_MOCR, cs->dc.icc.mocr);
 411                                         cs->dc.icc.mocr |= 0xa0;
 412                                         cs->writeisac(cs, ICC_MOCR, cs->dc.icc.mocr);
 413                                         if (cs->dc.icc.mon_txc &&
 414                                                 (cs->dc.icc.mon_txp >= cs->dc.icc.mon_txc))
 415                                                 schedule_event(cs, D_TX_MON1);
 416                                         goto AfterMOX1;
 417                                 }
 418                                 if (cs->dc.icc.mon_txc && (cs->dc.icc.mon_txp >= cs->dc.icc.mon_txc)) {
 419                                         schedule_event(cs, D_TX_MON1);
 420                                         goto AfterMOX1;
 421                                 }
 422                                 cs->writeisac(cs, ICC_MOX1,
 423                                         cs->dc.icc.mon_tx[cs->dc.icc.mon_txp++]);
 424                                 if (cs->debug & L1_DEB_MONITOR)
 425                                         debugl1(cs, "ICC %02x -> MOX1", cs->dc.icc.mon_tx[cs->dc.icc.mon_txp -1]);
 426                         }
 427                       AfterMOX1:
 428 #endif
 429                 }
 430         }
 431 }
 432
 433 static void
 434 ICC_l1hw(struct PStack *st, int pr, void *arg)
 435 {
 436         struct IsdnCardState *cs = (struct IsdnCardState *) st->l1.hardware;
 437         struct sk_buff *skb = arg;
 438         u_long flags;
 439         int  val;
 440
 441         switch (pr) {
 442                 case (PH_DATA |REQUEST):
 443                         if (cs->debug & DEB_DLOG_HEX)
 444                                 LogFrame(cs, skb->data, skb->len);
 445                         if (cs->debug & DEB_DLOG_VERBOSE)
 446                                 dlogframe(cs, skb, 0);
 447                         spin_lock_irqsave(&cs->lock, flags);
 448                         if (cs->tx_skb) {
 449                                 skb_queue_tail(&cs->sq, skb);
 450 #ifdef L2FRAME_DEBUG            /* psa */
 451                                 if (cs->debug & L1_DEB_LAPD)
 452                                         Logl2Frame(cs, skb, "PH_DATA Queued", 0);
 453 #endif
 454                         } else {
 455                                 cs->tx_skb = skb;
 456                                 cs->tx_cnt = 0;
 457 #ifdef L2FRAME_DEBUG            /* psa */
 458                                 if (cs->debug & L1_DEB_LAPD)
 459                                         Logl2Frame(cs, skb, "PH_DATA", 0);
 460 #endif
 461                                 icc_fill_fifo(cs);
 462                         }
 463                         spin_unlock_irqrestore(&cs->lock, flags);
 464                         break;
 465                 case (PH_PULL |INDICATION):
 466                         spin_lock_irqsave(&cs->lock, flags);
 467                         if (cs->tx_skb) {
 468                                 if (cs->debug & L1_DEB_WARN)
 469                                         debugl1(cs, " l2l1 tx_skb exist this shouldn't happen");
 470                                 skb_queue_tail(&cs->sq, skb);
 471                                 break;
 472                         }
 473                         if (cs->debug & DEB_DLOG_HEX)
 474                                 LogFrame(cs, skb->data, skb->len);
 475                         if (cs->debug & DEB_DLOG_VERBOSE)
 476                                 dlogframe(cs, skb, 0);
 477                         cs->tx_skb = skb;
 478                         cs->tx_cnt = 0;
 479 #ifdef L2FRAME_DEBUG            /* psa */
 480                         if (cs->debug & L1_DEB_LAPD)
 481                                 Logl2Frame(cs, skb, "PH_DATA_PULLED", 0);
 482 #endif
 483                         icc_fill_fifo(cs);
 484                         spin_unlock_irqrestore(&cs->lock, flags);
 485                         break;
 486                 case (PH_PULL | REQUEST):
 487 #ifdef L2FRAME_DEBUG            /* psa */
 488                         if (cs->debug & L1_DEB_LAPD)
 489                                 debugl1(cs, "-> PH_REQUEST_PULL");
 490 #endif
 491                         if (!cs->tx_skb) {
 492                                 test_and_clear_bit(FLG_L1_PULL_REQ, &st->l1.Flags);
 493                                 st->l1.l1l2(st, PH_PULL | CONFIRM, NULL);
 494                         } else
 495                                 test_and_set_bit(FLG_L1_PULL_REQ, &st->l1.Flags);
 496                         break;
 497                 case (HW_RESET | REQUEST):
 498                         spin_lock_irqsave(&cs->lock, flags);
 499                         if ((cs->dc.icc.ph_state == ICC_IND_EI1) ||
 500                                 (cs->dc.icc.ph_state == ICC_IND_DR))
 501                                 ph_command(cs, ICC_CMD_DI);
 502                         else
 503                                 ph_command(cs, ICC_CMD_RES);
 504                         spin_unlock_irqrestore(&cs->lock, flags);
 505                         break;
 506                 case (HW_ENABLE | REQUEST):
 507                         spin_lock_irqsave(&cs->lock, flags);
 508                         ph_command(cs, ICC_CMD_DI);
 509                         spin_unlock_irqrestore(&cs->lock, flags);
 510                         break;
 511                 case (HW_INFO1 | REQUEST):
 512                         spin_lock_irqsave(&cs->lock, flags);
 513                         ph_command(cs, ICC_CMD_AR);
 514                         spin_unlock_irqrestore(&cs->lock, flags);
 515                         break;
 516                 case (HW_INFO3 | REQUEST):
 517                         spin_lock_irqsave(&cs->lock, flags);
 518                         ph_command(cs, ICC_CMD_AI);
 519                         spin_unlock_irqrestore(&cs->lock, flags);
 520                         break;
 521                 case (HW_TESTLOOP | REQUEST):
 522                         spin_lock_irqsave(&cs->lock, flags);
 523                         val = 0;
 524                         if (1 & (long) arg)
 525                                 val |= 0x0c;
 526                         if (2 & (long) arg)
 527                                 val |= 0x3;
 528                         if (test_bit(HW_IOM1, &cs->HW_Flags)) {
 529                                 /* IOM 1 Mode */
 530                                 if (!val) {
 531                                         cs->writeisac(cs, ICC_SPCR, 0xa);
 532                                         cs->writeisac(cs, ICC_ADF1, 0x2);
 533                                 } else {
 534                                         cs->writeisac(cs, ICC_SPCR, val);
 535                                         cs->writeisac(cs, ICC_ADF1, 0xa);
 536                                 }
 537                         } else {
 538                                 /* IOM 2 Mode */
 539                                 cs->writeisac(cs, ICC_SPCR, val);
 540                                 if (val)
 541                                         cs->writeisac(cs, ICC_ADF1, 0x8);
 542                                 else
 543                                         cs->writeisac(cs, ICC_ADF1, 0x0);
 544                         }
 545                         spin_unlock_irqrestore(&cs->lock, flags);
 546                         break;
 547                 case (HW_DEACTIVATE | RESPONSE):
 548                         skb_queue_purge(&cs->rq);
 549                         skb_queue_purge(&cs->sq);
 550                         if (cs->tx_skb) {
 551                                 dev_kfree_skb_any(cs->tx_skb);
 552                                 cs->tx_skb = NULL;
 553                         }
 554                         if (test_and_clear_bit(FLG_DBUSY_TIMER, &cs->HW_Flags))
 555                                 del_timer(&cs->dbusytimer);
 556                         if (test_and_clear_bit(FLG_L1_DBUSY, &cs->HW_Flags))
 557                                 schedule_event(cs, D_CLEARBUSY);
 558                         break;
 559                 default:
 560                         if (cs->debug & L1_DEB_WARN)
 561                                 debugl1(cs, "icc_l1hw unknown %04x", pr);
 562                         break;
 563         }
 564 }
 565
 566 static void
 567 setstack_icc(struct PStack *st, struct IsdnCardState *cs)
 568 {
 569         st->l1.l1hw = ICC_l1hw;
 570 }
 571
 572 static void
 573 DC_Close_icc(struct IsdnCardState *cs) {
 574         kfree(cs->dc.icc.mon_rx);
 575         cs->dc.icc.mon_rx = NULL;
 576         kfree(cs->dc.icc.mon_tx);
 577         cs->dc.icc.mon_tx = NULL;
 578 }
 579
 580 static void
 581 dbusy_timer_handler(struct IsdnCardState *cs)
 582 {
 583         struct PStack *stptr;
 584         int     rbch, star;
 585
 586         if (test_bit(FLG_DBUSY_TIMER, &cs->HW_Flags)) {
 587                 rbch = cs->readisac(cs, ICC_RBCH);
 588                 star = cs->readisac(cs, ICC_STAR);
 589                 if (cs->debug)
 590                         debugl1(cs, "D-Channel Busy RBCH %02x STAR %02x",
 591                                 rbch, star);
 592                 if (rbch & ICC_RBCH_XAC) { /* D-Channel Busy */
 593                         test_and_set_bit(FLG_L1_DBUSY, &cs->HW_Flags);
 594                         stptr = cs->stlist;
 595                         while (stptr != NULL) {
 596                                 stptr->l1.l1l2(stptr, PH_PAUSE | INDICATION, NULL);
 597                                 stptr = stptr->next;
 598                         }
 599                 } else {
 600                         /* discard frame; reset transceiver */
 601                         test_and_clear_bit(FLG_DBUSY_TIMER, &cs->HW_Flags);
 602                         if (cs->tx_skb) {
 603                                 dev_kfree_skb_any(cs->tx_skb);
 604                                 cs->tx_cnt = 0;
 605                                 cs->tx_skb = NULL;
 606                         } else {
 607                                 printk(KERN_WARNING "HiSax: ICC D-Channel Busy no skb\n");
 608                                 debugl1(cs, "D-Channel Busy no skb");
 609                         }
 610                         cs->writeisac(cs, ICC_CMDR, 0x01); /* Transmitter reset */
 611                         cs->irq_func(cs->irq, cs, NULL);
 612                 }
 613         }
 614 }
 615
 616 void __init
 617 initicc(struct IsdnCardState *cs)
 618 {
 619         cs->setstack_d = setstack_icc;
 620         cs->DC_Close = DC_Close_icc;
 621         cs->dc.icc.mon_tx = NULL;
 622         cs->dc.icc.mon_rx = NULL;
 623         cs->writeisac(cs, ICC_MASK, 0xff);
 624         cs->dc.icc.mocr = 0xaa;
 625         if (test_bit(HW_IOM1, &cs->HW_Flags)) {
 626                 /* IOM 1 Mode */
 627                 cs->writeisac(cs, ICC_ADF2, 0x0);
 628                 cs->writeisac(cs, ICC_SPCR, 0xa);
 629                 cs->writeisac(cs, ICC_ADF1, 0x2);
 630                 cs->writeisac(cs, ICC_STCR, 0x70);
 631                 cs->writeisac(cs, ICC_MODE, 0xc9);
 632         } else {
 633                 /* IOM 2 Mode */
 634                 if (!cs->dc.icc.adf2)
 635                         cs->dc.icc.adf2 = 0x80;
 636                 cs->writeisac(cs, ICC_ADF2, cs->dc.icc.adf2);
 637                 cs->writeisac(cs, ICC_SQXR, 0xa0);
 638                 cs->writeisac(cs, ICC_SPCR, 0x20);
 639                 cs->writeisac(cs, ICC_STCR, 0x70);
 640                 cs->writeisac(cs, ICC_MODE, 0xca);
 641                 cs->writeisac(cs, ICC_TIMR, 0x00);
 642                 cs->writeisac(cs, ICC_ADF1, 0x20);
 643         }
 644         ph_command(cs, ICC_CMD_RES);
 645         cs->writeisac(cs, ICC_MASK, 0x0);
 646         ph_command(cs, ICC_CMD_DI);
 647 }
 648
 649 void __init
 650 clear_pending_icc_ints(struct IsdnCardState *cs)
 651 {
 652         int val, eval;
 653
 654         val = cs->readisac(cs, ICC_STAR);
 655         debugl1(cs, "ICC STAR %x", val);
 656         val = cs->readisac(cs, ICC_MODE);
 657         debugl1(cs, "ICC MODE %x", val);
 658         val = cs->readisac(cs, ICC_ADF2);
 659         debugl1(cs, "ICC ADF2 %x", val);
 660         val = cs->readisac(cs, ICC_ISTA);
 661         debugl1(cs, "ICC ISTA %x", val);
 662         if (val & 0x01) {
 663                 eval = cs->readisac(cs, ICC_EXIR);
 664                 debugl1(cs, "ICC EXIR %x", eval);
 665         }
 666         val = cs->readisac(cs, ICC_CIR0);
 667         debugl1(cs, "ICC CIR0 %x", val);
 668         cs->dc.icc.ph_state = (val >> 2) & 0xf;
 669         schedule_event(cs, D_L1STATECHANGE);
 670         /* Disable all IRQ */
 671         cs->writeisac(cs, ICC_MASK, 0xFF);
 672 }
 673
 674 void __devinit
 675 setup_icc(struct IsdnCardState *cs)
 676 {
 677         INIT_WORK(&cs->tqueue, (void *)(void *) icc_bh, cs);
 678         cs->dbusytimer.function = (void *) dbusy_timer_handler;
 679         cs->dbusytimer.data = (long) cs;
 680         init_timer(&cs->dbusytimer);
 681 }