# elsa_ser.c

    #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 )

    #ifndef MIN
    #define MIN(a,b)	((a) < (b) ? (a) : (b))
    #endif

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

    #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 &C1 E0 &D2 L2 M1 S64=13\n\0";
    static char *MInit_2 = "AT+FCLASS=0 V1 S2=128 X1 \\V8\n\0";
    static char *MInit_3 = "AT %G0 %B2400 L0 M0 &G0 %E1 %L1 %M0 %C3 \\N3\n\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);
    	sprintf(deb,"in   %s %02x",ModemIn[offset], val);
    	debugl1(cs, deb);
    	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 CONFIG_SERIAL_NOPAUSE_IO
    	u_int val = inb(cs->hw.elsa.base + 8 + offset);
    	sprintf(deb,"inp  %s %02x",ModemIn[offset], val);
    #else
    	u_int val = inb_p(cs->hw.elsa.base + 8 + offset);
    	sprintf(deb,"inP  %s %02x",ModemIn[offset], val);
    #endif
    	debugl1(cs, deb);
    	return(val);
    #else
    #ifdef CONFIG_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
    	sprintf(deb,"out  %s %02x",ModemOut[offset], value);
    	debugl1(cs, deb);
    #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 CONFIG_SERIAL_NOPAUSE_IO
    	sprintf(deb,"outp %s %02x",ModemOut[offset], value);
    #else
    	sprintf(deb,"outP %s %02x",ModemOut[offset], value);
    #endif
    	debugl1(cs, deb);
    #endif
    #ifdef CONFIG_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;
    	char	tmp[32];
    	unsigned long	flags;

    	/* 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);

    	sprintf(tmp,"modem quot=0x%x", quot);
    	debugl1(cs, tmp);
    	save_flags(flags); cli();
    	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 */
    	restore_flags(flags);
    }

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

    	save_flags(flags); cli();

    	/*
    	 * 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, 57600*2);
    	cs->hw.elsa.MFlag = 1;
    errout:
    	restore_flags(flags);
    	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)
    {
    	unsigned long	flags;

    #ifdef SERIAL_DEBUG_OPEN
    	printk("Shutting down serial ....");
    #endif

    	save_flags(flags); cli(); /* Disable interrupts */

    	/*
    	 * 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 */

    	restore_flags(flags);
    }

    inline int
    write_modem(struct BCState *bcs) {
    	int ret=0;
    	struct IsdnCardState *cs = bcs->cs;
    	int count, len, fp, buflen;
    	long flags;

    	if (!bcs->hw.hscx.tx_skb)
    		return 0;
    	if (bcs->hw.hscx.tx_skb->len <= 0)
    		return 0;
    	save_flags(flags);
    	cli();
    	buflen = MAX_MODEM_BUF - cs->hw.elsa.transcnt;
    	len = MIN(buflen, bcs->hw.hscx.tx_skb->len);
    	fp = cs->hw.elsa.transcnt + cs->hw.elsa.transp;
    	fp &= (MAX_MODEM_BUF -1);
    	count = MIN(len, MAX_MODEM_BUF - fp);
    	if (count < len) {
    		memcpy(cs->hw.elsa.transbuf + fp, skb_pull(bcs->hw.hscx.tx_skb, count), count);
    		cs->hw.elsa.transcnt += count;
    		ret = count;
    		count = len - count;
    		fp = 0;
    	}
    	memcpy(cs->hw.elsa.transbuf + fp, skb_pull(bcs->hw.hscx.tx_skb, count), 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);
    	}
    	restore_flags(flags);
    	return(ret);
    }

    inline void
    modem_fill(struct BCState *bcs) {

    	if (bcs->hw.hscx.tx_skb) {
    		if (bcs->hw.hscx.tx_skb->len) {
    			write_modem(bcs);
    			return;
    		} else {
    			if (bcs->st->lli.l1writewakeup &&
    				(PACKET_NOACK != bcs->hw.hscx.tx_skb->pkt_type))
    					bcs->st->lli.l1writewakeup(bcs->st,
    						bcs->hw.hscx.count);
    			dev_kfree_skb(bcs->hw.hscx.tx_skb);
    			bcs->hw.hscx.tx_skb = NULL;
    		}
    	}
    	if ((bcs->hw.hscx.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);
    		hscx_sched_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);
    		}
    		hscx_sched_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;
    	char tmp[64];

    	sprintf(tmp, "transmit_chars: p(%x) cnt(%x)", cs->hw.elsa.transp,
    		cs->hw.elsa.transcnt);
    	debugl1(cs, tmp);
    	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);
    	}
    }

    #if 0
    static inline void check_modem_status(struct IsdnCardState *cs)
    {
    	int	status;
    	struct async_struct *info = cs->hw.elsa.info;
    	struct	async_icount *icount;

    	status = serial_inp(info, UART_MSR);

    	if (status & UART_MSR_ANY_DELTA) {
    		icount = &info->state->icount;
    		/* update input line counters */
    		if (status & UART_MSR_TERI)
    			icount->rng++;
    		if (status & UART_MSR_DDSR)
    			icount->dsr++;
    		if (status & UART_MSR_DDCD) {
    			icount->dcd++;
    		}
    		if (status & UART_MSR_DCTS)
    			icount->cts++;
    //		wake_up_interruptible(&info->delta_msr_wait);
    	}

    	if ((info->flags & ASYNC_CHECK_CD) && (status & UART_MSR_DDCD)) {
    #if (defined(SERIAL_DEBUG_OPEN) || defined(SERIAL_DEBUG_INTR))
    		printk("ttys%d CD now %s...", info->line,
    		       (status & UART_MSR_DCD) ? "on" : "off");
    #endif
    		if (status & UART_MSR_DCD)
    //			wake_up_interruptible(&info->open_wait);
    ;
    		else if (!((info->flags & ASYNC_CALLOUT_ACTIVE) &&
    			   (info->flags & ASYNC_CALLOUT_NOHUP))) {
    #ifdef SERIAL_DEBUG_OPEN
    			printk("doing serial hangup...");
    #endif
    			if (info->tty)
    				tty_hangup(info->tty);
    		}
    	}
    #if 0
    	if (info->flags & ASYNC_CTS_FLOW) {
    		if (info->tty->hw_stopped) {
    			if (status & UART_MSR_CTS) {
    #if (defined(SERIAL_DEBUG_INTR) || defined(SERIAL_DEBUG_FLOW))
    				printk("CTS tx start...");
    #endif
    				info->tty->hw_stopped = 0;
    				info->IER |= UART_IER_THRI;
    				serial_outp(info, UART_IER, info->IER);
    //				rs_sched_event(info, RS_EVENT_WRITE_WAKEUP);
    				return;
    			}
    		} else {
    			if (!(status & UART_MSR_CTS)) {
    #if (defined(SERIAL_DEBUG_INTR) || defined(SERIAL_DEBUG_FLOW))
    				printk("CTS tx stop...");
    #endif
    				info->tty->hw_stopped = 1;
    				info->IER &= ~UART_IER_THRI;
    				serial_outp(info, UART_IER, info->IER);
    			}
    		}
    	}
    #endif 0
    }
    #endif

    static void rs_interrupt_elsa(int irq, struct IsdnCardState *cs)
    {
    	int status, iir, msr;
    	int pass_counter = 0;
    	u_char tmp[64];

    #ifdef SERIAL_DEBUG_INTR
    	printk("rs_interrupt_single(%d)...", irq);
    #endif

    	do {
    		status = serial_inp(cs, UART_LSR);
    		sprintf(tmp,"rs LSR %02x", status);
    		debugl1(cs, tmp);
    #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, 0);
    		if (pass_counter++ > RS_ISR_PASS_LIMIT) {
    			printk("rs_single loop break.\n");
    			break;
    		}
    		iir = serial_inp(cs, UART_IIR);
    		sprintf(tmp,"rs IIR %02x", iir);
    		debugl1(cs, tmp);
    		if ((iir & 0xf) == 0) {
    			msr = serial_inp(cs, UART_MSR);
    			sprintf(tmp,"rs MSR %02x", msr);
    			debugl1(cs, tmp);
    		}
    	} while (!(iir & UART_IIR_NO_INT));
    #ifdef SERIAL_DEBUG_INTR
    	printk("end.\n");
    #endif
    }

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

    void
    close_elsastate(struct BCState *bcs)
    {
    	struct sk_buff *skb;

    //	modehscx(bcs, 0, 0);
    	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;
    		}
    		while ((skb = skb_dequeue(&bcs->rqueue))) {
    			dev_kfree_skb(skb);
    		}
    		while ((skb = skb_dequeue(&bcs->squeue))) {
    			dev_kfree_skb(skb);
    		}
    		if (bcs->hw.hscx.tx_skb) {
    			dev_kfree_skb(bcs->hw.hscx.tx_skb);
    			bcs->hw.hscx.tx_skb = NULL;
    			test_and_clear_bit(BC_FLG_BUSY, &bcs->Flag);
    		}
    	}
    }

    void
    modem_l2l1(struct PStack *st, int pr, void *arg)
    {
    	struct sk_buff *skb = arg;
    	long flags;

    	if (pr == (PH_DATA | REQUEST)) {
    		save_flags(flags);
    		cli();
    		if (st->l1.bcs->hw.hscx.tx_skb) {
    			skb_queue_tail(&st->l1.bcs->squeue, skb);
    			restore_flags(flags);
    		} else {
    			st->l1.bcs->hw.hscx.tx_skb = skb;
    			test_and_set_bit(BC_FLG_BUSY, &st->l1.bcs->Flag);
    			st->l1.bcs->hw.hscx.count = 0;
    			restore_flags(flags);
    			write_modem(st->l1.bcs);
    		}
    	} else if (pr == (PH_ACTIVATE | REQUEST)) {
    		test_and_set_bit(BC_FLG_ACTIV, &st->l1.bcs->Flag);
    		st->l1.l1l2(st, PH_ACTIVATE | CONFIRM, NULL);
    		set_arcofi(st->l1.bcs->cs, st->l1.bc);
    		st->l1.bcs->cs->hw.elsa.MFlag=2;
    	} else if (pr == (PH_DEACTIVATE | REQUEST)) {
    		test_and_clear_bit(BC_FLG_ACTIV, &st->l1.bcs->Flag);
    		send_arcofi(st->l1.bcs->cs, ARCOFI_XOP_0, st->l1.bc, 0);
    		st->l1.bcs->cs->hw.elsa.MFlag=1;
    	} else {
    		printk(KERN_WARNING"ElsaSer: unknown pr %x\n", pr);
    	}
    }

    void
    modem_write_cmd(struct IsdnCardState *cs, u_char *buf, int len) {
    	int count, fp;
    	u_char *msg = buf;
    	long flags;

    	if (!len)
    		return;
    	save_flags(flags);
    	cli();
    	if (len > (MAX_MODEM_BUF - cs->hw.elsa.transcnt)) {
    		restore_flags(flags);
    		return;
    	}
    	fp = cs->hw.elsa.transcnt + cs->hw.elsa.transp;
    	fp &= (MAX_MODEM_BUF -1);
    	count = MIN(len, MAX_MODEM_BUF - fp);
    	if (count < len) {
    		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);
    	}
    	restore_flags(flags);
    }

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

    	save_flags(flags);
    	sti();
    	modem_write_cmd(cs, MInit_1, strlen(MInit_1));
    	timeout = 1000;
    	while(timeout-- && cs->hw.elsa.transcnt)
    		udelay(1000);
    	udelay(50000);
    	modem_write_cmd(cs, MInit_2, strlen(MInit_2));
    	timeout = 1000;
    	while(timeout-- && cs->hw.elsa.transcnt)
    		udelay(1000);
    	udelay(50000);
    	modem_write_cmd(cs, MInit_3, strlen(MInit_3));
    	timeout = 1000;
    	while(timeout-- && cs->hw.elsa.transcnt)
    		udelay(1000);
    	udelay(50000);
    	restore_flags(flags);
    }

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

    	switch (st->l1.mode) {
    		case L1_MODE_HDLC:
    		case L1_MODE_TRANS:
    			if (open_hscxstate(st->l1.hardware, bcs->channel))
    				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->hw.hscx.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);
    }

    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);
    }

    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;
    	}
    }