Logo Search packages:      
Sourcecode: linux version File versions  Download package

elsa_ser.c

/* $Id: elsa_ser.c,v 2.14.2.3 2004/02/11 13:21:33 keil Exp $
 *
 * stuff for the serial modem on ELSA cards
 *
 * This software may be used and distributed according to the terms
 * of the GNU General Public License, incorporated herein by reference.
 *
 */

#include <linux/serial.h>
#include <linux/serial_reg.h>

#define MAX_MODEM_BUF   256
#define WAKEUP_CHARS    (MAX_MODEM_BUF/2)
#define RS_ISR_PASS_LIMIT 256
#define BASE_BAUD ( 1843200 / 16 )

//#define SERIAL_DEBUG_OPEN 1
//#define SERIAL_DEBUG_INTR 1
//#define SERIAL_DEBUG_FLOW 1
#undef SERIAL_DEBUG_OPEN
#undef SERIAL_DEBUG_INTR
#undef SERIAL_DEBUG_FLOW
#undef SERIAL_DEBUG_REG
//#define SERIAL_DEBUG_REG 1

#ifdef SERIAL_DEBUG_REG
static u_char deb[32];
const char *ModemIn[] = {"RBR","IER","IIR","LCR","MCR","LSR","MSR","SCR"};
const char *ModemOut[] = {"THR","IER","FCR","LCR","MCR","LSR","MSR","SCR"};
#endif

static char *MInit_1 = "AT&F&C1E0&D2\r\0";
static char *MInit_2 = "ATL2M1S64=13\r\0";
static char *MInit_3 = "AT+FCLASS=0\r\0";
static char *MInit_4 = "ATV1S2=128X1\r\0";
static char *MInit_5 = "AT\\V8\\N3\r\0";
static char *MInit_6 = "ATL0M0&G0%E1\r\0";
static char *MInit_7 = "AT%L1%M0%C3\r\0";

static char *MInit_speed28800 = "AT%G0%B28800\r\0";

static char *MInit_dialout = "ATs7=60 x1 d\r\0";
static char *MInit_dialin = "ATs7=60 x1 a\r\0";


static inline unsigned int serial_in(struct IsdnCardState *cs, int offset)
{
#ifdef SERIAL_DEBUG_REG
      u_int val = inb(cs->hw.elsa.base + 8 + offset);
      debugl1(cs,"in   %s %02x",ModemIn[offset], val);
      return(val);
#else
      return inb(cs->hw.elsa.base + 8 + offset);
#endif
}

static inline unsigned int serial_inp(struct IsdnCardState *cs, int offset)
{
#ifdef SERIAL_DEBUG_REG
#ifdef ELSA_SERIAL_NOPAUSE_IO
      u_int val = inb(cs->hw.elsa.base + 8 + offset);
      debugl1(cs,"inp  %s %02x",ModemIn[offset], val);
#else
      u_int val = inb_p(cs->hw.elsa.base + 8 + offset);
      debugl1(cs,"inP  %s %02x",ModemIn[offset], val);
#endif
      return(val);
#else
#ifdef ELSA_SERIAL_NOPAUSE_IO
      return inb(cs->hw.elsa.base + 8 + offset);
#else
      return inb_p(cs->hw.elsa.base + 8 + offset);
#endif
#endif
}

static inline void serial_out(struct IsdnCardState *cs, int offset, int value)
{
#ifdef SERIAL_DEBUG_REG
      debugl1(cs,"out  %s %02x",ModemOut[offset], value);
#endif
      outb(value, cs->hw.elsa.base + 8 + offset);
}

static inline void serial_outp(struct IsdnCardState *cs, int offset,
                         int value)
{
#ifdef SERIAL_DEBUG_REG
#ifdef ELSA_SERIAL_NOPAUSE_IO
      debugl1(cs,"outp %s %02x",ModemOut[offset], value);
#else
      debugl1(cs,"outP %s %02x",ModemOut[offset], value);
#endif
#endif
#ifdef ELSA_SERIAL_NOPAUSE_IO
      outb(value, cs->hw.elsa.base + 8 + offset);
#else
      outb_p(value, cs->hw.elsa.base + 8 + offset);
#endif
}

/*
 * This routine is called to set the UART divisor registers to match
 * the specified baud rate for a serial port.
 */
static void change_speed(struct IsdnCardState *cs, int baud)
{
      int   quot = 0, baud_base;
      unsigned cval, fcr = 0;
      int   bits;


      /* byte size and parity */
      cval = 0x03; bits = 10;
      /* Determine divisor based on baud rate */
      baud_base = BASE_BAUD;
      quot = baud_base / baud;
      /* If the quotient is ever zero, default to 9600 bps */
      if (!quot)
            quot = baud_base / 9600;

      /* Set up FIFO's */
      if ((baud_base / quot) < 2400)
            fcr = UART_FCR_ENABLE_FIFO | UART_FCR_TRIGGER_1;
      else
            fcr = UART_FCR_ENABLE_FIFO | UART_FCR_TRIGGER_8;
      serial_outp(cs, UART_FCR, fcr);
      /* CTS flow control flag and modem status interrupts */
      cs->hw.elsa.IER &= ~UART_IER_MSI;
      cs->hw.elsa.IER |= UART_IER_MSI;
      serial_outp(cs, UART_IER, cs->hw.elsa.IER);

      debugl1(cs,"modem quot=0x%x", quot);
      serial_outp(cs, UART_LCR, cval | UART_LCR_DLAB);/* set DLAB */
      serial_outp(cs, UART_DLL, quot & 0xff);         /* LS of divisor */
      serial_outp(cs, UART_DLM, quot >> 8);           /* MS of divisor */
      serial_outp(cs, UART_LCR, cval);          /* reset DLAB */
      serial_inp(cs, UART_RX);
}

static int mstartup(struct IsdnCardState *cs)
{
      int   retval=0;

      /*
       * Clear the FIFO buffers and disable them
       * (they will be reenabled in change_speed())
       */
      serial_outp(cs, UART_FCR, (UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT));

      /*
       * At this point there's no way the LSR could still be 0xFF;
       * if it is, then bail out, because there's likely no UART
       * here.
       */
      if (serial_inp(cs, UART_LSR) == 0xff) {
            retval = -ENODEV;
            goto errout;
      }
      
      /*
       * Clear the interrupt registers.
       */
      (void) serial_inp(cs, UART_RX);
      (void) serial_inp(cs, UART_IIR);
      (void) serial_inp(cs, UART_MSR);

      /*
       * Now, initialize the UART 
       */
      serial_outp(cs, UART_LCR, UART_LCR_WLEN8);      /* reset DLAB */

      cs->hw.elsa.MCR = 0;
      cs->hw.elsa.MCR = UART_MCR_DTR | UART_MCR_RTS | UART_MCR_OUT2;
      serial_outp(cs, UART_MCR, cs->hw.elsa.MCR);
      
      /*
       * Finally, enable interrupts
       */
      cs->hw.elsa.IER = UART_IER_MSI | UART_IER_RLSI | UART_IER_RDI;
      serial_outp(cs, UART_IER, cs->hw.elsa.IER);     /* enable interrupts */
      
      /*
       * And clear the interrupt registers again for luck.
       */
      (void)serial_inp(cs, UART_LSR);
      (void)serial_inp(cs, UART_RX);
      (void)serial_inp(cs, UART_IIR);
      (void)serial_inp(cs, UART_MSR);

      cs->hw.elsa.transcnt = cs->hw.elsa.transp = 0;
      cs->hw.elsa.rcvcnt = cs->hw.elsa.rcvp =0;

      /*
       * and set the speed of the serial port
       */
      change_speed(cs, BASE_BAUD);
      cs->hw.elsa.MFlag = 1;
errout:
      return retval;
}

/*
 * This routine will shutdown a serial port; interrupts are disabled, and
 * DTR is dropped if the hangup on close termio flag is on.
 */
static void mshutdown(struct IsdnCardState *cs)
{

#ifdef SERIAL_DEBUG_OPEN
      printk(KERN_DEBUG"Shutting down serial ....");
#endif
      
      /*
       * clear delta_msr_wait queue to avoid mem leaks: we may free the irq
       * here so the queue might never be waken up
       */

      cs->hw.elsa.IER = 0;
      serial_outp(cs, UART_IER, 0x00);    /* disable all intrs */
      cs->hw.elsa.MCR &= ~UART_MCR_OUT2;
      
      /* disable break condition */
      serial_outp(cs, UART_LCR, serial_inp(cs, UART_LCR) & ~UART_LCR_SBC);
      
      cs->hw.elsa.MCR &= ~(UART_MCR_DTR|UART_MCR_RTS);
      serial_outp(cs, UART_MCR, cs->hw.elsa.MCR);

      /* disable FIFO's */    
      serial_outp(cs, UART_FCR, (UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT));
      serial_inp(cs, UART_RX);    /* read data port to reset things */
      
#ifdef SERIAL_DEBUG_OPEN
      printk(" done\n");
#endif
}

static inline int
write_modem(struct BCState *bcs) {
      int ret=0;
      struct IsdnCardState *cs = bcs->cs;
      int count, len, fp;
      
      if (!bcs->tx_skb)
            return 0;
      if (bcs->tx_skb->len <= 0)
            return 0;
      len = bcs->tx_skb->len;
      if (len > MAX_MODEM_BUF - cs->hw.elsa.transcnt)
            len = MAX_MODEM_BUF - cs->hw.elsa.transcnt;
      fp = cs->hw.elsa.transcnt + cs->hw.elsa.transp;
      fp &= (MAX_MODEM_BUF -1);
      count = len;
      if (count > MAX_MODEM_BUF - fp) {
            count = MAX_MODEM_BUF - fp;
            skb_copy_from_linear_data(bcs->tx_skb,
                                cs->hw.elsa.transbuf + fp, count);
            skb_pull(bcs->tx_skb, count);
            cs->hw.elsa.transcnt += count;
            ret = count;
            count = len - count;
            fp = 0;
      }
      skb_copy_from_linear_data(bcs->tx_skb,
                          cs->hw.elsa.transbuf + fp, count);
      skb_pull(bcs->tx_skb, count);
      cs->hw.elsa.transcnt += count;
      ret += count;
      
      if (cs->hw.elsa.transcnt && 
          !(cs->hw.elsa.IER & UART_IER_THRI)) {
                  cs->hw.elsa.IER |= UART_IER_THRI;
            serial_outp(cs, UART_IER, cs->hw.elsa.IER);
      }
      return(ret);
}

static inline void
modem_fill(struct BCState *bcs) {
            
      if (bcs->tx_skb) {
            if (bcs->tx_skb->len) {
                  write_modem(bcs);
                  return;
            } else {
                  if (test_bit(FLG_LLI_L1WAKEUP,&bcs->st->lli.flag) &&
                        (PACKET_NOACK != bcs->tx_skb->pkt_type)) {
                        u_long      flags;
                        spin_lock_irqsave(&bcs->aclock, flags);
                        bcs->ackcnt += bcs->hw.hscx.count;
                        spin_unlock_irqrestore(&bcs->aclock, flags);
                        schedule_event(bcs, B_ACKPENDING);
                  }
                  dev_kfree_skb_any(bcs->tx_skb);
                  bcs->tx_skb = NULL;
            }
      }
      if ((bcs->tx_skb = skb_dequeue(&bcs->squeue))) {
            bcs->hw.hscx.count = 0;
            test_and_set_bit(BC_FLG_BUSY, &bcs->Flag);
            write_modem(bcs);
      } else {
            test_and_clear_bit(BC_FLG_BUSY, &bcs->Flag);
            schedule_event(bcs, B_XMTBUFREADY);
      }
}

static inline void receive_chars(struct IsdnCardState *cs,
                         int *status)
{
      unsigned char ch;
      struct sk_buff *skb;

      do {
            ch = serial_in(cs, UART_RX);
            if (cs->hw.elsa.rcvcnt >= MAX_MODEM_BUF)
                  break;
            cs->hw.elsa.rcvbuf[cs->hw.elsa.rcvcnt++] = ch;
#ifdef SERIAL_DEBUG_INTR
            printk("DR%02x:%02x...", ch, *status);
#endif
            if (*status & (UART_LSR_BI | UART_LSR_PE |
                         UART_LSR_FE | UART_LSR_OE)) {
                              
#ifdef SERIAL_DEBUG_INTR
                  printk("handling exept....");
#endif
            }
            *status = serial_inp(cs, UART_LSR);
      } while (*status & UART_LSR_DR);
      if (cs->hw.elsa.MFlag == 2) {
            if (!(skb = dev_alloc_skb(cs->hw.elsa.rcvcnt)))
                  printk(KERN_WARNING "ElsaSER: receive out of memory\n");
            else {
                  memcpy(skb_put(skb, cs->hw.elsa.rcvcnt), cs->hw.elsa.rcvbuf, 
                        cs->hw.elsa.rcvcnt);
                  skb_queue_tail(& cs->hw.elsa.bcs->rqueue, skb);
            }
            schedule_event(cs->hw.elsa.bcs, B_RCVBUFREADY);
      } else {
            char tmp[128];
            char *t = tmp;

            t += sprintf(t, "modem read cnt %d", cs->hw.elsa.rcvcnt);
            QuickHex(t, cs->hw.elsa.rcvbuf, cs->hw.elsa.rcvcnt);
            debugl1(cs, tmp);
      }
      cs->hw.elsa.rcvcnt = 0;
}

static inline void transmit_chars(struct IsdnCardState *cs, int *intr_done)
{
      int count;
      
      debugl1(cs, "transmit_chars: p(%x) cnt(%x)", cs->hw.elsa.transp, 
            cs->hw.elsa.transcnt);
      
      if (cs->hw.elsa.transcnt <= 0) {
            cs->hw.elsa.IER &= ~UART_IER_THRI;
            serial_out(cs, UART_IER, cs->hw.elsa.IER);
            return;
      }
      count = 16;
      do {
            serial_outp(cs, UART_TX, cs->hw.elsa.transbuf[cs->hw.elsa.transp++]);
            if (cs->hw.elsa.transp >= MAX_MODEM_BUF)
                  cs->hw.elsa.transp=0;
            if (--cs->hw.elsa.transcnt <= 0)
                  break;
      } while (--count > 0);
      if ((cs->hw.elsa.transcnt < WAKEUP_CHARS) && (cs->hw.elsa.MFlag==2))
            modem_fill(cs->hw.elsa.bcs);

#ifdef SERIAL_DEBUG_INTR
      printk("THRE...");
#endif
      if (intr_done)
            *intr_done = 0;
      if (cs->hw.elsa.transcnt <= 0) {
            cs->hw.elsa.IER &= ~UART_IER_THRI;
            serial_outp(cs, UART_IER, cs->hw.elsa.IER);
      }
}


static void rs_interrupt_elsa(int irq, struct IsdnCardState *cs)
{
      int status, iir, msr;
      int pass_counter = 0;
      
#ifdef SERIAL_DEBUG_INTR
      printk("rs_interrupt_single(%d)...", irq);
#endif

      do {
            status = serial_inp(cs, UART_LSR);
            debugl1(cs,"rs LSR %02x", status);
#ifdef SERIAL_DEBUG_INTR
            printk("status = %x...", status);
#endif
            if (status & UART_LSR_DR)
                  receive_chars(cs, &status);
            if (status & UART_LSR_THRE)
                  transmit_chars(cs, NULL);
            if (pass_counter++ > RS_ISR_PASS_LIMIT) {
                  printk("rs_single loop break.\n");
                  break;
            }
            iir = serial_inp(cs, UART_IIR);
            debugl1(cs,"rs IIR %02x", iir);
            if ((iir & 0xf) == 0) {
                  msr = serial_inp(cs, UART_MSR);
                  debugl1(cs,"rs MSR %02x", msr);
            }
      } while (!(iir & UART_IIR_NO_INT));
#ifdef SERIAL_DEBUG_INTR
      printk("end.\n");
#endif
}

extern int open_hscxstate(struct IsdnCardState *cs, struct BCState *bcs);
extern void modehscx(struct BCState *bcs, int mode, int bc);
extern void hscx_l2l1(struct PStack *st, int pr, void *arg);

static void
close_elsastate(struct BCState *bcs)
{
      modehscx(bcs, 0, bcs->channel);
      if (test_and_clear_bit(BC_FLG_INIT, &bcs->Flag)) {
            if (bcs->hw.hscx.rcvbuf) {
                  if (bcs->mode != L1_MODE_MODEM)
                        kfree(bcs->hw.hscx.rcvbuf);
                  bcs->hw.hscx.rcvbuf = NULL;
            }
            skb_queue_purge(&bcs->rqueue);
            skb_queue_purge(&bcs->squeue);
            if (bcs->tx_skb) {
                  dev_kfree_skb_any(bcs->tx_skb);
                  bcs->tx_skb = NULL;
                  test_and_clear_bit(BC_FLG_BUSY, &bcs->Flag);
            }
      }
}

static void
modem_write_cmd(struct IsdnCardState *cs, u_char *buf, int len) {
      int count, fp;
      u_char *msg = buf;
      
      if (!len)
            return;
      if (len > (MAX_MODEM_BUF - cs->hw.elsa.transcnt)) {
            return;
      }
      fp = cs->hw.elsa.transcnt + cs->hw.elsa.transp;
      fp &= (MAX_MODEM_BUF -1);
      count = len;
      if (count > MAX_MODEM_BUF - fp) {
            count = MAX_MODEM_BUF - fp;
            memcpy(cs->hw.elsa.transbuf + fp, msg, count);
            cs->hw.elsa.transcnt += count;
            msg += count;
            count = len - count;
            fp = 0;
      }
      memcpy(cs->hw.elsa.transbuf + fp, msg, count);
      cs->hw.elsa.transcnt += count;
      if (cs->hw.elsa.transcnt && 
          !(cs->hw.elsa.IER & UART_IER_THRI)) {
            cs->hw.elsa.IER |= UART_IER_THRI;
            serial_outp(cs, UART_IER, cs->hw.elsa.IER);
      }
}

static void
modem_set_init(struct IsdnCardState *cs) {
      int timeout;

#define RCV_DELAY 20000 
      modem_write_cmd(cs, MInit_1, strlen(MInit_1));
      timeout = 1000;
      while(timeout-- && cs->hw.elsa.transcnt)
            udelay(1000);
      debugl1(cs, "msi tout=%d", timeout);
      udelay(RCV_DELAY);
      modem_write_cmd(cs, MInit_2, strlen(MInit_2));
      timeout = 1000;
      while(timeout-- && cs->hw.elsa.transcnt)
            udelay(1000);
      debugl1(cs, "msi tout=%d", timeout);
      udelay(RCV_DELAY);
      modem_write_cmd(cs, MInit_3, strlen(MInit_3));
      timeout = 1000;
      while(timeout-- && cs->hw.elsa.transcnt)
            udelay(1000);
      debugl1(cs, "msi tout=%d", timeout);
      udelay(RCV_DELAY);
      modem_write_cmd(cs, MInit_4, strlen(MInit_4));
      timeout = 1000;
      while(timeout-- && cs->hw.elsa.transcnt)
            udelay(1000);
      debugl1(cs, "msi tout=%d", timeout);
      udelay(RCV_DELAY );
      modem_write_cmd(cs, MInit_5, strlen(MInit_5));
      timeout = 1000;
      while(timeout-- && cs->hw.elsa.transcnt)
            udelay(1000);
      debugl1(cs, "msi tout=%d", timeout);
      udelay(RCV_DELAY);
      modem_write_cmd(cs, MInit_6, strlen(MInit_6));
      timeout = 1000;
      while(timeout-- && cs->hw.elsa.transcnt)
            udelay(1000);
      debugl1(cs, "msi tout=%d", timeout);
      udelay(RCV_DELAY);
      modem_write_cmd(cs, MInit_7, strlen(MInit_7));
      timeout = 1000;
      while(timeout-- && cs->hw.elsa.transcnt)
            udelay(1000);
      debugl1(cs, "msi tout=%d", timeout);
      udelay(RCV_DELAY);
}

static void
modem_set_dial(struct IsdnCardState *cs, int outgoing) {
      int timeout;
#define RCV_DELAY 20000 

      modem_write_cmd(cs, MInit_speed28800, strlen(MInit_speed28800));
      timeout = 1000;
      while(timeout-- && cs->hw.elsa.transcnt)
            udelay(1000);
      debugl1(cs, "msi tout=%d", timeout);
      udelay(RCV_DELAY);
      if (outgoing)
            modem_write_cmd(cs, MInit_dialout, strlen(MInit_dialout));
      else
            modem_write_cmd(cs, MInit_dialin, strlen(MInit_dialin));
      timeout = 1000;
      while(timeout-- && cs->hw.elsa.transcnt)
            udelay(1000);
      debugl1(cs, "msi tout=%d", timeout);
      udelay(RCV_DELAY);
}

static void
modem_l2l1(struct PStack *st, int pr, void *arg)
{
      struct BCState *bcs = st->l1.bcs;
      struct sk_buff *skb = arg;
      u_long flags;

      if (pr == (PH_DATA | REQUEST)) {
            spin_lock_irqsave(&bcs->cs->lock, flags);
            if (bcs->tx_skb) {
                  skb_queue_tail(&bcs->squeue, skb);
            } else {
                  bcs->tx_skb = skb;
                  test_and_set_bit(BC_FLG_BUSY, &bcs->Flag);
                  bcs->hw.hscx.count = 0;
                  write_modem(bcs);
            }
            spin_unlock_irqrestore(&bcs->cs->lock, flags);
      } else if (pr == (PH_ACTIVATE | REQUEST)) {
            test_and_set_bit(BC_FLG_ACTIV, &bcs->Flag);
            st->l1.l1l2(st, PH_ACTIVATE | CONFIRM, NULL);
            set_arcofi(bcs->cs, st->l1.bc);
            mstartup(bcs->cs);
            modem_set_dial(bcs->cs, test_bit(FLG_ORIG, &st->l2.flag));
            bcs->cs->hw.elsa.MFlag=2;
      } else if (pr == (PH_DEACTIVATE | REQUEST)) {
            test_and_clear_bit(BC_FLG_ACTIV, &bcs->Flag);
            bcs->cs->dc.isac.arcofi_bc = st->l1.bc;
            arcofi_fsm(bcs->cs, ARCOFI_START, &ARCOFI_XOP_0);
            interruptible_sleep_on(&bcs->cs->dc.isac.arcofi_wait);
            bcs->cs->hw.elsa.MFlag=1;
      } else {
            printk(KERN_WARNING"ElsaSer: unknown pr %x\n", pr);
      }
}

static int
setstack_elsa(struct PStack *st, struct BCState *bcs)
{

      bcs->channel = st->l1.bc;
      switch (st->l1.mode) {
            case L1_MODE_HDLC:
            case L1_MODE_TRANS:
                  if (open_hscxstate(st->l1.hardware, bcs))
                        return (-1);
                  st->l2.l2l1 = hscx_l2l1;
                  break;
            case L1_MODE_MODEM:
                  bcs->mode = L1_MODE_MODEM;
                  if (!test_and_set_bit(BC_FLG_INIT, &bcs->Flag)) {
                        bcs->hw.hscx.rcvbuf = bcs->cs->hw.elsa.rcvbuf;
                        skb_queue_head_init(&bcs->rqueue);
                        skb_queue_head_init(&bcs->squeue);
                  }
                  bcs->tx_skb = NULL;
                  test_and_clear_bit(BC_FLG_BUSY, &bcs->Flag);
                  bcs->event = 0;
                  bcs->hw.hscx.rcvidx = 0;
                  bcs->tx_cnt = 0;
                  bcs->cs->hw.elsa.bcs = bcs;
                  st->l2.l2l1 = modem_l2l1;
                  break;
      }
      st->l1.bcs = bcs;
      setstack_manager(st);
      bcs->st = st;
      setstack_l1_B(st);
      return (0);
}

static void
init_modem(struct IsdnCardState *cs) {

      cs->bcs[0].BC_SetStack = setstack_elsa;
      cs->bcs[1].BC_SetStack = setstack_elsa;
      cs->bcs[0].BC_Close = close_elsastate;
      cs->bcs[1].BC_Close = close_elsastate;
      if (!(cs->hw.elsa.rcvbuf = kmalloc(MAX_MODEM_BUF,
            GFP_ATOMIC))) {
            printk(KERN_WARNING
                  "Elsa: No modem mem hw.elsa.rcvbuf\n");
            return;
      }
      if (!(cs->hw.elsa.transbuf = kmalloc(MAX_MODEM_BUF,
            GFP_ATOMIC))) {
            printk(KERN_WARNING
                  "Elsa: No modem mem hw.elsa.transbuf\n");
            kfree(cs->hw.elsa.rcvbuf);
            cs->hw.elsa.rcvbuf = NULL;
            return;
      }
      if (mstartup(cs)) {
            printk(KERN_WARNING "Elsa: problem startup modem\n");
      }
      modem_set_init(cs);
}

static void
release_modem(struct IsdnCardState *cs) {

      cs->hw.elsa.MFlag = 0;
      if (cs->hw.elsa.transbuf) {
            if (cs->hw.elsa.rcvbuf) {
                  mshutdown(cs);
                  kfree(cs->hw.elsa.rcvbuf);
                  cs->hw.elsa.rcvbuf = NULL;
            }
            kfree(cs->hw.elsa.transbuf);
            cs->hw.elsa.transbuf = NULL;
      }
}

Generated by  Doxygen 1.6.0   Back to index