}	udelay(1000);	sendmsg(cs, dps | ISAR_HIS_BSTREQ, 0, 0, NULL);	udelay(1000);}static voidsetup_iom2(struct BCState *bcs) {	struct IsdnCardState *cs = bcs->cs;	u_char dps = SET_DPS(bcs->hw.isar.dpath);	u_char cmsb = IOM_CTRL_ENA, msg[5] = {IOM_P1_TXD,0,0,0,0};		if (bcs->channel)		msg[1] = msg[3] = 1;	switch (bcs->mode) {		case L1_MODE_NULL:			cmsb = 0;			/* dummy slot */			msg[1] = msg[3] = bcs->hw.isar.dpath + 2;			break;		case L1_MODE_TRANS:		case L1_MODE_HDLC:			break;		case L1_MODE_V32:		case L1_MODE_FAX:			cmsb |= IOM_CTRL_ALAW | IOM_CTRL_RCV;			break;	}	sendmsg(cs, dps | ISAR_HIS_IOM2CFG, cmsb, 5, msg);	udelay(1000);	sendmsg(cs, dps | ISAR_HIS_IOM2REQ, 0, 0, NULL);	udelay(1000);}intmodeisar(struct BCState *bcs, int mode, int bc){	struct IsdnCardState *cs = bcs->cs;	/* Here we are selecting the best datapath for requested mode */	if(bcs->mode == L1_MODE_NULL) { /* New Setup */		bcs->channel = bc;		switch (mode) {			case L1_MODE_NULL: /* init */				if (!bcs->hw.isar.dpath)					/* no init for dpath 0 */					return(0);				break;			case L1_MODE_TRANS:			case L1_MODE_HDLC:				/* best is datapath 2 */				if (!test_and_set_bit(ISAR_DP2_USE, 					&bcs->hw.isar.reg->Flags))					bcs->hw.isar.dpath = 2;				else if (!test_and_set_bit(ISAR_DP1_USE,					&bcs->hw.isar.reg->Flags))					bcs->hw.isar.dpath = 1;				else {					printk(KERN_WARNING"isar modeisar both pathes in use\n");					return(1);				}				break;			case L1_MODE_V32:			case L1_MODE_FAX:				/* only datapath 1 */				if (!test_and_set_bit(ISAR_DP1_USE, 					&bcs->hw.isar.reg->Flags))					bcs->hw.isar.dpath = 1;				else {					printk(KERN_WARNING"isar modeisar analog funktions only with DP1\n");					debugl1(cs, "isar modeisar analog funktions only with DP1");					return(1);				}				break;		}	}	if (cs->debug & L1_DEB_HSCX)		debugl1(cs, "isar dp%d mode %d->%d ichan %d",			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:			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:			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:			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:			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;	}	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);		cs->bcs[i].tqueue.routine = (void *) (void *) isar_bh;	}}voidisar_l2l1(struct PStack *st, int pr, void *arg){	struct sk_buff *skb = arg;	long flags;	switch (pr) {		case (PH_DATA | REQUEST):			save_flags(flags);			cli();			if (st->l1.bcs->tx_skb) {				skb_queue_tail(&st->l1.bcs->squeue, skb);				restore_flags(flags);			} else {				st->l1.bcs->tx_skb = skb;				test_and_set_bit(BC_FLG_BUSY, &st->l1.bcs->Flag);				if (st->l1.bcs->cs->debug & L1_DEB_HSCX)					debugl1(st->l1.bcs->cs, "DRQ set BC_FLG_BUSY");				st->l1.bcs->hw.isar.txcnt = 0;				restore_flags(flags);				st->l1.bcs->cs->BC_Send_Data(st->l1.bcs);			}			break;		case (PH_PULL | INDICATION):			if (st->l1.bcs->tx_skb) {				printk(KERN_WARNING "isar_l2l1: this shouldn't happen\n");				break;			}			test_and_set_bit(BC_FLG_BUSY, &st->l1.bcs->Flag);			if (st->l1.bcs->cs->debug & L1_DEB_HSCX)				debugl1(st->l1.bcs->cs, "PUI set BC_FLG_BUSY");			st->l1.bcs->tx_skb = skb;			st->l1.bcs->hw.isar.txcnt = 0;			st->l1.bcs->cs->BC_Send_Data(st->l1.bcs);			break;		case (PH_PULL | REQUEST):			if (!st->l1.bcs->tx_skb) {				test_and_clear_bit(FLG_L1_PULL_REQ, &st->l1.Flags);				L1L2(st, PH_PULL | CONFIRM, NULL);			} else				test_and_set_bit(FLG_L1_PULL_REQ, &st->l1.Flags);			break;		case (PH_ACTIVATE | REQUEST):			test_and_set_bit(BC_FLG_ACTIV, &st->l1.bcs->Flag);			st->l1.bcs->hw.isar.conmsg[0] = 0;			if (test_bit(FLG_ORIG, &st->l2.flag))				test_and_set_bit(BC_FLG_ORIG, &st->l1.bcs->Flag);			else				test_and_clear_bit(BC_FLG_ORIG, &st->l1.bcs->Flag);			switch(st->l1.mode) {				case L1_MODE_TRANS:				case L1_MODE_HDLC:					if (modeisar(st->l1.bcs, st->l1.mode, st->l1.bc))						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:					if (modeisar(st->l1.bcs, st->l1.mode, st->l1.bc))						l1_msg_b(st, PH_DEACTIVATE | REQUEST, arg);					break;			}			break;		case (PH_DEACTIVATE | REQUEST):			l1_msg_b(st, pr, arg);			break;		case (PH_DEACTIVATE | CONFIRM):			test_and_clear_bit(BC_FLG_ACTIV, &st->l1.bcs->Flag);			test_and_clear_bit(BC_FLG_BUSY, &st->l1.bcs->Flag);			if (st->l1.bcs->cs->debug & L1_DEB_HSCX)				debugl1(st->l1.bcs->cs, "PDAC clear BC_FLG_BUSY");			modeisar(st->l1.bcs, 0, st->l1.bc);			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;	bcs->hw.isar.ftimer.function = (void *) ftimer_handler;	bcs->hw.isar.ftimer.data = (long) bcs;	init_timer(&bcs->hw.isar.ftimer);	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->l1.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_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) {						strcpy(ic->parm.aux.para, faxmodulation_s);						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) {						for(i=0;i<FAXMODCNT;i++)							if (faxmodulation[i]==ic->parm.aux.para[0])								break;						if ((FAXMODCNT > i) && 							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 *)adr))						return(1);					else 						ll_run(cs, 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;}