patch-2.0.36 linux/drivers/isdn/hisax/teles0.c

Next file: linux/drivers/isdn/hisax/teles3.c
Previous file: linux/drivers/isdn/hisax/teleint.c
Back to the patch index
Back to the overall index

diff -u --recursive --new-file v2.0.35/linux/drivers/isdn/hisax/teles0.c linux/drivers/isdn/hisax/teles0.c
@@ -1,4 +1,4 @@
-/* $Id: teles0.c,v 1.8 1997/04/13 19:54:04 keil Exp $
+/* $Id: teles0.c,v 1.8.2.9 1998/04/08 21:58:49 keil Exp $
 
  * teles0.c     low level stuff for Teles Memory IO isdn cards
  *              based on the teles driver from Jan den Ouden
@@ -10,97 +10,103 @@
  *              Beat Doebeli
  *
  * $Log: teles0.c,v $
- * Revision 1.8  1997/04/13 19:54:04  keil
- * Change in IRQ check delay for SMP
+ * Revision 1.8.2.9  1998/04/08 21:58:49  keil
+ * New init code
  *
- * Revision 1.7  1997/04/06 22:54:04  keil
- * Using SKB's
+ * Revision 1.8.2.8  1998/03/07 23:15:40  tsbogend
+ * made HiSax working on Linux/Alpha
  *
- * Revision 1.6  1997/01/27 15:52:18  keil
- * SMP proof,cosmetics
+ * Revision 1.8.2.7  1998/02/03 23:17:16  keil
+ * IRQ 9
  *
- * Revision 1.5  1997/01/21 22:25:59  keil
- * cleanups
+ * Revision 1.8.2.6  1998/01/27 22:37:43  keil
+ * fast io
  *
- * Revision 1.4  1996/11/05 19:41:27  keil
- * more changes for 2.1
+ * Revision 1.8.2.5  1997/11/15 18:51:00  keil
+ * new common init function
  *
- * Revision 1.3  1996/10/30 10:22:58  keil
- * Changes for 2.1 kernels
+ * Revision 1.8.2.4  1997/10/17 22:14:26  keil
+ * update to last hisax version
  *
- * Revision 1.2  1996/10/27 22:08:34  keil
- * cosmetic changes
+ * Revision 2.1  1997/07/27 21:47:10  keil
+ * new interface structures
  *
- * Revision 1.1  1996/10/13 20:04:58  keil
- * Initial revision
+ * Revision 2.0  1997/06/26 11:02:43  keil
+ * New Layer and card interface
  *
+ * Revision 1.8  1997/04/13 19:54:04  keil
+ * Change in IRQ check delay for SMP
  *
+ * Revision 1.7  1997/04/06 22:54:04  keil
+ * Using SKB's
+ *
+ * removed old log info /KKe
  *
  */
 #define __NO_VERSION__
-#include "siemens.h"
 #include "hisax.h"
-#include "teles0.h"
 #include "isdnl1.h"
-#include <linux/kernel_stat.h>
+#include "isac.h"
+#include "hscx.h"
 
 extern const char *CardType[];
 
-const char *teles0_revision = "$Revision: 1.8 $";
+const char *teles0_revision = "$Revision: 1.8.2.9 $";
 
-#define byteout(addr,val) outb_p(val,addr)
-#define bytein(addr) inb_p(addr)
+#define byteout(addr,val) outb(val,addr)
+#define bytein(addr) inb(addr)
 
 static inline u_char
 readisac(unsigned int adr, u_char off)
 {
-	return readb(adr + 0x120 + ((off & 1) ? 0x1ff : 0) + off);
+	return readb(adr + ((off & 1) ? 0x2ff : 0x100) + off);
 }
 
 static inline void
 writeisac(unsigned int adr, u_char off, u_char data)
 {
-	writeb(data, adr + 0x120 + ((off & 1) ? 0x1ff : 0) + off);
+	writeb(data, adr + ((off & 1) ? 0x2ff : 0x100) + off); mb();
 }
 
 
 static inline u_char
 readhscx(unsigned int adr, int hscx, u_char off)
 {
-	return readb(adr + (hscx ? 0x1e0 : 0x1a0) +
+	return readb(adr + (hscx ? 0x1c0 : 0x180) +
 		     ((off & 1) ? 0x1ff : 0) + off);
 }
 
 static inline void
 writehscx(unsigned int adr, int hscx, u_char off, u_char data)
 {
-	writeb(data, adr + (hscx ? 0x1e0 : 0x1a0) +
-	       ((off & 1) ? 0x1ff : 0) + off);
+	writeb(data, adr + (hscx ? 0x1c0 : 0x180) +
+	       ((off & 1) ? 0x1ff : 0) + off); mb();
 }
 
 static inline void
 read_fifo_isac(unsigned int adr, u_char * data, int size)
 {
 	register int i;
-	register u_char *ad = (u_char *) (adr + 0x100);
+	register u_char *ad = (u_char *) ((long)adr + 0x100);
 	for (i = 0; i < size; i++)
 		data[i] = readb(ad);
 }
 
-static void
+static inline void
 write_fifo_isac(unsigned int adr, u_char * data, int size)
 {
 	register int i;
-	register u_char *ad = (u_char *) (adr + 0x100);
-	for (i = 0; i < size; i++)
-		writeb(data[i], ad);
+	register u_char *ad = (u_char *) ((long)adr + 0x100);
+	for (i = 0; i < size; i++) {
+		writeb(data[i], ad); mb();
+	}
 }
 
 static inline void
 read_fifo_hscx(unsigned int adr, int hscx, u_char * data, int size)
 {
 	register int i;
-	register u_char *ad = (u_char *) (adr + (hscx ? 0x1c0 : 0x180));
+	register u_char *ad = (u_char *) ((long)adr + (hscx ? 0x1c0 : 0x180));
 	for (i = 0; i < size; i++)
 		data[i] = readb(ad);
 }
@@ -109,749 +115,206 @@
 write_fifo_hscx(unsigned int adr, int hscx, u_char * data, int size)
 {
 	int i;
-	register u_char *ad = (u_char *) (adr + (hscx ? 0x1c0 : 0x180));
-	for (i = 0; i < size; i++)
-		writeb(data[i], ad);
-}
-static inline void
-waitforCEC(int adr, int hscx)
-{
-	int to = 50;
-
-	while ((readhscx(adr, hscx, HSCX_STAR) & 0x04) && to) {
-		udelay(1);
-		to--;
+	register u_char *ad = (u_char *) ((long)adr + (hscx ? 0x1c0 : 0x180));
+	for (i = 0; i < size; i++) {
+		writeb(data[i], ad); mb();
 	}
-	if (!to)
-		printk(KERN_WARNING "Teles0: waitforCEC timeout\n");
 }
 
+/* Interface functions */
 
-static inline void
-waitforXFW(int adr, int hscx)
-{
-	int to = 50;
-
-	while ((!(readhscx(adr, hscx, HSCX_STAR) & 0x44) == 0x40) && to) {
-		udelay(1);
-		to--;
-	}
-	if (!to)
-		printk(KERN_WARNING "Teles0: waitforXFW timeout\n");
-}
-
-static inline void
-writehscxCMDR(int adr, int hscx, u_char data)
+static u_char
+ReadISAC(struct IsdnCardState *cs, u_char offset)
 {
-	long flags;
-
-	save_flags(flags);
-	cli();
-	waitforCEC(adr, hscx);
-	writehscx(adr, hscx, HSCX_CMDR, data);
-	restore_flags(flags);
+	return (readisac(cs->hw.teles0.membase, offset));
 }
 
-/*
- * fast interrupt here
- */
-
-
 static void
-hscxreport(struct IsdnCardState *sp, int hscx)
+WriteISAC(struct IsdnCardState *cs, u_char offset, u_char value)
 {
-	printk(KERN_DEBUG "HSCX %d\n", hscx);
-	printk(KERN_DEBUG "ISTA %x\n", readhscx(sp->membase, hscx, HSCX_ISTA));
-	printk(KERN_DEBUG "STAR %x\n", readhscx(sp->membase, hscx, HSCX_STAR));
-	printk(KERN_DEBUG "EXIR %x\n", readhscx(sp->membase, hscx, HSCX_EXIR));
+	writeisac(cs->hw.teles0.membase, offset, value);
 }
 
-void
-teles0_report(struct IsdnCardState *sp)
-{
-	printk(KERN_DEBUG "ISAC\n");
-	printk(KERN_DEBUG "ISTA %x\n", readisac(sp->membase, ISAC_ISTA));
-	printk(KERN_DEBUG "STAR %x\n", readisac(sp->membase, ISAC_STAR));
-	printk(KERN_DEBUG "EXIR %x\n", readisac(sp->membase, ISAC_EXIR));
-	hscxreport(sp, 0);
-	hscxreport(sp, 1);
-}
-
-/*
- * HSCX stuff goes here
- */
-
 static void
-hscx_empty_fifo(struct HscxState *hsp, int count)
+ReadISACfifo(struct IsdnCardState *cs, u_char * data, int size)
 {
-	u_char *ptr;
-	struct IsdnCardState *sp = hsp->sp;
-	long flags;
-
-	if ((sp->debug & L1_DEB_HSCX) && !(sp->debug & L1_DEB_HSCX_FIFO))
-		debugl1(sp, "hscx_empty_fifo");
-
-	if (hsp->rcvidx + count > HSCX_BUFMAX) {
-		if (sp->debug & L1_DEB_WARN)
-			debugl1(sp, "hscx_empty_fifo: incoming packet too large");
-		writehscxCMDR(sp->membase, hsp->hscx, 0x80);
-		hsp->rcvidx = 0;
-		return;
-	}
-	ptr = hsp->rcvbuf + hsp->rcvidx;
-	hsp->rcvidx += count;
-	save_flags(flags);
-	cli();
-	read_fifo_hscx(sp->membase, hsp->hscx, ptr, count);
-	writehscxCMDR(sp->membase, hsp->hscx, 0x80);
-	restore_flags(flags);
-	if (sp->debug & L1_DEB_HSCX_FIFO) {
-		char tmp[128];
-		char *t = tmp;
-
-		t += sprintf(t, "hscx_empty_fifo %c cnt %d",
-			     hsp->hscx ? 'B' : 'A', count);
-		QuickHex(t, ptr, count);
-		debugl1(sp, tmp);
-	}
+	read_fifo_isac(cs->hw.teles0.membase, data, size);
 }
 
 static void
-hscx_fill_fifo(struct HscxState *hsp)
-{
-	struct IsdnCardState *sp = hsp->sp;
-	int more, count;
-	u_char *ptr;
-	long flags;
-
-	if ((sp->debug & L1_DEB_HSCX) && !(sp->debug & L1_DEB_HSCX_FIFO))
-		debugl1(sp, "hscx_fill_fifo");
-
-	if (!hsp->tx_skb)
-		return;
-	if (hsp->tx_skb->len <= 0)
-		return;
-
-	more = (hsp->mode == 1) ? 1 : 0;
-	if (hsp->tx_skb->len > 32) {
-		more = !0;
-		count = 32;
-	} else
-		count = hsp->tx_skb->len;
-
-	waitforXFW(sp->membase, hsp->hscx);
-	save_flags(flags);
-	cli();
-	ptr = hsp->tx_skb->data;
-	skb_pull(hsp->tx_skb, count);
-	hsp->tx_cnt -= count;
-	hsp->count += count;
-	write_fifo_hscx(sp->membase, hsp->hscx, ptr, count);
-	writehscxCMDR(sp->membase, hsp->hscx, more ? 0x8 : 0xa);
-	restore_flags(flags);
-	if (sp->debug & L1_DEB_HSCX_FIFO) {
-		char tmp[128];
-		char *t = tmp;
-
-		t += sprintf(t, "hscx_fill_fifo %c cnt %d",
-			     hsp->hscx ? 'B' : 'A', count);
-		QuickHex(t, ptr, count);
-		debugl1(sp, tmp);
-	}
-}
-
-static inline void
-hscx_interrupt(struct IsdnCardState *sp, u_char val, u_char hscx)
+WriteISACfifo(struct IsdnCardState *cs, u_char * data, int size)
 {
-	u_char r;
-	struct HscxState *hsp = sp->hs + hscx;
-	struct sk_buff *skb;
-	int count;
-	char tmp[32];
-
-	if (!hsp->init)
-		return;
-
-	if (val & 0x80) {	/* RME */
-
-		r = readhscx(sp->membase, hsp->hscx, HSCX_RSTA);
-		if ((r & 0xf0) != 0xa0) {
-			if (!(r & 0x80))
-				if (sp->debug & L1_DEB_WARN)
-					debugl1(sp, "HSCX invalid frame");
-			if ((r & 0x40) && hsp->mode)
-				if (sp->debug & L1_DEB_WARN) {
-					sprintf(tmp, "HSCX RDO mode=%d",
-						hsp->mode);
-					debugl1(sp, tmp);
-				}
-			if (!(r & 0x20))
-				if (sp->debug & L1_DEB_WARN)
-					debugl1(sp, "HSCX CRC error");
-			writehscxCMDR(sp->membase, hsp->hscx, 0x80);
-		} else {
-			count = readhscx(sp->membase, hsp->hscx, HSCX_RBCL) & 0x1f;
-			if (count == 0)
-				count = 32;
-			hscx_empty_fifo(hsp, count);
-			if ((count = hsp->rcvidx - 1) > 0) {
-				if (!(skb = dev_alloc_skb(count)))
-					printk(KERN_WARNING "teles0: receive out of memory\n");
-				else {
-					memcpy(skb_put(skb, count), hsp->rcvbuf, count);
-					skb_queue_tail(&hsp->rqueue, skb);
-				}
-			}
-		}
-		hsp->rcvidx = 0;
-		hscx_sched_event(hsp, HSCX_RCVBUFREADY);
-	}
-	if (val & 0x40) {	/* RPF */
-		hscx_empty_fifo(hsp, 32);
-		if (hsp->mode == 1) {
-			/* receive audio data */
-			if (!(skb = dev_alloc_skb(32)))
-				printk(KERN_WARNING "teles0: receive out of memory\n");
-			else {
-				memcpy(skb_put(skb, 32), hsp->rcvbuf, 32);
-				skb_queue_tail(&hsp->rqueue, skb);
-			}
-			hsp->rcvidx = 0;
-			hscx_sched_event(hsp, HSCX_RCVBUFREADY);
-		}
-	}
-	if (val & 0x10) {	/* XPR */
-		if (hsp->tx_skb)
-			if (hsp->tx_skb->len) {
-				hscx_fill_fifo(hsp);
-				return;
-			} else {
-				dev_kfree_skb(hsp->tx_skb, FREE_WRITE);
-				hsp->count = 0;
-				if (hsp->st->l4.l1writewakeup)
-					hsp->st->l4.l1writewakeup(hsp->st);
-				hsp->tx_skb = NULL;
-			}
-		if ((hsp->tx_skb = skb_dequeue(&hsp->squeue))) {
-			hsp->count = 0;
-			hscx_fill_fifo(hsp);
-		} else
-			hscx_sched_event(hsp, HSCX_XMTBUFREADY);
-	}
-}
-
-/*
- * ISAC stuff goes here
- */
-
-static void
-isac_empty_fifo(struct IsdnCardState *sp, int count)
-{
-	u_char *ptr;
-	long flags;
-
-	if ((sp->debug & L1_DEB_ISAC) && !(sp->debug & L1_DEB_ISAC_FIFO))
-		debugl1(sp, "isac_empty_fifo");
-
-	if ((sp->rcvidx + count) >= MAX_DFRAME_LEN) {
-		if (sp->debug & L1_DEB_WARN) {
-			char tmp[40];
-			sprintf(tmp, "isac_empty_fifo overrun %d",
-				sp->rcvidx + count);
-			debugl1(sp, tmp);
-		}
-		writeisac(sp->membase, ISAC_CMDR, 0x80);
-		sp->rcvidx = 0;
-		return;
-	}
-	ptr = sp->rcvbuf + sp->rcvidx;
-	sp->rcvidx += count;
-	save_flags(flags);
-	cli();
-	read_fifo_isac(sp->membase, ptr, count);
-	writeisac(sp->membase, ISAC_CMDR, 0x80);
-	restore_flags(flags);
-	if (sp->debug & L1_DEB_ISAC_FIFO) {
-		char tmp[128];
-		char *t = tmp;
-
-		t += sprintf(t, "isac_empty_fifo cnt %d", count);
-		QuickHex(t, ptr, count);
-		debugl1(sp, tmp);
-	}
+	write_fifo_isac(cs->hw.teles0.membase, data, size);
 }
 
-static void
-isac_fill_fifo(struct IsdnCardState *sp)
+static u_char
+ReadHSCX(struct IsdnCardState *cs, int hscx, u_char offset)
 {
-	int count, more;
-	u_char *ptr;
-	long flags;
-
-	if ((sp->debug & L1_DEB_ISAC) && !(sp->debug & L1_DEB_ISAC_FIFO))
-		debugl1(sp, "isac_fill_fifo");
-
-	if (!sp->tx_skb)
-		return;
-
-	count = sp->tx_skb->len;
-	if (count <= 0)
-		return;
-
-	more = 0;
-	if (count > 32) {
-		more = !0;
-		count = 32;
-	}
-	save_flags(flags);
-	cli();
-	ptr = sp->tx_skb->data;
-	skb_pull(sp->tx_skb, count);
-	sp->tx_cnt += count;
-	write_fifo_isac(sp->membase, ptr, count);
-	writeisac(sp->membase, ISAC_CMDR, more ? 0x8 : 0xa);
-	restore_flags(flags);
-	if (sp->debug & L1_DEB_ISAC_FIFO) {
-		char tmp[128];
-		char *t = tmp;
-
-		t += sprintf(t, "isac_fill_fifo cnt %d", count);
-		QuickHex(t, ptr, count);
-		debugl1(sp, tmp);
-	}
+	return (readhscx(cs->hw.teles0.membase, hscx, offset));
 }
 
 static void
-ph_command(struct IsdnCardState *sp, unsigned int command)
+WriteHSCX(struct IsdnCardState *cs, int hscx, u_char offset, u_char value)
 {
-	if (sp->debug & L1_DEB_ISAC) {
-		char tmp[32];
-		sprintf(tmp, "ph_command %d", command);
-		debugl1(sp, tmp);
-	}
-	writeisac(sp->membase, ISAC_CIX0, (command << 2) | 3);
+	writehscx(cs->hw.teles0.membase, hscx, offset, value);
 }
 
-static inline void
-isac_interrupt(struct IsdnCardState *sp, u_char val)
-{
-	u_char exval;
-	struct sk_buff *skb;
-	unsigned int count;
-	char tmp[32];
-
-	if (sp->debug & L1_DEB_ISAC) {
-		sprintf(tmp, "ISAC interrupt %x", val);
-		debugl1(sp, tmp);
-	}
-	if (val & 0x80) {	/* RME */
-		exval = readisac(sp->membase, ISAC_RSTA);
-		if ((exval & 0x70) != 0x20) {
-			if (exval & 0x40)
-				if (sp->debug & L1_DEB_WARN)
-					debugl1(sp, "ISAC RDO");
-			if (!(exval & 0x20))
-				if (sp->debug & L1_DEB_WARN)
-					debugl1(sp, "ISAC CRC error");
-			writeisac(sp->membase, ISAC_CMDR, 0x80);
-		} else {
-			count = readisac(sp->membase, ISAC_RBCL) & 0x1f;
-			if (count == 0)
-				count = 32;
-			isac_empty_fifo(sp, count);
-			if ((count = sp->rcvidx) > 0) {
-				if (!(skb = alloc_skb(count, GFP_ATOMIC)))
-					printk(KERN_WARNING "teles0: D receive out of memory\n");
-				else {
-					SET_SKB_FREE(skb);
-					memcpy(skb_put(skb, count), sp->rcvbuf, count);
-					skb_queue_tail(&sp->rq, skb);
-				}
-			}
-		}
-		sp->rcvidx = 0;
-		isac_sched_event(sp, ISAC_RCVBUFREADY);
-	}
-	if (val & 0x40) {	/* RPF */
-		isac_empty_fifo(sp, 32);
-	}
-	if (val & 0x20) {	/* RSC */
-		/* never */
-		if (sp->debug & L1_DEB_WARN)
-			debugl1(sp, "ISAC RSC interrupt");
-	}
-	if (val & 0x10) {	/* XPR */
-		if (sp->tx_skb)
-			if (sp->tx_skb->len) {
-				isac_fill_fifo(sp);
-				goto afterXPR;
-			} else {
-				dev_kfree_skb(sp->tx_skb, FREE_WRITE);
-				sp->tx_cnt = 0;
-				sp->tx_skb = NULL;
-			}
-		if ((sp->tx_skb = skb_dequeue(&sp->sq))) {
-			sp->tx_cnt = 0;
-			isac_fill_fifo(sp);
-		} else
-			isac_sched_event(sp, ISAC_XMTBUFREADY);
-	}
-      afterXPR:
-	if (val & 0x04) {	/* CISQ */
-		sp->ph_state = (readisac(sp->membase, ISAC_CIX0) >> 2)
-		    & 0xf;
-		if (sp->debug & L1_DEB_ISAC) {
-			sprintf(tmp, "l1state %d", sp->ph_state);
-			debugl1(sp, tmp);
-		}
-		isac_new_ph(sp);
-	}
-	if (val & 0x02) {	/* SIN */
-		/* never */
-		if (sp->debug & L1_DEB_WARN)
-			debugl1(sp, "ISAC SIN interrupt");
-	}
-	if (val & 0x01) {	/* EXI */
-		exval = readisac(sp->membase, ISAC_EXIR);
-		if (sp->debug & L1_DEB_WARN) {
-			sprintf(tmp, "ISAC EXIR %02x", exval);
-			debugl1(sp, tmp);
-		}
-	}
-}
+/*
+ * fast interrupt HSCX stuff goes here
+ */
 
-static inline void
-hscx_int_main(struct IsdnCardState *sp, u_char val)
-{
+#define READHSCX(cs, nr, reg) readhscx(cs->hw.teles0.membase, nr, reg)
+#define WRITEHSCX(cs, nr, reg, data) writehscx(cs->hw.teles0.membase, nr, reg, data)
+#define READHSCXFIFO(cs, nr, ptr, cnt) read_fifo_hscx(cs->hw.teles0.membase, nr, ptr, cnt)
+#define WRITEHSCXFIFO(cs, nr, ptr, cnt) write_fifo_hscx(cs->hw.teles0.membase, nr, ptr, cnt)
 
-	u_char exval;
-	struct HscxState *hsp;
-	char tmp[32];
-
-
-	if (val & 0x01) {
-		hsp = sp->hs + 1;
-		exval = readhscx(sp->membase, 1, HSCX_EXIR);
-		if (exval == 0x40) {
-			if (hsp->mode == 1)
-				hscx_fill_fifo(hsp);
-			else {
-				/* Here we lost an TX interrupt, so
-				   * restart transmitting the whole frame.
-				 */
-				if (hsp->tx_skb) {
-					skb_push(hsp->tx_skb, hsp->count);
-					hsp->tx_cnt += hsp->count;
-					hsp->count = 0;
-				}
-				writehscxCMDR(sp->membase, hsp->hscx, 0x01);
-				if (sp->debug & L1_DEB_WARN) {
-					sprintf(tmp, "HSCX B EXIR %x Lost TX", exval);
-					debugl1(sp, tmp);
-				}
-			}
-		} else if (sp->debug & L1_DEB_HSCX) {
-			sprintf(tmp, "HSCX B EXIR %x", exval);
-			debugl1(sp, tmp);
-		}
-	}
-	if (val & 0xf8) {
-		if (sp->debug & L1_DEB_HSCX) {
-			sprintf(tmp, "HSCX B interrupt %x", val);
-			debugl1(sp, tmp);
-		}
-		hscx_interrupt(sp, val, 1);
-	}
-	if (val & 0x02) {
-		hsp = sp->hs;
-		exval = readhscx(sp->membase, 0, HSCX_EXIR);
-		if (exval == 0x40) {
-			if (hsp->mode == 1)
-				hscx_fill_fifo(hsp);
-			else {
-				/* Here we lost an TX interrupt, so
-				   * restart transmitting the whole frame.
-				 */
-				if (hsp->tx_skb) {
-					skb_push(hsp->tx_skb, hsp->count);
-					hsp->tx_cnt += hsp->count;
-					hsp->count = 0;
-				}
-				writehscxCMDR(sp->membase, hsp->hscx, 0x01);
-				if (sp->debug & L1_DEB_WARN) {
-					sprintf(tmp, "HSCX A EXIR %x Lost TX", exval);
-					debugl1(sp, tmp);
-				}
-			}
-		} else if (sp->debug & L1_DEB_HSCX) {
-			sprintf(tmp, "HSCX A EXIR %x", exval);
-			debugl1(sp, tmp);
-		}
-	}
-	if (val & 0x04) {
-		exval = readhscx(sp->membase, 0, HSCX_ISTA);
-		if (sp->debug & L1_DEB_HSCX) {
-			sprintf(tmp, "HSCX A interrupt %x", exval);
-			debugl1(sp, tmp);
-		}
-		hscx_interrupt(sp, exval, 0);
-	}
-}
+#include "hscx_irq.c"
 
 static void
-telesS0_interrupt(int intno, void *dev_id, struct pt_regs *regs)
+teles0_interrupt(int intno, void *dev_id, struct pt_regs *regs)
 {
-	struct IsdnCardState *sp;
+	struct IsdnCardState *cs = dev_id;
 	u_char val, stat = 0;
+	int count = 0;
 
-	sp = (struct IsdnCardState *) irq2dev_map[intno];
-
-	if (!sp) {
+	if (!cs) {
 		printk(KERN_WARNING "Teles0: Spurious interrupt!\n");
 		return;
 	}
-	val = readhscx(sp->membase, 1, HSCX_ISTA);
+	val = readhscx(cs->hw.teles0.membase, 1, HSCX_ISTA);
       Start_HSCX:
 	if (val) {
-		hscx_int_main(sp, val);
+		hscx_int_main(cs, val);
 		stat |= 1;
 	}
-	val = readisac(sp->membase, ISAC_ISTA);
+	val = readisac(cs->hw.teles0.membase, ISAC_ISTA);
       Start_ISAC:
 	if (val) {
-		isac_interrupt(sp, val);
+		isac_interrupt(cs, val);
 		stat |= 2;
 	}
-	val = readhscx(sp->membase, 1, HSCX_ISTA);
-	if (val) {
-		if (sp->debug & L1_DEB_HSCX)
-			debugl1(sp, "HSCX IntStat after IntRoutine");
+	count++;
+	val = readhscx(cs->hw.teles0.membase, 1, HSCX_ISTA);
+	if (val && count < 20) {
+		if (cs->debug & L1_DEB_HSCX)
+			debugl1(cs, "HSCX IntStat after IntRoutine");
 		goto Start_HSCX;
 	}
-	val = readisac(sp->membase, ISAC_ISTA);
-	if (val) {
-		if (sp->debug & L1_DEB_ISAC)
-			debugl1(sp, "ISAC IntStat after IntRoutine");
+	val = readisac(cs->hw.teles0.membase, ISAC_ISTA);
+	if (val && count < 20) {
+		if (cs->debug & L1_DEB_ISAC)
+			debugl1(cs, "ISAC IntStat after IntRoutine");
 		goto Start_ISAC;
 	}
 	if (stat & 1) {
-		writehscx(sp->membase, 0, HSCX_MASK, 0xFF);
-		writehscx(sp->membase, 1, HSCX_MASK, 0xFF);
-		writehscx(sp->membase, 0, HSCX_MASK, 0x0);
-		writehscx(sp->membase, 1, HSCX_MASK, 0x0);
+		writehscx(cs->hw.teles0.membase, 0, HSCX_MASK, 0xFF);
+		writehscx(cs->hw.teles0.membase, 1, HSCX_MASK, 0xFF);
+		writehscx(cs->hw.teles0.membase, 0, HSCX_MASK, 0x0);
+		writehscx(cs->hw.teles0.membase, 1, HSCX_MASK, 0x0);
 	}
 	if (stat & 2) {
-		writeisac(sp->membase, ISAC_MASK, 0xFF);
-		writeisac(sp->membase, ISAC_MASK, 0x0);
+		writeisac(cs->hw.teles0.membase, ISAC_MASK, 0xFF);
+		writeisac(cs->hw.teles0.membase, ISAC_MASK, 0x0);
 	}
 }
 
-
-static void
-initisac(struct IsdnCardState *sp)
+void
+release_io_teles0(struct IsdnCardState *cs)
 {
-	unsigned int adr = sp->membase;
-
-	/* 16.0 IOM 1 Mode */
-	writeisac(adr, ISAC_MASK, 0xff);
-	writeisac(adr, ISAC_ADF2, 0x0);
-	writeisac(adr, ISAC_SPCR, 0xa);
-	writeisac(adr, ISAC_ADF1, 0x2);
-	writeisac(adr, ISAC_STCR, 0x70);
-	writeisac(adr, ISAC_MODE, 0xc9);
-	writeisac(adr, ISAC_CMDR, 0x41);
-	writeisac(adr, ISAC_CIX0, (1 << 2) | 3);
-	writeisac(adr, ISAC_MASK, 0xff);
-	writeisac(adr, ISAC_MASK, 0x0);
+	if (cs->hw.teles0.cfg_reg)
+		release_region(cs->hw.teles0.cfg_reg, 8);
 }
 
-static void
-modehscx(struct HscxState *hs, int mode, int ichan)
+static int
+reset_teles0(struct IsdnCardState *cs)
 {
-	struct IsdnCardState *sp = hs->sp;
-	int hscx = hs->hscx;
+	u_char cfval;
+	long flags;
 
-	if (sp->debug & L1_DEB_HSCX) {
-		char tmp[40];
-		sprintf(tmp, "hscx %c mode %d ichan %d",
-			'A' + hscx, mode, ichan);
-		debugl1(sp, tmp);
-	}
-	hs->mode = mode;
-	writehscx(sp->membase, hscx, HSCX_CCR1, 0x85);
-	writehscx(sp->membase, hscx, HSCX_XAD1, 0xFF);
-	writehscx(sp->membase, hscx, HSCX_XAD2, 0xFF);
-	writehscx(sp->membase, hscx, HSCX_RAH2, 0xFF);
-	writehscx(sp->membase, hscx, HSCX_XBCH, 0x0);
-
-	/* Switch IOM 1 SSI */
-	if (hscx == 0)
-		ichan = 1 - ichan;
-
-	switch (mode) {
-		case (0):
-			writehscx(sp->membase, hscx, HSCX_CCR2, 0x30);
-			writehscx(sp->membase, hscx, HSCX_TSAX, 0xff);
-			writehscx(sp->membase, hscx, HSCX_TSAR, 0xff);
-			writehscx(sp->membase, hscx, HSCX_XCCR, 7);
-			writehscx(sp->membase, hscx, HSCX_RCCR, 7);
-			writehscx(sp->membase, hscx, HSCX_MODE, 0x84);
-			break;
-		case (1):
-			if (ichan == 0) {
-				writehscx(sp->membase, hscx, HSCX_CCR2, 0x30);
-				writehscx(sp->membase, hscx, HSCX_TSAX, 0x7);
-				writehscx(sp->membase, hscx, HSCX_TSAR, 0x7);
-				writehscx(sp->membase, hscx, HSCX_XCCR, 7);
-				writehscx(sp->membase, hscx, HSCX_RCCR, 7);
-			} else {
-				writehscx(sp->membase, hscx, HSCX_CCR2, 0x30);
-				writehscx(sp->membase, hscx, HSCX_TSAX, 0x3);
-				writehscx(sp->membase, hscx, HSCX_TSAR, 0x3);
-				writehscx(sp->membase, hscx, HSCX_XCCR, 7);
-				writehscx(sp->membase, hscx, HSCX_RCCR, 7);
-			}
-			writehscx(sp->membase, hscx, HSCX_MODE, 0xe4);
-			writehscx(sp->membase, hscx, HSCX_CMDR, 0x41);
-			break;
-		case (2):
-			if (ichan == 0) {
-				writehscx(sp->membase, hscx, HSCX_CCR2, 0x30);
-				writehscx(sp->membase, hscx, HSCX_TSAX, 0x7);
-				writehscx(sp->membase, hscx, HSCX_TSAR, 0x7);
-				writehscx(sp->membase, hscx, HSCX_XCCR, 7);
-				writehscx(sp->membase, hscx, HSCX_RCCR, 7);
-			} else {
-				writehscx(sp->membase, hscx, HSCX_CCR2, 0x30);
-				writehscx(sp->membase, hscx, HSCX_TSAX, 0x3);
-				writehscx(sp->membase, hscx, HSCX_TSAR, 0x3);
-				writehscx(sp->membase, hscx, HSCX_XCCR, 7);
-				writehscx(sp->membase, hscx, HSCX_RCCR, 7);
-			}
-			writehscx(sp->membase, hscx, HSCX_MODE, 0x8c);
-			writehscx(sp->membase, hscx, HSCX_CMDR, 0x41);
-			break;
+	save_flags(flags);
+	sti();
+	if (cs->hw.teles0.cfg_reg) {
+		switch (cs->irq) {
+			case 2:
+			case 9:
+				cfval = 0x00;
+				break;
+			case 3:
+				cfval = 0x02;
+				break;
+			case 4:
+				cfval = 0x04;
+				break;
+			case 5:
+				cfval = 0x06;
+				break;
+			case 10:
+				cfval = 0x08;
+				break;
+			case 11:
+				cfval = 0x0A;
+				break;
+			case 12:
+				cfval = 0x0C;
+				break;
+			case 15:
+				cfval = 0x0E;
+				break;
+			default:
+				return(1);
+		}
+		cfval |= ((cs->hw.teles0.membase >> 9) & 0xF0);
+		byteout(cs->hw.teles0.cfg_reg + 4, cfval);
+		HZDELAY(HZ / 10 + 1);
+		byteout(cs->hw.teles0.cfg_reg + 4, cfval | 1);
+		HZDELAY(HZ / 10 + 1);
 	}
-	writehscx(sp->membase, hscx, HSCX_ISTA, 0x00);
-}
-
-void
-release_io_teles0(struct IsdnCard *card)
-{
-	if (card->sp->cfg_reg)
-		release_region(card->sp->cfg_reg, 8);
+	writeb(0, cs->hw.teles0.membase + 0x80); mb();
+	HZDELAY(HZ / 5 + 1);
+	writeb(1, cs->hw.teles0.membase + 0x80); mb();
+	HZDELAY(HZ / 5 + 1);
+	restore_flags(flags);
+	return(0);
 }
 
-static void
-clear_pending_ints(struct IsdnCardState *sp)
+static int
+Teles_card_msg(struct IsdnCardState *cs, int mt, void *arg)
 {
-	int val;
-	char tmp[64];
-
-	val = readhscx(sp->membase, 1, HSCX_ISTA);
-	sprintf(tmp, "HSCX B ISTA %x", val);
-	debugl1(sp, tmp);
-	if (val & 0x01) {
-		val = readhscx(sp->membase, 1, HSCX_EXIR);
-		sprintf(tmp, "HSCX B EXIR %x", val);
-		debugl1(sp, tmp);
-	} else if (val & 0x02) {
-		val = readhscx(sp->membase, 0, HSCX_EXIR);
-		sprintf(tmp, "HSCX A EXIR %x", val);
-		debugl1(sp, tmp);
-	}
-	val = readhscx(sp->membase, 0, HSCX_ISTA);
-	sprintf(tmp, "HSCX A ISTA %x", val);
-	debugl1(sp, tmp);
-	val = readhscx(sp->membase, 1, HSCX_STAR);
-	sprintf(tmp, "HSCX B STAR %x", val);
-	debugl1(sp, tmp);
-	val = readhscx(sp->membase, 0, HSCX_STAR);
-	sprintf(tmp, "HSCX A STAR %x", val);
-	debugl1(sp, tmp);
-	val = readisac(sp->membase, ISAC_STAR);
-	sprintf(tmp, "ISAC STAR %x", val);
-	debugl1(sp, tmp);
-	val = readisac(sp->membase, ISAC_MODE);
-	sprintf(tmp, "ISAC MODE %x", val);
-	debugl1(sp, tmp);
-	val = readisac(sp->membase, ISAC_ADF2);
-	sprintf(tmp, "ISAC ADF2 %x", val);
-	debugl1(sp, tmp);
-	val = readisac(sp->membase, ISAC_ISTA);
-	sprintf(tmp, "ISAC ISTA %x", val);
-	debugl1(sp, tmp);
-	if (val & 0x01) {
-		val = readisac(sp->membase, ISAC_EXIR);
-		sprintf(tmp, "ISAC EXIR %x", val);
-		debugl1(sp, tmp);
-	} else if (val & 0x04) {
-		val = readisac(sp->membase, ISAC_CIR0);
-		sprintf(tmp, "ISAC CIR0 %x", val);
-		debugl1(sp, tmp);
-	}
-	writeisac(sp->membase, ISAC_MASK, 0);
-	writeisac(sp->membase, ISAC_CMDR, 0x41);
-}
-
-int
-initteles0(struct IsdnCardState *sp)
-{
-	int ret;
-	int loop = 0;
-	char tmp[40];
-
-	sp->counter = kstat.interrupts[sp->irq];
-	sprintf(tmp, "IRQ %d count %d", sp->irq, sp->counter);
-	debugl1(sp, tmp);
-	clear_pending_ints(sp);
-	ret = get_irq(sp->cardnr, &telesS0_interrupt);
-	if (ret) {
-		initisac(sp);
-		sp->modehscx(sp->hs, 0, 0);
-		sp->modehscx(sp->hs + 1, 0, 0);
-		while (loop++ < 10) {
-			/* At least 1-3 irqs must happen
-			 * (one from HSCX A, one from HSCX B, 3rd from ISAC)
-			 */
-			if (kstat.interrupts[sp->irq] > sp->counter)
-				break;
-			current->state = TASK_INTERRUPTIBLE;
-			current->timeout = jiffies + 1;
-			schedule();
-		}
-		sprintf(tmp, "IRQ %d count %d", sp->irq,
-			kstat.interrupts[sp->irq]);
-		debugl1(sp, tmp);
-		if (kstat.interrupts[sp->irq] == sp->counter) {
-			printk(KERN_WARNING
-			       "Teles0: IRQ(%d) getting no interrupts during init\n",
-			       sp->irq);
-			irq2dev_map[sp->irq] = NULL;
-			free_irq(sp->irq, NULL);
-			return (0);
-		}
+	switch (mt) {
+		case CARD_RESET:
+			reset_teles0(cs);
+			return(0);
+		case CARD_RELEASE:
+			release_io_teles0(cs);
+			return(0);
+		case CARD_SETIRQ:
+			return(request_irq(cs->irq, &teles0_interrupt,
+					I4L_IRQ_FLAG, "HiSax", cs));
+		case CARD_INIT:
+			inithscxisac(cs, 3);
+			return(0);
+		case CARD_TEST:
+			return(0);
 	}
-	return (ret);
+	return(0);
 }
 
-int
-setup_teles0(struct IsdnCard *card)
+__initfunc(int
+setup_teles0(struct IsdnCard *card))
 {
-	u_char cfval, val, verA, verB;
-	struct IsdnCardState *sp = card->sp;
-	long flags;
+	u_char val;
+	struct IsdnCardState *cs = card->cs;
 	char tmp[64];
 
 	strcpy(tmp, teles0_revision);
-	printk(KERN_NOTICE "HiSax: Teles 8.0/16.0 driver Rev. %s\n", HiSax_getrev(tmp));
-	if ((sp->typ != ISDN_CTYPE_16_0) && (sp->typ != ISDN_CTYPE_8_0))
+	printk(KERN_INFO "HiSax: Teles 8.0/16.0 driver Rev. %s\n", HiSax_getrev(tmp));
+	if ((cs->typ != ISDN_CTYPE_16_0) && (cs->typ != ISDN_CTYPE_8_0))
 		return (0);
 
-	if (sp->typ == ISDN_CTYPE_16_0)
-		sp->cfg_reg = card->para[2];
+	if (cs->typ == ISDN_CTYPE_16_0)
+		cs->hw.teles0.cfg_reg = card->para[2];
 	else			/* 8.0 */
-		sp->cfg_reg = 0;
+		cs->hw.teles0.cfg_reg = 0;
 
 	if (card->para[1] < 0x10000) {
 		card->para[1] <<= 4;
@@ -859,110 +322,69 @@
 		   "Teles0: membase configured DOSish, assuming 0x%lx\n",
 		       (unsigned long) card->para[1]);
 	}
-	sp->membase = card->para[1];
-	sp->irq = card->para[0];
-	if (sp->cfg_reg) {
-		if (check_region((sp->cfg_reg), 8)) {
+	cs->hw.teles0.membase = card->para[1];
+	cs->irq = card->para[0];
+	if (cs->hw.teles0.cfg_reg) {
+		if (check_region((cs->hw.teles0.cfg_reg), 8)) {
 			printk(KERN_WARNING
 			  "HiSax: %s config port %x-%x already in use\n",
 			       CardType[card->typ],
-			       sp->cfg_reg,
-			       sp->cfg_reg + 8);
+			       cs->hw.teles0.cfg_reg,
+			       cs->hw.teles0.cfg_reg + 8);
 			return (0);
 		} else {
-			request_region(sp->cfg_reg, 8, "teles cfg");
+			request_region(cs->hw.teles0.cfg_reg, 8, "teles cfg");
 		}
 	}
-	switch (sp->irq) {
-		case 2:
-			cfval = 0x00;
-			break;
-		case 3:
-			cfval = 0x02;
-			break;
-		case 4:
-			cfval = 0x04;
-			break;
-		case 5:
-			cfval = 0x06;
-			break;
-		case 10:
-			cfval = 0x08;
-			break;
-		case 11:
-			cfval = 0x0A;
-			break;
-		case 12:
-			cfval = 0x0C;
-			break;
-		case 15:
-			cfval = 0x0E;
-			break;
-		default:
-			cfval = 0x00;
-			break;
-	}
-	cfval |= ((card->para[1] >> 9) & 0xF0);
-	if (sp->cfg_reg) {
-		if ((val = bytein(sp->cfg_reg + 0)) != 0x51) {
+	if (cs->hw.teles0.cfg_reg) {
+		if ((val = bytein(cs->hw.teles0.cfg_reg + 0)) != 0x51) {
 			printk(KERN_WARNING "Teles0: 16.0 Byte at %x is %x\n",
-			       sp->cfg_reg + 0, val);
-			release_region(sp->cfg_reg, 8);
+			       cs->hw.teles0.cfg_reg + 0, val);
+			release_region(cs->hw.teles0.cfg_reg, 8);
 			return (0);
 		}
-		if ((val = bytein(sp->cfg_reg + 1)) != 0x93) {
+		if ((val = bytein(cs->hw.teles0.cfg_reg + 1)) != 0x93) {
 			printk(KERN_WARNING "Teles0: 16.0 Byte at %x is %x\n",
-			       sp->cfg_reg + 1, val);
-			release_region(sp->cfg_reg, 8);
+			       cs->hw.teles0.cfg_reg + 1, val);
+			release_region(cs->hw.teles0.cfg_reg, 8);
 			return (0);
 		}
-		val = bytein(sp->cfg_reg + 2);	/* 0x1e=without AB
-						   * 0x1f=with AB
-						   * 0x1c 16.3 ???
-						 */
+		val = bytein(cs->hw.teles0.cfg_reg + 2);	/* 0x1e=without AB
+								   * 0x1f=with AB
+								   * 0x1c 16.3 ???
+								 */
 		if (val != 0x1e && val != 0x1f) {
 			printk(KERN_WARNING "Teles0: 16.0 Byte at %x is %x\n",
-			       sp->cfg_reg + 2, val);
-			release_region(sp->cfg_reg, 8);
+			       cs->hw.teles0.cfg_reg + 2, val);
+			release_region(cs->hw.teles0.cfg_reg, 8);
 			return (0);
 		}
-		save_flags(flags);
-		byteout(sp->cfg_reg + 4, cfval);
-		sti();
-		HZDELAY(HZ / 10 + 1);
-		byteout(sp->cfg_reg + 4, cfval | 1);
-		HZDELAY(HZ / 10 + 1);
-		restore_flags(flags);
 	}
-	printk(KERN_NOTICE
-	       "HiSax: %s config irq:%d mem:%x cfg:%x\n",
-	       CardType[sp->typ], sp->irq,
-	       sp->membase, sp->cfg_reg);
-	verA = readhscx(sp->membase, 0, HSCX_VSTR) & 0xf;
-	verB = readhscx(sp->membase, 1, HSCX_VSTR) & 0xf;
-	printk(KERN_INFO "Teles0: HSCX version A: %s  B: %s\n",
-	       HscxVersion(verA), HscxVersion(verB));
-	val = readisac(sp->membase, ISAC_RBCH);
-	printk(KERN_INFO "Teles0: ISAC %s\n",
-	       ISACVersion(val));
-
-	if ((verA == 0) | (verA == 0xf) | (verB == 0) | (verB == 0xf)) {
+	/* 16.0 and 8.0 designed for IOM1 */
+	test_and_set_bit(HW_IOM1, &cs->HW_Flags);
+	printk(KERN_INFO
+	       "HiSax: %s config irq:%d mem:0x%X cfg:0x%X\n",
+	       CardType[cs->typ], cs->irq,
+	       cs->hw.teles0.membase, cs->hw.teles0.cfg_reg);
+	if (reset_teles0(cs)) {
+		printk(KERN_WARNING "Teles0: wrong IRQ\n");
+		release_io_teles0(cs);
+		return (0);
+	}
+	cs->readisac = &ReadISAC;
+	cs->writeisac = &WriteISAC;
+	cs->readisacfifo = &ReadISACfifo;
+	cs->writeisacfifo = &WriteISACfifo;
+	cs->BC_Read_Reg = &ReadHSCX;
+	cs->BC_Write_Reg = &WriteHSCX;
+	cs->BC_Send_Data = &hscx_fill_fifo;
+	cs->cardmsg = &Teles_card_msg;
+	ISACVersion(cs, "Teles0:");
+	if (HscxVersion(cs, "Teles0:")) {
 		printk(KERN_WARNING
 		 "Teles0: wrong HSCX versions check IO/MEM addresses\n");
-		release_io_teles0(card);
+		release_io_teles0(cs);
 		return (0);
 	}
-	save_flags(flags);
-	writeb(0, sp->membase + 0x80);
-	sti();
-	HZDELAY(HZ / 5 + 1);
-	writeb(1, sp->membase + 0x80);
-	HZDELAY(HZ / 5 + 1);
-	restore_flags(flags);
-
-	sp->modehscx = &modehscx;
-	sp->ph_command = &ph_command;
-	sp->hscx_fill_fifo = &hscx_fill_fifo;
-	sp->isac_fill_fifo = &isac_fill_fifo;
 	return (1);
 }

FUNET's LINUX-ADM group, linux-adm@nic.funet.fi
TCL-scripts by Sam Shen, slshen@lbl.gov