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