bcs->hw.isar.dpath, bcs->mode, mode, bc);	bcs->mode = mode;	setup_pump(bcs);	setup_iom2(bcs);	setup_sart(bcs);	if (bcs->mode == L1_MODE_NULL) {		/* Clear resources */		if (bcs->hw.isar.dpath == 1)			test_and_clear_bit(ISAR_DP1_USE, &bcs->hw.isar.reg->Flags);		else if (bcs->hw.isar.dpath == 2)			test_and_clear_bit(ISAR_DP2_USE, &bcs->hw.isar.reg->Flags);		bcs->hw.isar.dpath = 0;	}	return(0);}static voidisar_pump_cmd(struct BCState *bcs, u_char cmd, u_char para) {	struct IsdnCardState *cs = bcs->cs;	u_char dps = SET_DPS(bcs->hw.isar.dpath);	u_char ctrl = 0, nom = 0, p1 = 0;	switch(cmd) {		case ISDN_FAX_CLASS1_FTM:			test_and_clear_bit(BC_FLG_FRH_WAIT, &bcs->Flag);			if (bcs->hw.isar.state == STFAX_READY) {				p1 = para;				ctrl = PCTRL_CMD_FTM;				nom = 1;				bcs->hw.isar.state = STFAX_LINE;				bcs->hw.isar.cmd = ctrl;				bcs->hw.isar.mod = para;				bcs->hw.isar.newmod = 0;				bcs->hw.isar.newcmd = 0;				bcs->hw.isar.try_mod = 3; 			} else if ((bcs->hw.isar.state == STFAX_ACTIV) &&				(bcs->hw.isar.cmd == PCTRL_CMD_FTM) &&				(bcs->hw.isar.mod == para)) {				ll_deliver_faxstat(bcs, ISDN_FAX_CLASS1_CONNECT);			} else {				bcs->hw.isar.newmod = para;				bcs->hw.isar.newcmd = PCTRL_CMD_FTM;				nom = 0;				ctrl = PCTRL_CMD_ESC;				bcs->hw.isar.state = STFAX_ESCAPE; 			}			break;		case ISDN_FAX_CLASS1_FTH:			test_and_clear_bit(BC_FLG_FRH_WAIT, &bcs->Flag);			if (bcs->hw.isar.state == STFAX_READY) {				p1 = para;				ctrl = PCTRL_CMD_FTH;				nom = 1;				bcs->hw.isar.state = STFAX_LINE;				bcs->hw.isar.cmd = ctrl;				bcs->hw.isar.mod = para;				bcs->hw.isar.newmod = 0;				bcs->hw.isar.newcmd = 0;				bcs->hw.isar.try_mod = 3; 			} else if ((bcs->hw.isar.state == STFAX_ACTIV) &&				(bcs->hw.isar.cmd == PCTRL_CMD_FTH) &&				(bcs->hw.isar.mod == para)) {				ll_deliver_faxstat(bcs, ISDN_FAX_CLASS1_CONNECT);			} else {				bcs->hw.isar.newmod = para;				bcs->hw.isar.newcmd = PCTRL_CMD_FTH;				nom = 0;				ctrl = PCTRL_CMD_ESC;				bcs->hw.isar.state = STFAX_ESCAPE; 			}			break;		case ISDN_FAX_CLASS1_FRM:			test_and_clear_bit(BC_FLG_FRH_WAIT, &bcs->Flag);			if (bcs->hw.isar.state == STFAX_READY) {				p1 = para;				ctrl = PCTRL_CMD_FRM;				nom = 1;				bcs->hw.isar.state = STFAX_LINE;				bcs->hw.isar.cmd = ctrl;				bcs->hw.isar.mod = para;				bcs->hw.isar.newmod = 0;				bcs->hw.isar.newcmd = 0;				bcs->hw.isar.try_mod = 3; 			} else if ((bcs->hw.isar.state == STFAX_ACTIV) &&				(bcs->hw.isar.cmd == PCTRL_CMD_FRM) &&				(bcs->hw.isar.mod == para)) {				ll_deliver_faxstat(bcs, ISDN_FAX_CLASS1_CONNECT);			} else {				bcs->hw.isar.newmod = para;				bcs->hw.isar.newcmd = PCTRL_CMD_FRM;				nom = 0;				ctrl = PCTRL_CMD_ESC;				bcs->hw.isar.state = STFAX_ESCAPE; 			}			break;		case ISDN_FAX_CLASS1_FRH:			test_and_set_bit(BC_FLG_FRH_WAIT, &bcs->Flag);			if (bcs->hw.isar.state == STFAX_READY) {				p1 = para;				ctrl = PCTRL_CMD_FRH;				nom = 1;				bcs->hw.isar.state = STFAX_LINE;				bcs->hw.isar.cmd = ctrl;				bcs->hw.isar.mod = para;				bcs->hw.isar.newmod = 0;				bcs->hw.isar.newcmd = 0;				bcs->hw.isar.try_mod = 3; 			} else if ((bcs->hw.isar.state == STFAX_ACTIV) &&				(bcs->hw.isar.cmd == PCTRL_CMD_FRH) &&				(bcs->hw.isar.mod == para)) {				ll_deliver_faxstat(bcs, ISDN_FAX_CLASS1_CONNECT);			} else {				bcs->hw.isar.newmod = para;				bcs->hw.isar.newcmd = PCTRL_CMD_FRH;				nom = 0;				ctrl = PCTRL_CMD_ESC;				bcs->hw.isar.state = STFAX_ESCAPE; 			}			break;		case ISDN_FAXPUMP_HALT:			bcs->hw.isar.state = STFAX_NULL;			nom = 0;			ctrl = PCTRL_CMD_HALT;			break;	}	if (ctrl)		sendmsg(cs, dps | ISAR_HIS_PUMPCTRL, ctrl, nom, &p1);}voidisar_setup(struct IsdnCardState *cs){	u_char msg;	int i;		/* Dpath 1, 2 */	msg = 61;	for (i=0; i<2; i++) {		/* Buffer Config */		sendmsg(cs, (i ? ISAR_HIS_DPS2 : ISAR_HIS_DPS1) |			ISAR_HIS_P12CFG, 4, 1, &msg);		cs->bcs[i].hw.isar.mml = msg;		cs->bcs[i].mode = 0;		cs->bcs[i].hw.isar.dpath = i + 1;		modeisar(&cs->bcs[i], 0, 0);		INIT_WORK(&cs->bcs[i].tqueue, (void *)(void *) isar_bh, &cs->bcs[i]);	}}voidisar_l2l1(struct PStack *st, int pr, void *arg){	struct BCState *bcs = st->l1.bcs;	struct sk_buff *skb = arg;	int ret;	u_long flags;	switch (pr) {		case (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);				if (bcs->cs->debug & L1_DEB_HSCX)					debugl1(bcs->cs, "DRQ set BC_FLG_BUSY");				bcs->hw.isar.txcnt = 0;				bcs->cs->BC_Send_Data(bcs);			}			spin_unlock_irqrestore(&bcs->cs->lock, flags);			break;		case (PH_PULL | INDICATION):			spin_lock_irqsave(&bcs->cs->lock, flags);			if (bcs->tx_skb) {				printk(KERN_WARNING "isar_l2l1: this shouldn't happen\n");			} else {				test_and_set_bit(BC_FLG_BUSY, &bcs->Flag);				if (bcs->cs->debug & L1_DEB_HSCX)					debugl1(bcs->cs, "PUI set BC_FLG_BUSY");				bcs->tx_skb = skb;				bcs->hw.isar.txcnt = 0;				bcs->cs->BC_Send_Data(bcs);			}			spin_unlock_irqrestore(&bcs->cs->lock, flags);			break;		case (PH_PULL | REQUEST):			if (!bcs->tx_skb) {				test_and_clear_bit(FLG_L1_PULL_REQ, &st->l1.Flags);				st->l1.l1l2(st, PH_PULL | CONFIRM, NULL);			} else				test_and_set_bit(FLG_L1_PULL_REQ, &st->l1.Flags);			break;		case (PH_ACTIVATE | REQUEST):			spin_lock_irqsave(&bcs->cs->lock, flags);			test_and_set_bit(BC_FLG_ACTIV, &bcs->Flag);			bcs->hw.isar.conmsg[0] = 0;			if (test_bit(FLG_ORIG, &st->l2.flag))				test_and_set_bit(BC_FLG_ORIG, &bcs->Flag);			else				test_and_clear_bit(BC_FLG_ORIG, &bcs->Flag);			switch(st->l1.mode) {				case L1_MODE_TRANS:				case L1_MODE_HDLC:					ret = modeisar(bcs, st->l1.mode, st->l1.bc);					spin_unlock_irqrestore(&bcs->cs->lock, flags);					if (ret)						l1_msg_b(st, PH_DEACTIVATE | REQUEST, arg);					else						l1_msg_b(st, PH_ACTIVATE | REQUEST, arg);					break;				case L1_MODE_V32:				case L1_MODE_FAX:					ret = modeisar(bcs, st->l1.mode, st->l1.bc);					spin_unlock_irqrestore(&bcs->cs->lock, flags);					if (ret)						l1_msg_b(st, PH_DEACTIVATE | REQUEST, arg);					break;				default:					spin_unlock_irqrestore(&bcs->cs->lock, flags);					break;			}			break;		case (PH_DEACTIVATE | REQUEST):			l1_msg_b(st, pr, arg);			break;		case (PH_DEACTIVATE | CONFIRM):			spin_lock_irqsave(&bcs->cs->lock, flags);			switch(st->l1.mode) {				case L1_MODE_TRANS:				case L1_MODE_HDLC:				case L1_MODE_V32:					break;				case L1_MODE_FAX:					isar_pump_cmd(bcs, ISDN_FAXPUMP_HALT, 0);					break;			}			test_and_clear_bit(BC_FLG_ACTIV, &bcs->Flag);			test_and_clear_bit(BC_FLG_BUSY, &bcs->Flag);			if (bcs->cs->debug & L1_DEB_HSCX)				debugl1(bcs->cs, "PDAC clear BC_FLG_BUSY");			modeisar(bcs, 0, st->l1.bc);			spin_unlock_irqrestore(&bcs->cs->lock, flags);			st->l1.l1l2(st, PH_DEACTIVATE | CONFIRM, NULL);			break;	}}voidclose_isarstate(struct BCState *bcs){	modeisar(bcs, 0, bcs->channel);	if (test_and_clear_bit(BC_FLG_INIT, &bcs->Flag)) {		if (bcs->hw.isar.rcvbuf) {			kfree(bcs->hw.isar.rcvbuf);			bcs->hw.isar.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);			if (bcs->cs->debug & L1_DEB_HSCX)				debugl1(bcs->cs, "closeisar clear BC_FLG_BUSY");		}	}	del_timer(&bcs->hw.isar.ftimer);}intopen_isarstate(struct IsdnCardState *cs, struct BCState *bcs){	if (!test_and_set_bit(BC_FLG_INIT, &bcs->Flag)) {		if (!(bcs->hw.isar.rcvbuf = kmalloc(HSCX_BUFMAX, GFP_ATOMIC))) {			printk(KERN_WARNING			       "HiSax: No memory for isar.rcvbuf\n");			return (1);		}		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);	if (cs->debug & L1_DEB_HSCX)		debugl1(cs, "openisar clear BC_FLG_BUSY");	bcs->event = 0;	bcs->hw.isar.rcvidx = 0;	bcs->tx_cnt = 0;	return (0);}intsetstack_isar(struct PStack *st, struct BCState *bcs){	bcs->channel = st->l1.bc;	if (open_isarstate(st->l1.hardware, bcs))		return (-1);	st->l1.bcs = bcs;	st->l2.l2l1 = isar_l2l1;	setstack_manager(st);	bcs->st = st;	setstack_l1_B(st);	return (0);}intisar_auxcmd(struct IsdnCardState *cs, isdn_ctrl *ic) {	u_long adr;	int features, i;	struct BCState *bcs;	if (cs->debug & L1_DEB_HSCX)		debugl1(cs, "isar_auxcmd cmd/ch %x/%d", ic->command, ic->arg);	switch (ic->command) {		case (ISDN_CMD_FAXCMD):			bcs = cs->channel[ic->arg].bcs;			if (cs->debug & L1_DEB_HSCX)				debugl1(cs, "isar_auxcmd cmd/subcmd %d/%d",					ic->parm.aux.cmd, ic->parm.aux.subcmd);			switch(ic->parm.aux.cmd) {				case ISDN_FAX_CLASS1_CTRL:					if (ic->parm.aux.subcmd == ETX)						test_and_set_bit(BC_FLG_DLEETX,							&bcs->Flag);					break;				case ISDN_FAX_CLASS1_FTS:					if (ic->parm.aux.subcmd == AT_QUERY) {						ic->command = ISDN_STAT_FAXIND;						ic->parm.aux.cmd = ISDN_FAX_CLASS1_OK;						cs->iif.statcallb(ic);						return(0);					} else if (ic->parm.aux.subcmd == AT_EQ_QUERY) {						strcpy(ic->parm.aux.para, "0-255");						ic->command = ISDN_STAT_FAXIND;						ic->parm.aux.cmd = ISDN_FAX_CLASS1_QUERY;						cs->iif.statcallb(ic);						return(0);					} else if (ic->parm.aux.subcmd == AT_EQ_VALUE) {						if (cs->debug & L1_DEB_HSCX)							debugl1(cs, "isar_auxcmd %s=%d",								FC1_CMD[ic->parm.aux.cmd], ic->parm.aux.para[0]);						if (bcs->hw.isar.state == STFAX_READY) {							if (! ic->parm.aux.para[0]) {								ic->command = ISDN_STAT_FAXIND;								ic->parm.aux.cmd = ISDN_FAX_CLASS1_OK;								cs->iif.statcallb(ic);								return(0);							}							if (! test_and_set_bit(BC_FLG_FTI_RUN, &bcs->Flag)) {								/* n*10 ms */								bcs->hw.isar.ftimer.expires =									jiffies + ((ic->parm.aux.para[0] * 10 * HZ)/1000);								test_and_set_bit(BC_FLG_FTI_FTS, &bcs->Flag);								add_timer(&bcs->hw.isar.ftimer);								return(0);							} else {								if (cs->debug)									debugl1(cs, "isar FTS=%d and FTI busy",										ic->parm.aux.para[0]);							}						} else {							if (cs->debug)								debugl1(cs, "isar FTS=%d and isar.state not ready(%x)",									ic->parm.aux.para[0],bcs->hw.isar.state);						}						ic->command = ISDN_STAT_FAXIND;						ic->parm.aux.cmd = ISDN_FAX_CLASS1_ERROR;						cs->iif.statcallb(ic);					}					break;				case ISDN_FAX_CLASS1_FRM:				case ISDN_FAX_CLASS1_FRH:				case ISDN_FAX_CLASS1_FTM:				case ISDN_FAX_CLASS1_FTH:					if (ic->parm.aux.subcmd == AT_QUERY) {						sprintf(ic->parm.aux.para,							"%d", bcs->hw.isar.mod);						ic->command = ISDN_STAT_FAXIND;						ic->parm.aux.cmd = ISDN_FAX_CLASS1_QUERY;						cs->iif.statcallb(ic);						return(0);					} else if (ic->parm.aux.subcmd == AT_EQ_QUERY) {						char *p = ic->parm.aux.para;						for(i=0;i<FAXMODCNT;i++)							if ((1<<i) & modmask)								p += sprintf(p, "%d,", faxmodulation[i]);						p--;						*p=0;						ic->command = ISDN_STAT_FAXIND;						ic->parm.aux.cmd = ISDN_FAX_CLASS1_QUERY;						cs->iif.statcallb(ic);						return(0);					} else if (ic->parm.aux.subcmd == AT_EQ_VALUE) {						if (cs->debug & L1_DEB_HSCX)							debugl1(cs, "isar_auxcmd %s=%d",								FC1_CMD[ic->parm.aux.cmd], ic->parm.aux.para[0]);						for(i=0;i<FAXMODCNT;i++)							if (faxmodulation[i]==ic->parm.aux.para[0])								break;						if ((i < FAXMODCNT) && ((1<<i) & modmask) && 							test_bit(BC_FLG_INIT, &bcs->Flag)) {							isar_pump_cmd(bcs,								ic->parm.aux.cmd,								ic->parm.aux.para[0]);							return(0);						}					}					/* wrong modulation or not activ */					/* fall through */				default:					ic->command = ISDN_STAT_FAXIND;					ic->parm.aux.cmd = ISDN_FAX_CLASS1_ERROR;					cs->iif.statcallb(ic);			}			break;		case (ISDN_CMD_IOCTL):			switch (ic->arg) {				case 9: /* load firmware */					features = ISDN_FEATURE_L2_MODEM |						ISDN_FEATURE_L2_FAX |						ISDN_FEATURE_L3_FCLASS1;					memcpy(&adr, ic->parm.num, sizeof(ulong));					if (isar_load_firmware(cs, (u_char __user *)adr))						return(1);					else 						ll_run(cs, features);					break;				case 20:					features = *(unsigned int *) ic->parm.num;					printk(KERN_DEBUG "HiSax: max modulation old(%04x) new(%04x)\n",						modmask, features);					modmask = features;					break;				case 21:					features = *(unsigned int *) ic->parm.num;					printk(KERN_DEBUG "HiSax: FRM extra delay old(%d) new(%d) ms\n",						frm_extra_delay, features);					if (features >= 0)						frm_extra_delay = features;					break;				case 22:					features = *(unsigned int *) ic->parm.num;					printk(KERN_DEBUG "HiSax: TOA old(%d) new(%d) db\n",						para_TOA, features);					if (features >= 0 && features < 32)						para_TOA = features;					break;				default:					printk(KERN_DEBUG "HiSax: invalid ioctl %d\n",					       (int) ic->arg);					return(-EINVAL);			}			break;		default:			return(-EINVAL);	}	return(0);}void __devinitinitisar(struct IsdnCardState *cs){	cs->bcs[0].BC_SetStack = setstack_isar;	cs->bcs[1].BC_SetStack = setstack_isar;	cs->bcs[0].BC_Close = close_isarstate;	cs->bcs[1].BC_Close = close_isarstate;	cs->bcs[0].hw.isar.ftimer.function = (void *) ftimer_handler;	cs->bcs[0].hw.isar.ftimer.data = (long) &cs->bcs[0];	init_timer(&cs->bcs[0].hw.isar.ftimer);	cs->bcs[1].hw.isar.ftimer.function = (void *) ftimer_handler;	cs->bcs[1].hw.isar.ftimer.data = (long) &cs->bcs[1];	init_timer(&cs->bcs[1].hw.isar.ftimer);}