drivers/isdn/hisax/elsa_ser.c

   1 /* $Id: elsa_ser.c,v 2.14.2.3 2004/02/11 13:21:33 keil Exp $
   2  *
   3  * stuff for the serial modem on ELSA cards
   4  *
   5  * This software may be used and distributed according to the terms
   6  * of the GNU General Public License, incorporated herein by reference.
   7  *
   8  */
   9
  10 #include <linux/serial.h>
  11 #include <linux/serial_reg.h>
  12 #include <linux/slab.h>
  13
  14 #define MAX_MODEM_BUF   256
  15 #define WAKEUP_CHARS    (MAX_MODEM_BUF/2)
  16 #define RS_ISR_PASS_LIMIT 256
  17 #define BASE_BAUD ( 1843200 / 16 )
  18
  19 //#define SERIAL_DEBUG_OPEN 1
  20 //#define SERIAL_DEBUG_INTR 1
  21 //#define SERIAL_DEBUG_FLOW 1
  22 #undef SERIAL_DEBUG_OPEN
  23 #undef SERIAL_DEBUG_INTR
  24 #undef SERIAL_DEBUG_FLOW
  25 #undef SERIAL_DEBUG_REG
  26 //#define SERIAL_DEBUG_REG 1
  27
  28 #ifdef SERIAL_DEBUG_REG
  29 static u_char deb[32];
  30 const char *ModemIn[] = {"RBR","IER","IIR","LCR","MCR","LSR","MSR","SCR"};
  31 const char *ModemOut[] = {"THR","IER","FCR","LCR","MCR","LSR","MSR","SCR"};
  32 #endif
  33
  34 static char *MInit_1 = "AT&F&C1E0&D2\r\0";
  35 static char *MInit_2 = "ATL2M1S64=13\r\0";
  36 static char *MInit_3 = "AT+FCLASS=0\r\0";
  37 static char *MInit_4 = "ATV1S2=128X1\r\0";
  38 static char *MInit_5 = "AT\\V8\\N3\r\0";
  39 static char *MInit_6 = "ATL0M0&G0%E1\r\0";
  40 static char *MInit_7 = "AT%L1%M0%C3\r\0";
  41
  42 static char *MInit_speed28800 = "AT%G0%B28800\r\0";
  43
  44 static char *MInit_dialout = "ATs7=60 x1 d\r\0";
  45 static char *MInit_dialin = "ATs7=60 x1 a\r\0";
  46
  47
  48 static inline unsigned int serial_in(struct IsdnCardState *cs, int offset)
  49 {
  50 #ifdef SERIAL_DEBUG_REG
  51         u_int val = inb(cs->hw.elsa.base + 8 + offset);
  52         debugl1(cs,"in   %s %02x",ModemIn[offset], val);
  53         return(val);
  54 #else
  55         return inb(cs->hw.elsa.base + 8 + offset);
  56 #endif
  57 }
  58
  59 static inline unsigned int serial_inp(struct IsdnCardState *cs, int offset)
  60 {
  61 #ifdef SERIAL_DEBUG_REG
  62 #ifdef ELSA_SERIAL_NOPAUSE_IO
  63         u_int val = inb(cs->hw.elsa.base + 8 + offset);
  64         debugl1(cs,"inp  %s %02x",ModemIn[offset], val);
  65 #else
  66         u_int val = inb_p(cs->hw.elsa.base + 8 + offset);
  67         debugl1(cs,"inP  %s %02x",ModemIn[offset], val);
  68 #endif
  69         return(val);
  70 #else
  71 #ifdef ELSA_SERIAL_NOPAUSE_IO
  72         return inb(cs->hw.elsa.base + 8 + offset);
  73 #else
  74         return inb_p(cs->hw.elsa.base + 8 + offset);
  75 #endif
  76 #endif
  77 }
  78
  79 static inline void serial_out(struct IsdnCardState *cs, int offset, int value)
  80 {
  81 #ifdef SERIAL_DEBUG_REG
  82         debugl1(cs,"out  %s %02x",ModemOut[offset], value);
  83 #endif
  84         outb(value, cs->hw.elsa.base + 8 + offset);
  85 }
  86
  87 static inline void serial_outp(struct IsdnCardState *cs, int offset,
  88                                int value)
  89 {
  90 #ifdef SERIAL_DEBUG_REG
  91 #ifdef ELSA_SERIAL_NOPAUSE_IO
  92         debugl1(cs,"outp %s %02x",ModemOut[offset], value);
  93 #else
  94         debugl1(cs,"outP %s %02x",ModemOut[offset], value);
  95 #endif
  96 #endif
  97 #ifdef ELSA_SERIAL_NOPAUSE_IO
  98         outb(value, cs->hw.elsa.base + 8 + offset);
  99 #else
 100         outb_p(value, cs->hw.elsa.base + 8 + offset);
 101 #endif
 102 }
 103
 104 /*
 105  * This routine is called to set the UART divisor registers to match
 106  * the specified baud rate for a serial port.
 107  */
 108 static void change_speed(struct IsdnCardState *cs, int baud)
 109 {
 110         int     quot = 0, baud_base;
 111         unsigned cval, fcr = 0;
 112
 113
 114         /* byte size and parity */
 115         cval = 0x03;
 116         /* Determine divisor based on baud rate */
 117         baud_base = BASE_BAUD;
 118         quot = baud_base / baud;
 119         /* If the quotient is ever zero, default to 9600 bps */
 120         if (!quot)
 121                 quot = baud_base / 9600;
 122
 123         /* Set up FIFO's */
 124         if ((baud_base / quot) < 2400)
 125                 fcr = UART_FCR_ENABLE_FIFO | UART_FCR_TRIGGER_1;
 126         else
 127                 fcr = UART_FCR_ENABLE_FIFO | UART_FCR_TRIGGER_8;
 128         serial_outp(cs, UART_FCR, fcr);
 129         /* CTS flow control flag and modem status interrupts */
 130         cs->hw.elsa.IER &= ~UART_IER_MSI;
 131         cs->hw.elsa.IER |= UART_IER_MSI;
 132         serial_outp(cs, UART_IER, cs->hw.elsa.IER);
 133
 134         debugl1(cs,"modem quot=0x%x", quot);
 135         serial_outp(cs, UART_LCR, cval | UART_LCR_DLAB);/* set DLAB */
 136         serial_outp(cs, UART_DLL, quot & 0xff);         /* LS of divisor */
 137         serial_outp(cs, UART_DLM, quot >> 8);           /* MS of divisor */
 138         serial_outp(cs, UART_LCR, cval);                /* reset DLAB */
 139         serial_inp(cs, UART_RX);
 140 }
 141
 142 static int mstartup(struct IsdnCardState *cs)
 143 {
 144         int     retval=0;
 145
 146         /*
 147          * Clear the FIFO buffers and disable them
 148          * (they will be reenabled in change_speed())
 149          */
 150         serial_outp(cs, UART_FCR, (UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT));
 151
 152         /*
 153          * At this point there's no way the LSR could still be 0xFF;
 154          * if it is, then bail out, because there's likely no UART
 155          * here.
 156          */
 157         if (serial_inp(cs, UART_LSR) == 0xff) {
 158                 retval = -ENODEV;
 159                 goto errout;
 160         }
 161
 162         /*
 163          * Clear the interrupt registers.
 164          */
 165         (void) serial_inp(cs, UART_RX);
 166         (void) serial_inp(cs, UART_IIR);
 167         (void) serial_inp(cs, UART_MSR);
 168
 169         /*
 170          * Now, initialize the UART
 171          */
 172         serial_outp(cs, UART_LCR, UART_LCR_WLEN8);      /* reset DLAB */
 173
 174         cs->hw.elsa.MCR = 0;
 175         cs->hw.elsa.MCR = UART_MCR_DTR | UART_MCR_RTS | UART_MCR_OUT2;
 176         serial_outp(cs, UART_MCR, cs->hw.elsa.MCR);
 177
 178         /*
 179          * Finally, enable interrupts
 180          */
 181         cs->hw.elsa.IER = UART_IER_MSI | UART_IER_RLSI | UART_IER_RDI;
 182         serial_outp(cs, UART_IER, cs->hw.elsa.IER);     /* enable interrupts */
 183
 184         /*
 185          * And clear the interrupt registers again for luck.
 186          */
 187         (void)serial_inp(cs, UART_LSR);
 188         (void)serial_inp(cs, UART_RX);
 189         (void)serial_inp(cs, UART_IIR);
 190         (void)serial_inp(cs, UART_MSR);
 191
 192         cs->hw.elsa.transcnt = cs->hw.elsa.transp = 0;
 193         cs->hw.elsa.rcvcnt = cs->hw.elsa.rcvp =0;
 194
 195         /*
 196          * and set the speed of the serial port
 197          */
 198         change_speed(cs, BASE_BAUD);
 199         cs->hw.elsa.MFlag = 1;
 200 errout:
 201         return retval;
 202 }
 203
 204 /*
 205  * This routine will shutdown a serial port; interrupts are disabled, and
 206  * DTR is dropped if the hangup on close termio flag is on.
 207  */
 208 static void mshutdown(struct IsdnCardState *cs)
 209 {
 210
 211 #ifdef SERIAL_DEBUG_OPEN
 212         printk(KERN_DEBUG"Shutting down serial ....");
 213 #endif
 214
 215         /*
 216          * clear delta_msr_wait queue to avoid mem leaks: we may free the irq
 217          * here so the queue might never be waken up
 218          */
 219
 220         cs->hw.elsa.IER = 0;
 221         serial_outp(cs, UART_IER, 0x00);        /* disable all intrs */
 222         cs->hw.elsa.MCR &= ~UART_MCR_OUT2;
 223
 224         /* disable break condition */
 225         serial_outp(cs, UART_LCR, serial_inp(cs, UART_LCR) & ~UART_LCR_SBC);
 226
 227         cs->hw.elsa.MCR &= ~(UART_MCR_DTR|UART_MCR_RTS);
 228         serial_outp(cs, UART_MCR, cs->hw.elsa.MCR);
 229
 230         /* disable FIFO's */
 231         serial_outp(cs, UART_FCR, (UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT));
 232         serial_inp(cs, UART_RX);    /* read data port to reset things */
 233
 234 #ifdef SERIAL_DEBUG_OPEN
 235         printk(" done\n");
 236 #endif
 237 }
 238
 239 static inline int
 240 write_modem(struct BCState *bcs) {
 241         int ret=0;
 242         struct IsdnCardState *cs = bcs->cs;
 243         int count, len, fp;
 244
 245         if (!bcs->tx_skb)
 246                 return 0;
 247         if (bcs->tx_skb->len <= 0)
 248                 return 0;
 249         len = bcs->tx_skb->len;
 250         if (len > MAX_MODEM_BUF - cs->hw.elsa.transcnt)
 251                 len = MAX_MODEM_BUF - cs->hw.elsa.transcnt;
 252         fp = cs->hw.elsa.transcnt + cs->hw.elsa.transp;
 253         fp &= (MAX_MODEM_BUF -1);
 254         count = len;
 255         if (count > MAX_MODEM_BUF - fp) {
 256                 count = MAX_MODEM_BUF - fp;
 257                 skb_copy_from_linear_data(bcs->tx_skb,
 258                                           cs->hw.elsa.transbuf + fp, count);
 259                 skb_pull(bcs->tx_skb, count);
 260                 cs->hw.elsa.transcnt += count;
 261                 ret = count;
 262                 count = len - count;
 263                 fp = 0;
 264         }
 265         skb_copy_from_linear_data(bcs->tx_skb,
 266                                   cs->hw.elsa.transbuf + fp, count);
 267         skb_pull(bcs->tx_skb, count);
 268         cs->hw.elsa.transcnt += count;
 269         ret += count;
 270
 271         if (cs->hw.elsa.transcnt &&
 272             !(cs->hw.elsa.IER & UART_IER_THRI)) {
 273                         cs->hw.elsa.IER |= UART_IER_THRI;
 274                 serial_outp(cs, UART_IER, cs->hw.elsa.IER);
 275         }
 276         return(ret);
 277 }
 278
 279 static inline void
 280 modem_fill(struct BCState *bcs) {
 281
 282         if (bcs->tx_skb) {
 283                 if (bcs->tx_skb->len) {
 284                         write_modem(bcs);
 285                         return;
 286                 } else {
 287                         if (test_bit(FLG_LLI_L1WAKEUP,&bcs->st->lli.flag) &&
 288                                 (PACKET_NOACK != bcs->tx_skb->pkt_type)) {
 289                                 u_long  flags;
 290                                 spin_lock_irqsave(&bcs->aclock, flags);
 291                                 bcs->ackcnt += bcs->hw.hscx.count;
 292                                 spin_unlock_irqrestore(&bcs->aclock, flags);
 293                                 schedule_event(bcs, B_ACKPENDING);
 294                         }
 295                         dev_kfree_skb_any(bcs->tx_skb);
 296                         bcs->tx_skb = NULL;
 297                 }
 298         }
 299         if ((bcs->tx_skb = skb_dequeue(&bcs->squeue))) {
 300                 bcs->hw.hscx.count = 0;
 301                 test_and_set_bit(BC_FLG_BUSY, &bcs->Flag);
 302                 write_modem(bcs);
 303         } else {
 304                 test_and_clear_bit(BC_FLG_BUSY, &bcs->Flag);
 305                 schedule_event(bcs, B_XMTBUFREADY);
 306         }
 307 }
 308
 309 static inline void receive_chars(struct IsdnCardState *cs,
 310                                  int *status)
 311 {
 312         unsigned char ch;
 313         struct sk_buff *skb;
 314
 315         do {
 316                 ch = serial_in(cs, UART_RX);
 317                 if (cs->hw.elsa.rcvcnt >= MAX_MODEM_BUF)
 318                         break;
 319                 cs->hw.elsa.rcvbuf[cs->hw.elsa.rcvcnt++] = ch;
 320 #ifdef SERIAL_DEBUG_INTR
 321                 printk("DR%02x:%02x...", ch, *status);
 322 #endif
 323                 if (*status & (UART_LSR_BI | UART_LSR_PE |
 324                                UART_LSR_FE | UART_LSR_OE)) {
 325
 326 #ifdef SERIAL_DEBUG_INTR
 327                         printk("handling exept....");
 328 #endif
 329                 }
 330                 *status = serial_inp(cs, UART_LSR);
 331         } while (*status & UART_LSR_DR);
 332         if (cs->hw.elsa.MFlag == 2) {
 333                 if (!(skb = dev_alloc_skb(cs->hw.elsa.rcvcnt)))
 334                         printk(KERN_WARNING "ElsaSER: receive out of memory\n");
 335                 else {
 336                         memcpy(skb_put(skb, cs->hw.elsa.rcvcnt), cs->hw.elsa.rcvbuf,
 337                                 cs->hw.elsa.rcvcnt);
 338                         skb_queue_tail(& cs->hw.elsa.bcs->rqueue, skb);
 339                 }
 340                 schedule_event(cs->hw.elsa.bcs, B_RCVBUFREADY);
 341         } else {
 342                 char tmp[128];
 343                 char *t = tmp;
 344
 345                 t += sprintf(t, "modem read cnt %d", cs->hw.elsa.rcvcnt);
 346                 QuickHex(t, cs->hw.elsa.rcvbuf, cs->hw.elsa.rcvcnt);
 347                 debugl1(cs, tmp);
 348         }
 349         cs->hw.elsa.rcvcnt = 0;
 350 }
 351
 352 static inline void transmit_chars(struct IsdnCardState *cs, int *intr_done)
 353 {
 354         int count;
 355
 356         debugl1(cs, "transmit_chars: p(%x) cnt(%x)", cs->hw.elsa.transp,
 357                 cs->hw.elsa.transcnt);
 358
 359         if (cs->hw.elsa.transcnt <= 0) {
 360                 cs->hw.elsa.IER &= ~UART_IER_THRI;
 361                 serial_out(cs, UART_IER, cs->hw.elsa.IER);
 362                 return;
 363         }
 364         count = 16;
 365         do {
 366                 serial_outp(cs, UART_TX, cs->hw.elsa.transbuf[cs->hw.elsa.transp++]);
 367                 if (cs->hw.elsa.transp >= MAX_MODEM_BUF)
 368                         cs->hw.elsa.transp=0;
 369                 if (--cs->hw.elsa.transcnt <= 0)
 370                         break;
 371         } while (--count > 0);
 372         if ((cs->hw.elsa.transcnt < WAKEUP_CHARS) && (cs->hw.elsa.MFlag==2))
 373                 modem_fill(cs->hw.elsa.bcs);
 374
 375 #ifdef SERIAL_DEBUG_INTR
 376         printk("THRE...");
 377 #endif
 378         if (intr_done)
 379                 *intr_done = 0;
 380         if (cs->hw.elsa.transcnt <= 0) {
 381                 cs->hw.elsa.IER &= ~UART_IER_THRI;
 382                 serial_outp(cs, UART_IER, cs->hw.elsa.IER);
 383         }
 384 }
 385
 386
 387 static void rs_interrupt_elsa(struct IsdnCardState *cs)
 388 {
 389         int status, iir, msr;
 390         int pass_counter = 0;
 391
 392 #ifdef SERIAL_DEBUG_INTR
 393         printk(KERN_DEBUG "rs_interrupt_single(%d)...", cs->irq);
 394 #endif
 395
 396         do {
 397                 status = serial_inp(cs, UART_LSR);
 398                 debugl1(cs,"rs LSR %02x", status);
 399 #ifdef SERIAL_DEBUG_INTR
 400                 printk("status = %x...", status);
 401 #endif
 402                 if (status & UART_LSR_DR)
 403                         receive_chars(cs, &status);
 404                 if (status & UART_LSR_THRE)
 405                         transmit_chars(cs, NULL);
 406                 if (pass_counter++ > RS_ISR_PASS_LIMIT) {
 407                         printk("rs_single loop break.\n");
 408                         break;
 409                 }
 410                 iir = serial_inp(cs, UART_IIR);
 411                 debugl1(cs,"rs IIR %02x", iir);
 412                 if ((iir & 0xf) == 0) {
 413                         msr = serial_inp(cs, UART_MSR);
 414                         debugl1(cs,"rs MSR %02x", msr);
 415                 }
 416         } while (!(iir & UART_IIR_NO_INT));
 417 #ifdef SERIAL_DEBUG_INTR
 418         printk("end.\n");
 419 #endif
 420 }
 421
 422 extern int open_hscxstate(struct IsdnCardState *cs, struct BCState *bcs);
 423 extern void modehscx(struct BCState *bcs, int mode, int bc);
 424 extern void hscx_l2l1(struct PStack *st, int pr, void *arg);
 425
 426 static void
 427 close_elsastate(struct BCState *bcs)
 428 {
 429         modehscx(bcs, 0, bcs->channel);
 430         if (test_and_clear_bit(BC_FLG_INIT, &bcs->Flag)) {
 431                 if (bcs->hw.hscx.rcvbuf) {
 432                         if (bcs->mode != L1_MODE_MODEM)
 433                                 kfree(bcs->hw.hscx.rcvbuf);
 434                         bcs->hw.hscx.rcvbuf = NULL;
 435                 }
 436                 skb_queue_purge(&bcs->rqueue);
 437                 skb_queue_purge(&bcs->squeue);
 438                 if (bcs->tx_skb) {
 439                         dev_kfree_skb_any(bcs->tx_skb);
 440                         bcs->tx_skb = NULL;
 441                         test_and_clear_bit(BC_FLG_BUSY, &bcs->Flag);
 442                 }
 443         }
 444 }
 445
 446 static void
 447 modem_write_cmd(struct IsdnCardState *cs, u_char *buf, int len) {
 448         int count, fp;
 449         u_char *msg = buf;
 450
 451         if (!len)
 452                 return;
 453         if (len > (MAX_MODEM_BUF - cs->hw.elsa.transcnt)) {
 454                 return;
 455         }
 456         fp = cs->hw.elsa.transcnt + cs->hw.elsa.transp;
 457         fp &= (MAX_MODEM_BUF -1);
 458         count = len;
 459         if (count > MAX_MODEM_BUF - fp) {
 460                 count = MAX_MODEM_BUF - fp;
 461                 memcpy(cs->hw.elsa.transbuf + fp, msg, count);
 462                 cs->hw.elsa.transcnt += count;
 463                 msg += count;
 464                 count = len - count;
 465                 fp = 0;
 466         }
 467         memcpy(cs->hw.elsa.transbuf + fp, msg, count);
 468         cs->hw.elsa.transcnt += count;
 469         if (cs->hw.elsa.transcnt &&
 470             !(cs->hw.elsa.IER & UART_IER_THRI)) {
 471                 cs->hw.elsa.IER |= UART_IER_THRI;
 472                 serial_outp(cs, UART_IER, cs->hw.elsa.IER);
 473         }
 474 }
 475
 476 static void
 477 modem_set_init(struct IsdnCardState *cs) {
 478         int timeout;
 479
 480 #define RCV_DELAY 20
 481         modem_write_cmd(cs, MInit_1, strlen(MInit_1));
 482         timeout = 1000;
 483         while(timeout-- && cs->hw.elsa.transcnt)
 484                 udelay(1000);
 485         debugl1(cs, "msi tout=%d", timeout);
 486         mdelay(RCV_DELAY);
 487         modem_write_cmd(cs, MInit_2, strlen(MInit_2));
 488         timeout = 1000;
 489         while(timeout-- && cs->hw.elsa.transcnt)
 490                 udelay(1000);
 491         debugl1(cs, "msi tout=%d", timeout);
 492         mdelay(RCV_DELAY);
 493         modem_write_cmd(cs, MInit_3, strlen(MInit_3));
 494         timeout = 1000;
 495         while(timeout-- && cs->hw.elsa.transcnt)
 496                 udelay(1000);
 497         debugl1(cs, "msi tout=%d", timeout);
 498         mdelay(RCV_DELAY);
 499         modem_write_cmd(cs, MInit_4, strlen(MInit_4));
 500         timeout = 1000;
 501         while(timeout-- && cs->hw.elsa.transcnt)
 502                 udelay(1000);
 503         debugl1(cs, "msi tout=%d", timeout);
 504         mdelay(RCV_DELAY);
 505         modem_write_cmd(cs, MInit_5, strlen(MInit_5));
 506         timeout = 1000;
 507         while(timeout-- && cs->hw.elsa.transcnt)
 508                 udelay(1000);
 509         debugl1(cs, "msi tout=%d", timeout);
 510         mdelay(RCV_DELAY);
 511         modem_write_cmd(cs, MInit_6, strlen(MInit_6));
 512         timeout = 1000;
 513         while(timeout-- && cs->hw.elsa.transcnt)
 514                 udelay(1000);
 515         debugl1(cs, "msi tout=%d", timeout);
 516         mdelay(RCV_DELAY);
 517         modem_write_cmd(cs, MInit_7, strlen(MInit_7));
 518         timeout = 1000;
 519         while(timeout-- && cs->hw.elsa.transcnt)
 520                 udelay(1000);
 521         debugl1(cs, "msi tout=%d", timeout);
 522         mdelay(RCV_DELAY);
 523 }
 524
 525 static void
 526 modem_set_dial(struct IsdnCardState *cs, int outgoing) {
 527         int timeout;
 528 #define RCV_DELAY 20
 529
 530         modem_write_cmd(cs, MInit_speed28800, strlen(MInit_speed28800));
 531         timeout = 1000;
 532         while(timeout-- && cs->hw.elsa.transcnt)
 533                 udelay(1000);
 534         debugl1(cs, "msi tout=%d", timeout);
 535         mdelay(RCV_DELAY);
 536         if (outgoing)
 537                 modem_write_cmd(cs, MInit_dialout, strlen(MInit_dialout));
 538         else
 539                 modem_write_cmd(cs, MInit_dialin, strlen(MInit_dialin));
 540         timeout = 1000;
 541         while(timeout-- && cs->hw.elsa.transcnt)
 542                 udelay(1000);
 543         debugl1(cs, "msi tout=%d", timeout);
 544         mdelay(RCV_DELAY);
 545 }
 546
 547 static void
 548 modem_l2l1(struct PStack *st, int pr, void *arg)
 549 {
 550         struct BCState *bcs = st->l1.bcs;
 551         struct sk_buff *skb = arg;
 552         u_long flags;
 553
 554         if (pr == (PH_DATA | REQUEST)) {
 555                 spin_lock_irqsave(&bcs->cs->lock, flags);
 556                 if (bcs->tx_skb) {
 557                         skb_queue_tail(&bcs->squeue, skb);
 558                 } else {
 559                         bcs->tx_skb = skb;
 560                         test_and_set_bit(BC_FLG_BUSY, &bcs->Flag);
 561                         bcs->hw.hscx.count = 0;
 562                         write_modem(bcs);
 563                 }
 564                 spin_unlock_irqrestore(&bcs->cs->lock, flags);
 565         } else if (pr == (PH_ACTIVATE | REQUEST)) {
 566                 test_and_set_bit(BC_FLG_ACTIV, &bcs->Flag);
 567                 st->l1.l1l2(st, PH_ACTIVATE | CONFIRM, NULL);
 568                 set_arcofi(bcs->cs, st->l1.bc);
 569                 mstartup(bcs->cs);
 570                 modem_set_dial(bcs->cs, test_bit(FLG_ORIG, &st->l2.flag));
 571                 bcs->cs->hw.elsa.MFlag=2;
 572         } else if (pr == (PH_DEACTIVATE | REQUEST)) {
 573                 test_and_clear_bit(BC_FLG_ACTIV, &bcs->Flag);
 574                 bcs->cs->dc.isac.arcofi_bc = st->l1.bc;
 575                 arcofi_fsm(bcs->cs, ARCOFI_START, &ARCOFI_XOP_0);
 576                 interruptible_sleep_on(&bcs->cs->dc.isac.arcofi_wait);
 577                 bcs->cs->hw.elsa.MFlag=1;
 578         } else {
 579                 printk(KERN_WARNING"ElsaSer: unknown pr %x\n", pr);
 580         }
 581 }
 582
 583 static int
 584 setstack_elsa(struct PStack *st, struct BCState *bcs)
 585 {
 586
 587         bcs->channel = st->l1.bc;
 588         switch (st->l1.mode) {
 589                 case L1_MODE_HDLC:
 590                 case L1_MODE_TRANS:
 591                         if (open_hscxstate(st->l1.hardware, bcs))
 592                                 return (-1);
 593                         st->l2.l2l1 = hscx_l2l1;
 594                         break;
 595                 case L1_MODE_MODEM:
 596                         bcs->mode = L1_MODE_MODEM;
 597                         if (!test_and_set_bit(BC_FLG_INIT, &bcs->Flag)) {
 598                                 bcs->hw.hscx.rcvbuf = bcs->cs->hw.elsa.rcvbuf;
 599                                 skb_queue_head_init(&bcs->rqueue);
 600                                 skb_queue_head_init(&bcs->squeue);
 601                         }
 602                         bcs->tx_skb = NULL;
 603                         test_and_clear_bit(BC_FLG_BUSY, &bcs->Flag);
 604                         bcs->event = 0;
 605                         bcs->hw.hscx.rcvidx = 0;
 606                         bcs->tx_cnt = 0;
 607                         bcs->cs->hw.elsa.bcs = bcs;
 608                         st->l2.l2l1 = modem_l2l1;
 609                         break;
 610         }
 611         st->l1.bcs = bcs;
 612         setstack_manager(st);
 613         bcs->st = st;
 614         setstack_l1_B(st);
 615         return (0);
 616 }
 617
 618 static void
 619 init_modem(struct IsdnCardState *cs) {
 620
 621         cs->bcs[0].BC_SetStack = setstack_elsa;
 622         cs->bcs[1].BC_SetStack = setstack_elsa;
 623         cs->bcs[0].BC_Close = close_elsastate;
 624         cs->bcs[1].BC_Close = close_elsastate;
 625         if (!(cs->hw.elsa.rcvbuf = kmalloc(MAX_MODEM_BUF,
 626                 GFP_ATOMIC))) {
 627                 printk(KERN_WARNING
 628                         "Elsa: No modem mem hw.elsa.rcvbuf\n");
 629                 return;
 630         }
 631         if (!(cs->hw.elsa.transbuf = kmalloc(MAX_MODEM_BUF,
 632                 GFP_ATOMIC))) {
 633                 printk(KERN_WARNING
 634                         "Elsa: No modem mem hw.elsa.transbuf\n");
 635                 kfree(cs->hw.elsa.rcvbuf);
 636                 cs->hw.elsa.rcvbuf = NULL;
 637                 return;
 638         }
 639         if (mstartup(cs)) {
 640                 printk(KERN_WARNING "Elsa: problem startup modem\n");
 641         }
 642         modem_set_init(cs);
 643 }
 644
 645 static void
 646 release_modem(struct IsdnCardState *cs) {
 647
 648         cs->hw.elsa.MFlag = 0;
 649         if (cs->hw.elsa.transbuf) {
 650                 if (cs->hw.elsa.rcvbuf) {
 651                         mshutdown(cs);
 652                         kfree(cs->hw.elsa.rcvbuf);
 653                         cs->hw.elsa.rcvbuf = NULL;
 654                 }
 655                 kfree(cs->hw.elsa.transbuf);
 656                 cs->hw.elsa.transbuf = NULL;
 657         }
 658 }