📄 asuscom.c
字号:
/* $Id: asuscom.c,v 1.14.2.4 2004/01/13 23:48:39 keil Exp $ * * low level stuff for ASUSCOM NETWORK INC. ISDNLink cards * * Author Karsten Keil * Copyright by Karsten Keil <keil@isdn4linux.de> * * This software may be used and distributed according to the terms * of the GNU General Public License, incorporated herein by reference. * * Thanks to ASUSCOM NETWORK INC. Taiwan and Dynalink NL for information * */#include <linux/init.h>#include <linux/isapnp.h>#include "hisax.h"#include "isac.h"#include "ipac.h"#include "hscx.h"#include "isdnl1.h"extern const char *CardType[];static const char *Asuscom_revision = "$Revision: 1.14.2.4 $";#define byteout(addr,val) outb(val,addr)#define bytein(addr) inb(addr)#define ASUS_ISAC 0#define ASUS_HSCX 1#define ASUS_ADR 2#define ASUS_CTRL_U7 3#define ASUS_CTRL_POTS 5#define ASUS_IPAC_ALE 0#define ASUS_IPAC_DATA 1#define ASUS_ISACHSCX 1#define ASUS_IPAC 2/* CARD_ADR (Write) */#define ASUS_RESET 0x80 /* Bit 7 Reset-Leitung */static inline u_charreadreg(unsigned int ale, unsigned int adr, u_char off){ register u_char ret; byteout(ale, off); ret = bytein(adr); return (ret);}static inline voidreadfifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int size){ byteout(ale, off); insb(adr, data, size);}static inline voidwritereg(unsigned int ale, unsigned int adr, u_char off, u_char data){ byteout(ale, off); byteout(adr, data);}static inline voidwritefifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int size){ byteout(ale, off); outsb(adr, data, size);}/* Interface functions */static u_charReadISAC(struct IsdnCardState *cs, u_char offset){ return (readreg(cs->hw.asus.adr, cs->hw.asus.isac, offset));}static voidWriteISAC(struct IsdnCardState *cs, u_char offset, u_char value){ writereg(cs->hw.asus.adr, cs->hw.asus.isac, offset, value);}static voidReadISACfifo(struct IsdnCardState *cs, u_char * data, int size){ readfifo(cs->hw.asus.adr, cs->hw.asus.isac, 0, data, size);}static voidWriteISACfifo(struct IsdnCardState *cs, u_char * data, int size){ writefifo(cs->hw.asus.adr, cs->hw.asus.isac, 0, data, size);}static u_charReadISAC_IPAC(struct IsdnCardState *cs, u_char offset){ return (readreg(cs->hw.asus.adr, cs->hw.asus.isac, offset|0x80));}static voidWriteISAC_IPAC(struct IsdnCardState *cs, u_char offset, u_char value){ writereg(cs->hw.asus.adr, cs->hw.asus.isac, offset|0x80, value);}static voidReadISACfifo_IPAC(struct IsdnCardState *cs, u_char * data, int size){ readfifo(cs->hw.asus.adr, cs->hw.asus.isac, 0x80, data, size);}static voidWriteISACfifo_IPAC(struct IsdnCardState *cs, u_char * data, int size){ writefifo(cs->hw.asus.adr, cs->hw.asus.isac, 0x80, data, size);}static u_charReadHSCX(struct IsdnCardState *cs, int hscx, u_char offset){ return (readreg(cs->hw.asus.adr, cs->hw.asus.hscx, offset + (hscx ? 0x40 : 0)));}static voidWriteHSCX(struct IsdnCardState *cs, int hscx, u_char offset, u_char value){ writereg(cs->hw.asus.adr, cs->hw.asus.hscx, offset + (hscx ? 0x40 : 0), value);}/* * fast interrupt HSCX stuff goes here */#define READHSCX(cs, nr, reg) readreg(cs->hw.asus.adr, \ cs->hw.asus.hscx, reg + (nr ? 0x40 : 0))#define WRITEHSCX(cs, nr, reg, data) writereg(cs->hw.asus.adr, \ cs->hw.asus.hscx, reg + (nr ? 0x40 : 0), data)#define READHSCXFIFO(cs, nr, ptr, cnt) readfifo(cs->hw.asus.adr, \ cs->hw.asus.hscx, (nr ? 0x40 : 0), ptr, cnt)#define WRITEHSCXFIFO(cs, nr, ptr, cnt) writefifo(cs->hw.asus.adr, \ cs->hw.asus.hscx, (nr ? 0x40 : 0), ptr, cnt)#include "hscx_irq.c"static irqreturn_tasuscom_interrupt(int intno, void *dev_id, struct pt_regs *regs){ struct IsdnCardState *cs = dev_id; u_char val; u_long flags; spin_lock_irqsave(&cs->lock, flags); val = readreg(cs->hw.asus.adr, cs->hw.asus.hscx, HSCX_ISTA + 0x40); Start_HSCX: if (val) hscx_int_main(cs, val); val = readreg(cs->hw.asus.adr, cs->hw.asus.isac, ISAC_ISTA); Start_ISAC: if (val) isac_interrupt(cs, val); val = readreg(cs->hw.asus.adr, cs->hw.asus.hscx, HSCX_ISTA + 0x40); if (val) { if (cs->debug & L1_DEB_HSCX) debugl1(cs, "HSCX IntStat after IntRoutine"); goto Start_HSCX; } val = readreg(cs->hw.asus.adr, cs->hw.asus.isac, ISAC_ISTA); if (val) { if (cs->debug & L1_DEB_ISAC) debugl1(cs, "ISAC IntStat after IntRoutine"); goto Start_ISAC; } writereg(cs->hw.asus.adr, cs->hw.asus.hscx, HSCX_MASK, 0xFF); writereg(cs->hw.asus.adr, cs->hw.asus.hscx, HSCX_MASK + 0x40, 0xFF); writereg(cs->hw.asus.adr, cs->hw.asus.isac, ISAC_MASK, 0xFF); writereg(cs->hw.asus.adr, cs->hw.asus.isac, ISAC_MASK, 0x0); writereg(cs->hw.asus.adr, cs->hw.asus.hscx, HSCX_MASK, 0x0); writereg(cs->hw.asus.adr, cs->hw.asus.hscx, HSCX_MASK + 0x40, 0x0); spin_unlock_irqrestore(&cs->lock, flags); return IRQ_HANDLED;}static irqreturn_tasuscom_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs){ struct IsdnCardState *cs = dev_id; u_char ista, val, icnt = 5; u_long flags; spin_lock_irqsave(&cs->lock, flags); ista = readreg(cs->hw.asus.adr, cs->hw.asus.isac, IPAC_ISTA);Start_IPAC: if (cs->debug & L1_DEB_IPAC) debugl1(cs, "IPAC ISTA %02X", ista); if (ista & 0x0f) { val = readreg(cs->hw.asus.adr, cs->hw.asus.hscx, HSCX_ISTA + 0x40); if (ista & 0x01) val |= 0x01; if (ista & 0x04) val |= 0x02; if (ista & 0x08) val |= 0x04; if (val) hscx_int_main(cs, val); } if (ista & 0x20) { val = 0xfe & readreg(cs->hw.asus.adr, cs->hw.asus.isac, ISAC_ISTA | 0x80); if (val) { isac_interrupt(cs, val); } } if (ista & 0x10) { val = 0x01; isac_interrupt(cs, val); } ista = readreg(cs->hw.asus.adr, cs->hw.asus.isac, IPAC_ISTA); if ((ista & 0x3f) && icnt) { icnt--; goto Start_IPAC; } if (!icnt) printk(KERN_WARNING "ASUS IRQ LOOP\n"); writereg(cs->hw.asus.adr, cs->hw.asus.isac, IPAC_MASK, 0xFF); writereg(cs->hw.asus.adr, cs->hw.asus.isac, IPAC_MASK, 0xC0); spin_unlock_irqrestore(&cs->lock, flags); return IRQ_HANDLED;}static voidrelease_io_asuscom(struct IsdnCardState *cs){ int bytecnt = 8; if (cs->hw.asus.cfg_reg) release_region(cs->hw.asus.cfg_reg, bytecnt);}static voidreset_asuscom(struct IsdnCardState *cs){ if (cs->subtyp == ASUS_IPAC) writereg(cs->hw.asus.adr, cs->hw.asus.isac, IPAC_POTA2, 0x20); else byteout(cs->hw.asus.adr, ASUS_RESET); /* Reset On */ mdelay(10); if (cs->subtyp == ASUS_IPAC) writereg(cs->hw.asus.adr, cs->hw.asus.isac, IPAC_POTA2, 0x0); else byteout(cs->hw.asus.adr, 0); /* Reset Off */ mdelay(10); if (cs->subtyp == ASUS_IPAC) { writereg(cs->hw.asus.adr, cs->hw.asus.isac, IPAC_CONF, 0x0); writereg(cs->hw.asus.adr, cs->hw.asus.isac, IPAC_ACFG, 0xff); writereg(cs->hw.asus.adr, cs->hw.asus.isac, IPAC_AOE, 0x0); writereg(cs->hw.asus.adr, cs->hw.asus.isac, IPAC_MASK, 0xc0); writereg(cs->hw.asus.adr, cs->hw.asus.isac, IPAC_PCFG, 0x12); }}static intAsus_card_msg(struct IsdnCardState *cs, int mt, void *arg){ u_long flags; switch (mt) { case CARD_RESET: spin_lock_irqsave(&cs->lock, flags); reset_asuscom(cs); spin_unlock_irqrestore(&cs->lock, flags); return(0); case CARD_RELEASE: release_io_asuscom(cs); return(0); case CARD_INIT: spin_lock_irqsave(&cs->lock, flags); cs->debug |= L1_DEB_IPAC; inithscxisac(cs, 3); spin_unlock_irqrestore(&cs->lock, flags); return(0); case CARD_TEST: return(0); } return(0);}#ifdef __ISAPNP__static struct isapnp_device_id asus_ids[] __initdata = { { ISAPNP_VENDOR('A', 'S', 'U'), ISAPNP_FUNCTION(0x1688), ISAPNP_VENDOR('A', 'S', 'U'), ISAPNP_FUNCTION(0x1688), (unsigned long) "Asus1688 PnP" }, { ISAPNP_VENDOR('A', 'S', 'U'), ISAPNP_FUNCTION(0x1690), ISAPNP_VENDOR('A', 'S', 'U'), ISAPNP_FUNCTION(0x1690), (unsigned long) "Asus1690 PnP" }, { ISAPNP_VENDOR('S', 'I', 'E'), ISAPNP_FUNCTION(0x0020), ISAPNP_VENDOR('S', 'I', 'E'), ISAPNP_FUNCTION(0x0020), (unsigned long) "Isurf2 PnP" }, { ISAPNP_VENDOR('E', 'L', 'F'), ISAPNP_FUNCTION(0x0000), ISAPNP_VENDOR('E', 'L', 'F'), ISAPNP_FUNCTION(0x0000), (unsigned long) "Iscas TE320" }, { 0, }};static struct isapnp_device_id *ipid __initdata = &asus_ids[0];static struct pnp_card *pnp_c __devinitdata = NULL;#endifint __initsetup_asuscom(struct IsdnCard *card){ int bytecnt; struct IsdnCardState *cs = card->cs; u_char val; char tmp[64]; strcpy(tmp, Asuscom_revision); printk(KERN_INFO "HiSax: Asuscom ISDNLink driver Rev. %s\n", HiSax_getrev(tmp)); if (cs->typ != ISDN_CTYPE_ASUSCOM) return (0);#ifdef __ISAPNP__ if (!card->para[1] && isapnp_present()) { struct pnp_dev *pnp_d; while(ipid->card_vendor) { if ((pnp_c = pnp_find_card(ipid->card_vendor, ipid->card_device, pnp_c))) { pnp_d = NULL; if ((pnp_d = pnp_find_dev(pnp_c, ipid->vendor, ipid->function, pnp_d))) { int err; printk(KERN_INFO "HiSax: %s detected\n", (char *)ipid->driver_data); pnp_disable_dev(pnp_d); err = pnp_activate_dev(pnp_d); if (err<0) { printk(KERN_WARNING "%s: pnp_activate_dev ret(%d)\n", __FUNCTION__, err); return(0); } card->para[1] = pnp_port_start(pnp_d, 0); card->para[0] = pnp_irq(pnp_d, 0); if (!card->para[0] || !card->para[1]) { printk(KERN_ERR "AsusPnP:some resources are missing %ld/%lx\n", card->para[0], card->para[1]); pnp_disable_dev(pnp_d); return(0); } break; } else { printk(KERN_ERR "AsusPnP: PnP error card found, no device\n"); } } ipid++; pnp_c = NULL; } if (!ipid->card_vendor) { printk(KERN_INFO "AsusPnP: no ISAPnP card found\n"); return(0); } }#endif bytecnt = 8; cs->hw.asus.cfg_reg = card->para[1]; cs->irq = card->para[0]; if (!request_region(cs->hw.asus.cfg_reg, bytecnt, "asuscom isdn")) { printk(KERN_WARNING "HiSax: %s config port %x-%x already in use\n", CardType[card->typ], cs->hw.asus.cfg_reg, cs->hw.asus.cfg_reg + bytecnt); return (0); } printk(KERN_INFO "ISDNLink: defined at 0x%x IRQ %d\n", cs->hw.asus.cfg_reg, cs->irq); setup_isac(cs); cs->BC_Read_Reg = &ReadHSCX; cs->BC_Write_Reg = &WriteHSCX; cs->BC_Send_Data = &hscx_fill_fifo; cs->cardmsg = &Asus_card_msg; val = readreg(cs->hw.asus.cfg_reg + ASUS_IPAC_ALE, cs->hw.asus.cfg_reg + ASUS_IPAC_DATA, IPAC_ID); if ((val == 1) || (val == 2)) { cs->subtyp = ASUS_IPAC; cs->hw.asus.adr = cs->hw.asus.cfg_reg + ASUS_IPAC_ALE; cs->hw.asus.isac = cs->hw.asus.cfg_reg + ASUS_IPAC_DATA; cs->hw.asus.hscx = cs->hw.asus.cfg_reg + ASUS_IPAC_DATA; test_and_set_bit(HW_IPAC, &cs->HW_Flags); cs->readisac = &ReadISAC_IPAC; cs->writeisac = &WriteISAC_IPAC; cs->readisacfifo = &ReadISACfifo_IPAC; cs->writeisacfifo = &WriteISACfifo_IPAC; cs->irq_func = &asuscom_interrupt_ipac; printk(KERN_INFO "Asus: IPAC version %x\n", val); } else { cs->subtyp = ASUS_ISACHSCX; cs->hw.asus.adr = cs->hw.asus.cfg_reg + ASUS_ADR; cs->hw.asus.isac = cs->hw.asus.cfg_reg + ASUS_ISAC; cs->hw.asus.hscx = cs->hw.asus.cfg_reg + ASUS_HSCX; cs->hw.asus.u7 = cs->hw.asus.cfg_reg + ASUS_CTRL_U7; cs->hw.asus.pots = cs->hw.asus.cfg_reg + ASUS_CTRL_POTS; cs->readisac = &ReadISAC; cs->writeisac = &WriteISAC; cs->readisacfifo = &ReadISACfifo; cs->writeisacfifo = &WriteISACfifo; cs->irq_func = &asuscom_interrupt; ISACVersion(cs, "ISDNLink:"); if (HscxVersion(cs, "ISDNLink:")) { printk(KERN_WARNING "ISDNLink: wrong HSCX versions check IO address\n"); release_io_asuscom(cs); return (0); } } return (1);}
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -