patch-2.0.36 linux/drivers/isdn/hisax/teles3.c
Next file: linux/drivers/isdn/hisax/teles3c.c
Previous file: linux/drivers/isdn/hisax/teles0.c
Back to the patch index
Back to the overall index
- Lines: 1309
- Date:
Sun Nov 15 10:32:58 1998
- Orig file:
v2.0.35/linux/drivers/isdn/hisax/teles3.c
- Orig date:
Tue Aug 5 09:00:12 1997
diff -u --recursive --new-file v2.0.35/linux/drivers/isdn/hisax/teles3.c linux/drivers/isdn/hisax/teles3.c
@@ -1,4 +1,4 @@
-/* $Id: teles3.c,v 1.11 1997/04/13 19:54:05 keil Exp $
+/* $Id: teles3.c,v 1.11.2.9 1998/04/08 21:58:52 keil Exp $
* teles3.c low level stuff for Teles 16.3 & PNP isdn cards
*
@@ -11,6 +11,30 @@
* Beat Doebeli
*
* $Log: teles3.c,v $
+ * Revision 1.11.2.9 1998/04/08 21:58:52 keil
+ * New init code
+ *
+ * Revision 1.11.2.8 1998/01/27 22:37:46 keil
+ * fast io
+ *
+ * Revision 1.11.2.7 1998/01/11 22:58:01 keil
+ * make IRQ 9 working again
+ *
+ * Revision 1.11.2.6 1997/12/01 22:35:43 keil
+ * ID Byte for 16.3 version 1.1
+ *
+ * Revision 1.11.2.5 1997/11/15 18:51:03 keil
+ * new common init function
+ *
+ * Revision 1.11.2.4 1997/10/17 22:14:30 keil
+ * update to last hisax version
+ *
+ * Revision 2.1 1997/07/27 21:47:12 keil
+ * new interface structures
+ *
+ * Revision 2.0 1997/06/26 11:02:46 keil
+ * New Layer and card interface
+ *
* Revision 1.11 1997/04/13 19:54:05 keil
* Change in IRQ check delay for SMP
*
@@ -35,36 +59,20 @@
* Revision 1.6 1997/01/27 15:52:55 keil
* SMP proof,cosmetics, PCMCIA added
*
- * Revision 1.5 1997/01/21 22:28:32 keil
- * cleanups
- *
- * Revision 1.4 1996/12/14 21:05:41 keil
- * Reset for 16.3 PnP
- *
- * Revision 1.3 1996/11/05 19:56:54 keil
- * debug output fixed
- *
- * Revision 1.2 1996/10/27 22:09:15 keil
- * cosmetic changes
- *
- * Revision 1.1 1996/10/13 20:04:59 keil
- * Initial revision
- *
- *
+ * removed old log info /KKe
*
*/
#define __NO_VERSION__
-#include "siemens.h"
#include "hisax.h"
-#include "teles3.h"
+#include "isac.h"
+#include "hscx.h"
#include "isdnl1.h"
-#include <linux/kernel_stat.h>
extern const char *CardType[];
-const char *teles3_revision = "$Revision: 1.11 $";
+const char *teles3_revision = "$Revision: 1.11.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
readreg(unsigned int adr, u_char off)
@@ -82,953 +90,407 @@
static inline void
read_fifo(unsigned int adr, u_char * data, int size)
{
- insb(adr + 0x1e, data, size);
+ insb(adr, data, size);
}
static void
write_fifo(unsigned int adr, u_char * data, int size)
{
- outsb(adr + 0x1e, data, size);
-}
-
-static inline void
-waitforCEC(int adr)
-{
- int to = 50;
-
- while ((readreg(adr, HSCX_STAR) & 0x04) && to) {
- udelay(1);
- to--;
- }
- if (!to)
- printk(KERN_WARNING "Teles3: waitforCEC timeout\n");
-}
-
-
-static inline void
-waitforXFW(int adr)
-{
- int to = 50;
-
- while ((!(readreg(adr, HSCX_STAR) & 0x44) == 0x40) && to) {
- udelay(1);
- to--;
- }
- if (!to)
- printk(KERN_WARNING "Teles3: waitforXFW timeout\n");
+ outsb(adr, data, size);
}
-static inline void
-writehscxCMDR(int adr, u_char data)
-{
- long flags;
- save_flags(flags);
- cli();
- waitforCEC(adr);
- writereg(adr, HSCX_CMDR, data);
- restore_flags(flags);
-}
+/* Interface functions */
-/*
- * fast interrupt here
- */
-
-static void
-hscxreport(struct IsdnCardState *sp, int hscx)
+static u_char
+ReadISAC(struct IsdnCardState *cs, u_char offset)
{
- printk(KERN_DEBUG "HSCX %d\n", hscx);
- printk(KERN_DEBUG "ISTA %x\n", readreg(sp->hscx[hscx], HSCX_ISTA));
- printk(KERN_DEBUG "STAR %x\n", readreg(sp->hscx[hscx], HSCX_STAR));
- printk(KERN_DEBUG "EXIR %x\n", readreg(sp->hscx[hscx], HSCX_EXIR));
+ return (readreg(cs->hw.teles3.isac, offset));
}
-void
-teles3_report(struct IsdnCardState *sp)
-{
- printk(KERN_DEBUG "ISAC\n");
- printk(KERN_DEBUG "ISTA %x\n", readreg(sp->isac, ISAC_ISTA));
- printk(KERN_DEBUG "STAR %x\n", readreg(sp->isac, ISAC_STAR));
- printk(KERN_DEBUG "EXIR %x\n", readreg(sp->isac, ISAC_EXIR));
- hscxreport(sp, 0);
- hscxreport(sp, 1);
-}
-
-/*
- * HSCX stuff goes here
- */
-
static void
-hscx_empty_fifo(struct HscxState *hsp, int count)
+WriteISAC(struct IsdnCardState *cs, u_char offset, u_char value)
{
- 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->hscx[hsp->hscx], 0x80);
- hsp->rcvidx = 0;
- return;
- }
- ptr = hsp->rcvbuf + hsp->rcvidx;
- hsp->rcvidx += count;
- save_flags(flags);
- cli();
- read_fifo(sp->hscx[hsp->hscx], ptr, count);
- writehscxCMDR(sp->hscx[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);
- }
+ writereg(cs->hw.teles3.isac, offset, value);
}
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->hscx[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(sp->hscx[hsp->hscx], ptr, count);
- writehscxCMDR(sp->hscx[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)
+ReadISACfifo(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 = readreg(sp->hscx[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->hscx[hsp->hscx], 0x80);
- } else {
- count = readreg(sp->hscx[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 "teles3: 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 "teles3: 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);
- }
+ read_fifo(cs->hw.teles3.isacfifo, data, size);
}
-/*
- * ISAC stuff goes here
- */
-
static void
-isac_empty_fifo(struct IsdnCardState *sp, int count)
+WriteISACfifo(struct IsdnCardState *cs, u_char * data, int size)
{
- u_char *ptr;
- long flags;
-
- if ((sp->debug & L1_DEB_ISAC) && !(sp->debug & L1_DEB_ISAC_FIFO))
- if (sp->debug & L1_DEB_ISAC)
- 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);
- }
- writereg(sp->isac, ISAC_CMDR, 0x80);
- sp->rcvidx = 0;
- return;
- }
- ptr = sp->rcvbuf + sp->rcvidx;
- sp->rcvidx += count;
- save_flags(flags);
- cli();
- read_fifo(sp->isac, ptr, count);
- writereg(sp->isac, 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(cs->hw.teles3.isacfifo, 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(sp->isac, ptr, count);
- writereg(sp->isac, 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 (readreg(cs->hw.teles3.hscx[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);
- }
- writereg(sp->isac, ISAC_CIX0, (command << 2) | 3);
+ writereg(cs->hw.teles3.hscx[hscx], offset, value);
}
+/*
+ * fast interrupt HSCX stuff goes here
+ */
-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 = readreg(sp->isac, 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");
- writereg(sp->isac, ISAC_CMDR, 0x80);
- } else {
- count = readreg(sp->isac, 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 "AVM: 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 = (readreg(sp->isac, 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 = readreg(sp->isac, ISAC_EXIR);
- if (sp->debug & L1_DEB_WARN) {
- sprintf(tmp, "ISAC EXIR %02x", exval);
- debugl1(sp, tmp);
- }
- }
-}
-
-static inline void
-hscx_int_main(struct IsdnCardState *sp, u_char val)
-{
+#define READHSCX(cs, nr, reg) readreg(cs->hw.teles3.hscx[nr], reg)
+#define WRITEHSCX(cs, nr, reg, data) writereg(cs->hw.teles3.hscx[nr], reg, data)
+#define READHSCXFIFO(cs, nr, ptr, cnt) read_fifo(cs->hw.teles3.hscxfifo[nr], ptr, cnt)
+#define WRITEHSCXFIFO(cs, nr, ptr, cnt) write_fifo(cs->hw.teles3.hscxfifo[nr], ptr, cnt)
- u_char exval;
- struct HscxState *hsp;
- char tmp[32];
-
-
- if (val & 0x01) {
- hsp = sp->hs + 1;
- exval = readreg(sp->hscx[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->hscx[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 = readreg(sp->hscx[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->hscx[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 = readreg(sp->hscx[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
teles3_interrupt(int intno, void *dev_id, struct pt_regs *regs)
{
#define MAXCOUNT 20
- 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 "Teles: Spurious interrupt!\n");
return;
}
- val = readreg(sp->hscx[1], HSCX_ISTA);
+ val = readreg(cs->hw.teles3.hscx[1], HSCX_ISTA);
Start_HSCX:
if (val) {
- hscx_int_main(sp, val);
+ hscx_int_main(cs, val);
stat |= 1;
}
- val = readreg(sp->isac, ISAC_ISTA);
+ val = readreg(cs->hw.teles3.isac, ISAC_ISTA);
Start_ISAC:
if (val) {
- isac_interrupt(sp, val);
+ isac_interrupt(cs, val);
stat |= 2;
}
count++;
- val = readreg(sp->hscx[1], HSCX_ISTA);
+ val = readreg(cs->hw.teles3.hscx[1], HSCX_ISTA);
if (val && count < MAXCOUNT) {
- if (sp->debug & L1_DEB_HSCX)
- debugl1(sp, "HSCX IntStat after IntRoutine");
+ if (cs->debug & L1_DEB_HSCX)
+ debugl1(cs, "HSCX IntStat after IntRoutine");
goto Start_HSCX;
}
- val = readreg(sp->isac, ISAC_ISTA);
+ val = readreg(cs->hw.teles3.isac, ISAC_ISTA);
if (val && count < MAXCOUNT) {
- if (sp->debug & L1_DEB_ISAC)
- debugl1(sp, "ISAC IntStat after IntRoutine");
+ if (cs->debug & L1_DEB_ISAC)
+ debugl1(cs, "ISAC IntStat after IntRoutine");
goto Start_ISAC;
}
if (count >= MAXCOUNT)
printk(KERN_WARNING "Teles3: more than %d loops in teles3_interrupt\n", count);
if (stat & 1) {
- writereg(sp->hscx[0], HSCX_MASK, 0xFF);
- writereg(sp->hscx[1], HSCX_MASK, 0xFF);
- writereg(sp->hscx[0], HSCX_MASK, 0x0);
- writereg(sp->hscx[1], HSCX_MASK, 0x0);
+ writereg(cs->hw.teles3.hscx[0], HSCX_MASK, 0xFF);
+ writereg(cs->hw.teles3.hscx[1], HSCX_MASK, 0xFF);
+ writereg(cs->hw.teles3.hscx[0], HSCX_MASK, 0x0);
+ writereg(cs->hw.teles3.hscx[1], HSCX_MASK, 0x0);
}
if (stat & 2) {
- writereg(sp->isac, ISAC_MASK, 0xFF);
- writereg(sp->isac, ISAC_MASK, 0x0);
- }
-}
-
-
-static void
-initisac(struct IsdnCardState *sp)
-{
- unsigned int adr = sp->isac;
-
- /* 16.3 IOM 2 Mode */
- writereg(adr, ISAC_MASK, 0xff);
- writereg(adr, ISAC_ADF2, 0x80);
- writereg(adr, ISAC_SQXR, 0x2f);
- writereg(adr, ISAC_SPCR, 0x0);
- writereg(adr, ISAC_ADF1, 0x2);
- writereg(adr, ISAC_STCR, 0x70);
- writereg(adr, ISAC_MODE, 0xc9);
- writereg(adr, ISAC_TIMR, 0x0);
- writereg(adr, ISAC_ADF1, 0x0);
- writereg(adr, ISAC_CMDR, 0x41);
- writereg(adr, ISAC_CIX0, (1 << 2) | 3);
- writereg(adr, ISAC_MASK, 0xff);
- writereg(adr, ISAC_MASK, 0x0);
-}
-
-static void
-modehscx(struct HscxState *hs, int mode, int ichan)
-{
- struct IsdnCardState *sp = hs->sp;
- int hscx = hs->hscx;
-
- 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;
- writereg(sp->hscx[hscx], HSCX_CCR1, 0x85);
- writereg(sp->hscx[hscx], HSCX_XAD1, 0xFF);
- writereg(sp->hscx[hscx], HSCX_XAD2, 0xFF);
- writereg(sp->hscx[hscx], HSCX_RAH2, 0xFF);
- writereg(sp->hscx[hscx], HSCX_XBCH, 0x0);
- writereg(sp->hscx[hscx], HSCX_RLCR, 0x0);
-
- switch (mode) {
- case (0):
- writereg(sp->hscx[hscx], HSCX_CCR2, 0x30);
- writereg(sp->hscx[hscx], HSCX_TSAX, 0xff);
- writereg(sp->hscx[hscx], HSCX_TSAR, 0xff);
- writereg(sp->hscx[hscx], HSCX_XCCR, 7);
- writereg(sp->hscx[hscx], HSCX_RCCR, 7);
- writereg(sp->hscx[hscx], HSCX_MODE, 0x84);
- break;
- case (1):
- if (ichan == 0) {
- writereg(sp->hscx[hscx], HSCX_CCR2, 0x30);
- writereg(sp->hscx[hscx], HSCX_TSAX, 0x2f);
- writereg(sp->hscx[hscx], HSCX_TSAR, 0x2f);
- writereg(sp->hscx[hscx], HSCX_XCCR, 7);
- writereg(sp->hscx[hscx], HSCX_RCCR, 7);
- } else {
- writereg(sp->hscx[hscx], HSCX_CCR2, 0x30);
- writereg(sp->hscx[hscx], HSCX_TSAX, 0x3);
- writereg(sp->hscx[hscx], HSCX_TSAR, 0x3);
- writereg(sp->hscx[hscx], HSCX_XCCR, 7);
- writereg(sp->hscx[hscx], HSCX_RCCR, 7);
- }
- writereg(sp->hscx[hscx], HSCX_MODE, 0xe4);
- writereg(sp->hscx[hscx], HSCX_CMDR, 0x41);
- break;
- case (2):
- if (ichan == 0) {
- writereg(sp->hscx[hscx], HSCX_CCR2, 0x30);
- writereg(sp->hscx[hscx], HSCX_TSAX, 0x2f);
- writereg(sp->hscx[hscx], HSCX_TSAR, 0x2f);
- writereg(sp->hscx[hscx], HSCX_XCCR, 7);
- writereg(sp->hscx[hscx], HSCX_RCCR, 7);
- } else {
- writereg(sp->hscx[hscx], HSCX_CCR2, 0x30);
- writereg(sp->hscx[hscx], HSCX_TSAX, 0x3);
- writereg(sp->hscx[hscx], HSCX_TSAR, 0x3);
- writereg(sp->hscx[hscx], HSCX_XCCR, 7);
- writereg(sp->hscx[hscx], HSCX_RCCR, 7);
- }
- writereg(sp->hscx[hscx], HSCX_MODE, 0x8c);
- writereg(sp->hscx[hscx], HSCX_CMDR, 0x41);
- break;
+ writereg(cs->hw.teles3.isac, ISAC_MASK, 0xFF);
+ writereg(cs->hw.teles3.isac, ISAC_MASK, 0x0);
}
- writereg(sp->hscx[hscx], HSCX_ISTA, 0x00);
}
inline static void
-release_ioregs(struct IsdnCard *card, int mask)
+release_ioregs(struct IsdnCardState *cs, int mask)
{
if (mask & 1)
- release_region(card->sp->isac, 32);
+ release_region(cs->hw.teles3.isac + 32, 32);
if (mask & 2)
- release_region(card->sp->hscx[0], 32);
+ release_region(cs->hw.teles3.hscx[0] + 32, 32);
if (mask & 4)
- release_region(card->sp->hscx[1], 32);
+ release_region(cs->hw.teles3.hscx[1] + 32, 32);
}
void
-release_io_teles3(struct IsdnCard *card)
+release_io_teles3(struct IsdnCardState *cs)
{
- if (card->sp->typ == ISDN_CTYPE_TELESPCMCIA)
- release_region(card->sp->hscx[0], 97);
+ if (cs->typ == ISDN_CTYPE_TELESPCMCIA)
+ release_region(cs->hw.teles3.cfg_reg, 97);
else {
- if (card->sp->cfg_reg)
- release_region(card->sp->cfg_reg, 8);
- release_ioregs(card, 0x7);
+ if (cs->hw.teles3.cfg_reg)
+ if (cs->typ == ISDN_CTYPE_COMPAQ_ISA) {
+ release_region(cs->hw.teles3.cfg_reg, 1);
+ } else {
+ release_region(cs->hw.teles3.cfg_reg, 8);
+ }
+ release_ioregs(cs, 0x7);
}
}
-static void
-clear_pending_ints(struct IsdnCardState *sp)
+static int
+reset_teles3(struct IsdnCardState *cs)
{
- int val;
- char tmp[64];
-
- val = readreg(sp->hscx[1], HSCX_ISTA);
- sprintf(tmp, "HSCX B ISTA %x", val);
- debugl1(sp, tmp);
- if (val & 0x01) {
- val = readreg(sp->hscx[1], HSCX_EXIR);
- sprintf(tmp, "HSCX B EXIR %x", val);
- debugl1(sp, tmp);
- } else if (val & 0x02) {
- val = readreg(sp->hscx[0], HSCX_EXIR);
- sprintf(tmp, "HSCX A EXIR %x", val);
- debugl1(sp, tmp);
- }
- val = readreg(sp->hscx[0], HSCX_ISTA);
- sprintf(tmp, "HSCX A ISTA %x", val);
- debugl1(sp, tmp);
- val = readreg(sp->hscx[1], HSCX_STAR);
- sprintf(tmp, "HSCX B STAR %x", val);
- debugl1(sp, tmp);
- val = readreg(sp->hscx[0], HSCX_STAR);
- sprintf(tmp, "HSCX A STAR %x", val);
- debugl1(sp, tmp);
- val = readreg(sp->isac, ISAC_STAR);
- sprintf(tmp, "ISAC STAR %x", val);
- debugl1(sp, tmp);
- val = readreg(sp->isac, ISAC_MODE);
- sprintf(tmp, "ISAC MODE %x", val);
- debugl1(sp, tmp);
- val = readreg(sp->isac, ISAC_ADF2);
- sprintf(tmp, "ISAC ADF2 %x", val);
- debugl1(sp, tmp);
- val = readreg(sp->isac, ISAC_ISTA);
- sprintf(tmp, "ISAC ISTA %x", val);
- debugl1(sp, tmp);
- if (val & 0x01) {
- val = readreg(sp->isac, ISAC_EXIR);
- sprintf(tmp, "ISAC EXIR %x", val);
- debugl1(sp, tmp);
- } else if (val & 0x04) {
- val = readreg(sp->isac, ISAC_CIR0);
- sprintf(tmp, "ISAC CIR0 %x", val);
- debugl1(sp, tmp);
- }
- writereg(sp->isac, ISAC_MASK, 0);
- writereg(sp->isac, ISAC_CMDR, 0x41);
-}
+ long flags;
+ u_char irqcfg;
-int
-initteles3(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, &teles3_interrupt);
- if (ret) {
- initisac(sp);
- sp->modehscx(sp->hs, 0, 0);
- writereg(sp->hscx[sp->hs->hscx], HSCX_CMDR, 0x01);
- sp->modehscx(sp->hs + 1, 0, 0);
- writereg(sp->hscx[(sp->hs + 1)->hscx], HSCX_CMDR, 0x01);
- 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 loop %d", sp->irq,
- kstat.interrupts[sp->irq], loop);
- debugl1(sp, tmp);
- if (kstat.interrupts[sp->irq] <= sp->counter) {
- printk(KERN_WARNING
- "Teles3: IRQ(%d) getting no interrupts during init\n",
- sp->irq);
- irq2dev_map[sp->irq] = NULL;
- free_irq(sp->irq, NULL);
- return (0);
- }
+ if (cs->typ != ISDN_CTYPE_TELESPCMCIA) {
+ if ((cs->hw.teles3.cfg_reg) && (cs->typ != ISDN_CTYPE_COMPAQ_ISA)) {
+ switch (cs->irq) {
+ case 2:
+ case 9:
+ irqcfg = 0x00;
+ break;
+ case 3:
+ irqcfg = 0x02;
+ break;
+ case 4:
+ irqcfg = 0x04;
+ break;
+ case 5:
+ irqcfg = 0x06;
+ break;
+ case 10:
+ irqcfg = 0x08;
+ break;
+ case 11:
+ irqcfg = 0x0A;
+ break;
+ case 12:
+ irqcfg = 0x0C;
+ break;
+ case 15:
+ irqcfg = 0x0E;
+ break;
+ default:
+ return(1);
+ }
+ save_flags(flags);
+ byteout(cs->hw.teles3.cfg_reg + 4, irqcfg);
+ sti();
+ HZDELAY(HZ / 10 + 1);
+ byteout(cs->hw.teles3.cfg_reg + 4, irqcfg | 1);
+ HZDELAY(HZ / 10 + 1);
+ restore_flags(flags);
+ } else if (cs->typ == ISDN_CTYPE_COMPAQ_ISA) {
+ save_flags(flags);
+ byteout(cs->hw.teles3.cfg_reg, 0xff);
+ HZDELAY(2);
+ byteout(cs->hw.teles3.cfg_reg, 0x00);
+ HZDELAY(2);
+ restore_flags(flags);
+ } else {
+ /* Reset off for 16.3 PnP , thanks to Georg Acher */
+ save_flags(flags);
+ byteout(cs->hw.teles3.isac + 0x3c, 0);
+ HZDELAY(2);
+ byteout(cs->hw.teles3.isac + 0x3c, 1);
+ HZDELAY(2);
+ restore_flags(flags);
+ }
+ }
+ return(0);
+}
+
+static int
+Teles_card_msg(struct IsdnCardState *cs, int mt, void *arg)
+{
+ switch (mt) {
+ case CARD_RESET:
+ reset_teles3(cs);
+ return(0);
+ case CARD_RELEASE:
+ release_io_teles3(cs);
+ return(0);
+ case CARD_SETIRQ:
+ return(request_irq(cs->irq, &teles3_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_teles3(struct IsdnCard *card)
+__initfunc(int
+setup_teles3(struct IsdnCard *card))
{
- u_char cfval = 0, val, verA, verB;
- struct IsdnCardState *sp = card->sp;
- long flags;
+ u_char val;
+ struct IsdnCardState *cs = card->cs;
char tmp[64];
strcpy(tmp, teles3_revision);
- printk(KERN_NOTICE "HiSax: Teles IO driver Rev. %s\n", HiSax_getrev(tmp));
- if ((sp->typ != ISDN_CTYPE_16_3) && (sp->typ != ISDN_CTYPE_PNP)
- && (sp->typ != ISDN_CTYPE_TELESPCMCIA))
+ printk(KERN_INFO "HiSax: Teles IO driver Rev. %s\n", HiSax_getrev(tmp));
+ if ((cs->typ != ISDN_CTYPE_16_3) && (cs->typ != ISDN_CTYPE_PNP)
+ && (cs->typ != ISDN_CTYPE_TELESPCMCIA) && (cs->typ != ISDN_CTYPE_COMPAQ_ISA))
return (0);
- if (sp->typ == ISDN_CTYPE_16_3) {
- sp->cfg_reg = card->para[1];
- switch (sp->cfg_reg) {
+ if (cs->typ == ISDN_CTYPE_16_3) {
+ cs->hw.teles3.cfg_reg = card->para[1];
+ switch (cs->hw.teles3.cfg_reg) {
case 0x180:
case 0x280:
case 0x380:
- sp->cfg_reg |= 0xc00;
+ cs->hw.teles3.cfg_reg |= 0xc00;
break;
}
- sp->isac = sp->cfg_reg - 0x400;
- sp->hscx[0] = sp->cfg_reg - 0xc00;
- sp->hscx[1] = sp->cfg_reg - 0x800;
- } else if (sp->typ == ISDN_CTYPE_TELESPCMCIA) {
- sp->cfg_reg = 0;
- sp->hscx[0] = card->para[1];
- sp->hscx[1] = card->para[1] + 0x20;
- sp->isac = card->para[1] + 0x40;
- } else { /* PNP */
- sp->cfg_reg = 0;
- sp->isac = card->para[1];
- sp->hscx[0] = card->para[2];
- sp->hscx[1] = card->para[2] + 0x20;
- }
- sp->irq = card->para[0];
- if (sp->typ == ISDN_CTYPE_TELESPCMCIA) {
- if (check_region((sp->hscx[0]), 97)) {
+ cs->hw.teles3.isac = cs->hw.teles3.cfg_reg - 0x420;
+ cs->hw.teles3.hscx[0] = cs->hw.teles3.cfg_reg - 0xc20;
+ cs->hw.teles3.hscx[1] = cs->hw.teles3.cfg_reg - 0x820;
+ } else if (cs->typ == ISDN_CTYPE_TELESPCMCIA) {
+ cs->hw.teles3.cfg_reg = card->para[1];
+ cs->hw.teles3.hscx[0] = card->para[1] - 0x20;
+ cs->hw.teles3.hscx[1] = card->para[1];
+ cs->hw.teles3.isac = card->para[1] + 0x20;
+ } else if (cs->typ == ISDN_CTYPE_COMPAQ_ISA) {
+ cs->hw.teles3.cfg_reg = card->para[3];
+ cs->hw.teles3.isac = card->para[2] - 32;
+ cs->hw.teles3.hscx[0] = card->para[1] - 32;
+ cs->hw.teles3.hscx[1] = card->para[1];
+ } else { /* PNP */
+ cs->hw.teles3.cfg_reg = 0;
+ cs->hw.teles3.isac = card->para[1] - 32;
+ cs->hw.teles3.hscx[0] = card->para[2] - 32;
+ cs->hw.teles3.hscx[1] = card->para[2];
+ }
+ cs->irq = card->para[0];
+ cs->hw.teles3.isacfifo = cs->hw.teles3.isac + 0x3e;
+ cs->hw.teles3.hscxfifo[0] = cs->hw.teles3.hscx[0] + 0x3e;
+ cs->hw.teles3.hscxfifo[1] = cs->hw.teles3.hscx[1] + 0x3e;
+ if (cs->typ == ISDN_CTYPE_TELESPCMCIA) {
+ if (check_region((cs->hw.teles3.cfg_reg), 97)) {
printk(KERN_WARNING
"HiSax: %s ports %x-%x already in use\n",
- CardType[sp->typ],
- sp->hscx[0],
- sp->hscx[0] + 96);
+ CardType[cs->typ],
+ cs->hw.teles3.cfg_reg,
+ cs->hw.teles3.cfg_reg + 96);
return (0);
} else
- request_region(sp->hscx[0], 97, "HiSax Teles PCMCIA");
+ request_region(cs->hw.teles3.hscx[0], 97, "HiSax Teles PCMCIA");
} else {
- if (sp->cfg_reg) {
- if (check_region((sp->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);
- return (0);
+ if (cs->hw.teles3.cfg_reg) {
+ if (cs->typ == ISDN_CTYPE_COMPAQ_ISA) {
+ if (check_region((cs->hw.teles3.cfg_reg), 1)) {
+ printk(KERN_WARNING
+ "HiSax: %s config port %x already in use\n",
+ CardType[card->typ],
+ cs->hw.teles3.cfg_reg);
+ return (0);
+ } else
+ request_region(cs->hw.teles3.cfg_reg, 1, "teles3 cfg");
} else {
- request_region(sp->cfg_reg, 8, "teles3 cfg");
+ if (check_region((cs->hw.teles3.cfg_reg), 8)) {
+ printk(KERN_WARNING
+ "HiSax: %s config port %x-%x already in use\n",
+ CardType[card->typ],
+ cs->hw.teles3.cfg_reg,
+ cs->hw.teles3.cfg_reg + 8);
+ return (0);
+ } else
+ request_region(cs->hw.teles3.cfg_reg, 8, "teles3 cfg");
}
}
- if (check_region((sp->isac), 32)) {
+ if (check_region((cs->hw.teles3.isac + 32), 32)) {
printk(KERN_WARNING
"HiSax: %s isac ports %x-%x already in use\n",
- CardType[sp->typ],
- sp->isac,
- sp->isac + 32);
- if (sp->cfg_reg) {
- release_region(sp->cfg_reg, 8);
- }
+ CardType[cs->typ],
+ cs->hw.teles3.isac + 32,
+ cs->hw.teles3.isac + 64);
+ if (cs->hw.teles3.cfg_reg)
+ if (cs->typ == ISDN_CTYPE_COMPAQ_ISA) {
+ release_region(cs->hw.teles3.cfg_reg, 1);
+ } else {
+ release_region(cs->hw.teles3.cfg_reg, 8);
+ }
return (0);
- } else {
- request_region(sp->isac, 32, "HiSax isac");
- }
- if (check_region((sp->hscx[0]), 32)) {
+ } else
+ request_region(cs->hw.teles3.isac + 32, 32, "HiSax isac");
+ if (check_region((cs->hw.teles3.hscx[0] + 32), 32)) {
printk(KERN_WARNING
"HiSax: %s hscx A ports %x-%x already in use\n",
- CardType[sp->typ],
- sp->hscx[0],
- sp->hscx[0] + 32);
- if (sp->cfg_reg) {
- release_region(sp->cfg_reg, 8);
- }
- release_ioregs(card, 1);
+ CardType[cs->typ],
+ cs->hw.teles3.hscx[0] + 32,
+ cs->hw.teles3.hscx[0] + 64);
+ if (cs->hw.teles3.cfg_reg)
+ if (cs->typ == ISDN_CTYPE_COMPAQ_ISA) {
+ release_region(cs->hw.teles3.cfg_reg, 1);
+ } else {
+ release_region(cs->hw.teles3.cfg_reg, 8);
+ }
+ release_ioregs(cs, 1);
return (0);
- } else {
- request_region(sp->hscx[0], 32, "HiSax hscx A");
- }
- if (check_region((sp->hscx[1]), 32)) {
+ } else
+ request_region(cs->hw.teles3.hscx[0] + 32, 32, "HiSax hscx A");
+ if (check_region((cs->hw.teles3.hscx[1] + 32), 32)) {
printk(KERN_WARNING
"HiSax: %s hscx B ports %x-%x already in use\n",
- CardType[sp->typ],
- sp->hscx[1],
- sp->hscx[1] + 32);
- if (sp->cfg_reg) {
- release_region(sp->cfg_reg, 8);
- }
- release_ioregs(card, 3);
+ CardType[cs->typ],
+ cs->hw.teles3.hscx[1] + 32,
+ cs->hw.teles3.hscx[1] + 64);
+ if (cs->hw.teles3.cfg_reg)
+ if (cs->typ == ISDN_CTYPE_COMPAQ_ISA) {
+ release_region(cs->hw.teles3.cfg_reg, 1);
+ } else {
+ release_region(cs->hw.teles3.cfg_reg, 8);
+ }
+ release_ioregs(cs, 3);
return (0);
- } else {
- request_region(sp->hscx[1], 32, "HiSax hscx B");
- }
- 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;
- }
+ } else
+ request_region(cs->hw.teles3.hscx[1] + 32, 32, "HiSax hscx B");
}
- if (sp->cfg_reg) {
- if ((val = bytein(sp->cfg_reg + 0)) != 0x51) {
+ if ((cs->hw.teles3.cfg_reg) && (cs->typ != ISDN_CTYPE_COMPAQ_ISA)) {
+ if ((val = bytein(cs->hw.teles3.cfg_reg + 0)) != 0x51) {
printk(KERN_WARNING "Teles: 16.3 Byte at %x is %x\n",
- sp->cfg_reg + 0, val);
- release_io_teles3(card);
+ cs->hw.teles3.cfg_reg + 0, val);
+ release_io_teles3(cs);
return (0);
}
- if ((val = bytein(sp->cfg_reg + 1)) != 0x93) {
+ if ((val = bytein(cs->hw.teles3.cfg_reg + 1)) != 0x93) {
printk(KERN_WARNING "Teles: 16.3 Byte at %x is %x\n",
- sp->cfg_reg + 1, val);
- release_io_teles3(card);
+ cs->hw.teles3.cfg_reg + 1, val);
+ release_io_teles3(cs);
return (0);
}
- val = bytein(sp->cfg_reg + 2); /* 0x1e=without AB
- * 0x1f=with AB
- * 0x1c 16.3 ???
- * 0x46 16.3 with AB + Video (Teles-Vision)
- */
- if (val != 0x46 && val != 0x1c && val != 0x1e && val != 0x1f) {
+ val = bytein(cs->hw.teles3.cfg_reg + 2);/* 0x1e=without AB
+ * 0x1f=with AB
+ * 0x1c 16.3 ???
+ * 0x39 16.3 1.1
+ * 0x46 16.3 with AB + Video (Teles-Vision)
+ */
+ if (val != 0x46 && val != 0x39 && val != 0x1c && val != 0x1e && val != 0x1f) {
printk(KERN_WARNING "Teles: 16.3 Byte at %x is %x\n",
- sp->cfg_reg + 2, val);
- release_io_teles3(card);
+ cs->hw.teles3.cfg_reg + 2, val);
+ release_io_teles3(cs);
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);
- } else {
- /* Reset off for 16.3 PnP , thanks to Georg Acher */
- save_flags(flags);
- byteout(sp->isac + 0x1c, 1);
- HZDELAY(2);
- restore_flags(flags);
}
- printk(KERN_NOTICE
- "HiSax: %s config irq:%d isac:%x cfg:%x\n",
- CardType[sp->typ], sp->irq,
- sp->isac, sp->cfg_reg);
- printk(KERN_NOTICE
- "HiSax: hscx A:%x hscx B:%x\n",
- sp->hscx[0], sp->hscx[1]);
- verA = readreg(sp->hscx[0], HSCX_VSTR) & 0xf;
- verB = readreg(sp->hscx[1], HSCX_VSTR) & 0xf;
- printk(KERN_INFO "Teles3: HSCX version A: %s B: %s\n",
- HscxVersion(verA), HscxVersion(verB));
- val = readreg(sp->isac, ISAC_RBCH);
- printk(KERN_INFO "Teles3: ISAC %s\n",
- ISACVersion(val));
- if ((verA == 0) | (verA == 0xf) | (verB == 0) | (verB == 0xf)) {
+ printk(KERN_INFO
+ "HiSax: %s config irq:%d isac:0x%X cfg:0x%X\n",
+ CardType[cs->typ], cs->irq,
+ cs->hw.teles3.isac + 32, cs->hw.teles3.cfg_reg);
+ printk(KERN_INFO
+ "HiSax: hscx A:0x%X hscx B:0x%X\n",
+ cs->hw.teles3.hscx[0] + 32, cs->hw.teles3.hscx[1] + 32);
+
+ if (reset_teles3(cs)) {
+ printk(KERN_WARNING "Teles3: wrong IRQ\n");
+ release_io_teles3(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, "Teles3:");
+ if (HscxVersion(cs, "Teles3:")) {
printk(KERN_WARNING
"Teles3: wrong HSCX versions check IO address\n");
- release_io_teles3(card);
+ release_io_teles3(cs);
return (0);
}
- 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