Skip to content

L
linux
Commit 24e904bd authored by Kai Germaschewski's avatar Kai Germaschewski
Browse files
Options

ISDN/HiSax: Simplify readreg()/writereg() use 

In many cases, readreg()/writereg() users can be simplified by
passing struct IsdnCardState instead of individual register
addresses.
parent e54c19cf
Hide whitespace changes
Inline Side-by-side
Showing with 454 additions and 443 deletions
drivers/isdn/hisax/asuscom.c
View file @ 24e904bd
...@@ -43,46 +43,51 @@ static spinlock_t asuscom_lock = SPIN_LOCK_UNLOCKED; ...@@ -43,46 +43,51 @@ static spinlock_t asuscom_lock = SPIN_LOCK_UNLOCKED;
/* CARD_ADR (Write) */ /* CARD_ADR (Write) */
#define ASUS_RESET 0x80 /* Bit 7 Reset-Leitung */ #define ASUS_RESET 0x80 /* Bit 7 Reset-Leitung */
static inline u_char static inline u8
readreg(unsigned int ale, unsigned int adr, u_char off) readreg(struct IsdnCardState *cs, unsigned int adr, u8 off)
{ {
register u_char ret; u8 ret;
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&asuscom_lock, flags); spin_lock_irqsave(&asuscom_lock, flags);
byteout(ale, off); byteout(cs->hw.asus.adr, off);
ret = bytein(adr); ret = bytein(adr);
spin_unlock_irqrestore(&asuscom_lock, flags); spin_unlock_irqrestore(&asuscom_lock, flags);
return (ret); return ret;
} }
static inline void static inline void
readfifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int size) readfifo(struct IsdnCardState *cs, unsigned int adr, u8 off, u8 * data, int size)
{ {
/* fifo read without cli because it's allready done */ unsigned long flags;
byteout(ale, off); spin_lock_irqsave(&asuscom_lock, flags);
byteout(cs->hw.asus.adr, off);
insb(adr, data, size); insb(adr, data, size);
spin_unlock_irqrestore(&asuscom_lock, flags);
} }
static inline void static inline void
writereg(unsigned int ale, unsigned int adr, u_char off, u_char data) writereg(struct IsdnCardState *cs, unsigned int adr, u8 off, u8 data)
{ {
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&asuscom_lock, flags); spin_lock_irqsave(&asuscom_lock, flags);
byteout(ale, off); byteout(cs->hw.asus.adr, off);
byteout(adr, data); byteout(adr, data);
spin_unlock_irqrestore(&asuscom_lock, flags); spin_unlock_irqrestore(&asuscom_lock, flags);
} }
static inline void static inline void
writefifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int size) writefifo(struct IsdnCardState *cs, unsigned int adr, u8 off, u8 * data, int size)
{ {
/* fifo write without cli because it's allready done */ unsigned long flags;
byteout(ale, off);
spin_lock_irqsave(&asuscom_lock, flags);
byteout(cs->hw.asus.adr, off);
outsb(adr, data, size); outsb(adr, data, size);
spin_unlock_irqrestore(&asuscom_lock, flags);
} }
/* Interface functions */ /* Interface functions */
...@@ -90,25 +95,25 @@ writefifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int siz ...@@ -90,25 +95,25 @@ writefifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int siz
static u_char static u_char
ReadISAC(struct IsdnCardState *cs, u_char offset) ReadISAC(struct IsdnCardState *cs, u_char offset)
{ {
return (readreg(cs->hw.asus.adr, cs->hw.asus.isac, offset)); return readreg(cs, cs->hw.asus.isac, offset);
} }
static void static void
WriteISAC(struct IsdnCardState *cs, u_char offset, u_char value) WriteISAC(struct IsdnCardState *cs, u_char offset, u_char value)
{ {
writereg(cs->hw.asus.adr, cs->hw.asus.isac, offset, value); writereg(cs, cs->hw.asus.isac, offset, value);
} }
static void static void
ReadISACfifo(struct IsdnCardState *cs, u_char * data, int size) ReadISACfifo(struct IsdnCardState *cs, u_char * data, int size)
{ {
readfifo(cs->hw.asus.adr, cs->hw.asus.isac, 0, data, size); readfifo(cs, cs->hw.asus.isac, 0, data, size);
} }
static void static void
WriteISACfifo(struct IsdnCardState *cs, u_char * data, int size) WriteISACfifo(struct IsdnCardState *cs, u_char * data, int size)
{ {
writefifo(cs->hw.asus.adr, cs->hw.asus.isac, 0, data, size); writefifo(cs, cs->hw.asus.isac, 0, data, size);
} }
static struct dc_hw_ops isac_ops = { static struct dc_hw_ops isac_ops = {
...@@ -121,25 +126,25 @@ static struct dc_hw_ops isac_ops = { ...@@ -121,25 +126,25 @@ static struct dc_hw_ops isac_ops = {
static u_char static u_char
ReadISAC_IPAC(struct IsdnCardState *cs, u_char offset) ReadISAC_IPAC(struct IsdnCardState *cs, u_char offset)
{ {
return (readreg(cs->hw.asus.adr, cs->hw.asus.isac, offset|0x80)); return readreg(cs, cs->hw.asus.isac, offset|0x80);
} }
static void static void
WriteISAC_IPAC(struct IsdnCardState *cs, u_char offset, u_char value) WriteISAC_IPAC(struct IsdnCardState *cs, u_char offset, u_char value)
{ {
writereg(cs->hw.asus.adr, cs->hw.asus.isac, offset|0x80, value); writereg(cs, cs->hw.asus.isac, offset|0x80, value);
} }
static void static void
ReadISACfifo_IPAC(struct IsdnCardState *cs, u_char * data, int size) ReadISACfifo_IPAC(struct IsdnCardState *cs, u_char * data, int size)
{ {
readfifo(cs->hw.asus.adr, cs->hw.asus.isac, 0x80, data, size); readfifo(cs, cs->hw.asus.isac, 0x80, data, size);
} }
static void static void
WriteISACfifo_IPAC(struct IsdnCardState *cs, u_char * data, int size) WriteISACfifo_IPAC(struct IsdnCardState *cs, u_char * data, int size)
{ {
writefifo(cs->hw.asus.adr, cs->hw.asus.isac, 0x80, data, size); writefifo(cs, cs->hw.asus.isac, 0x80, data, size);
} }
static struct dc_hw_ops ipac_dc_ops = { static struct dc_hw_ops ipac_dc_ops = {
...@@ -152,15 +157,13 @@ static struct dc_hw_ops ipac_dc_ops = { ...@@ -152,15 +157,13 @@ static struct dc_hw_ops ipac_dc_ops = {
static u_char static u_char
ReadHSCX(struct IsdnCardState *cs, int hscx, u_char offset) ReadHSCX(struct IsdnCardState *cs, int hscx, u_char offset)
{ {
return (readreg(cs->hw.asus.adr, return readreg(cs, cs->hw.asus.hscx, offset + (hscx ? 0x40 : 0));
cs->hw.asus.hscx, offset + (hscx ? 0x40 : 0)));
} }
static void static void
WriteHSCX(struct IsdnCardState *cs, int hscx, u_char offset, u_char value) WriteHSCX(struct IsdnCardState *cs, int hscx, u_char offset, u_char value)
{ {
writereg(cs->hw.asus.adr, writereg(cs, cs->hw.asus.hscx, offset + (hscx ? 0x40 : 0), value);
cs->hw.asus.hscx, offset + (hscx ? 0x40 : 0), value);
} }
static struct bc_hw_ops hscx_ops = { static struct bc_hw_ops hscx_ops = {
...@@ -172,15 +175,15 @@ static struct bc_hw_ops hscx_ops = { ...@@ -172,15 +175,15 @@ static struct bc_hw_ops hscx_ops = {
* fast interrupt HSCX stuff goes here * fast interrupt HSCX stuff goes here
*/ */
#define READHSCX(cs, nr, reg) readreg(cs->hw.asus.adr, \ #define READHSCX(cs, nr, reg) readreg(cs, \
cs->hw.asus.hscx, reg + (nr ? 0x40 : 0)) cs->hw.asus.hscx, reg + (nr ? 0x40 : 0))
#define WRITEHSCX(cs, nr, reg, data) writereg(cs->hw.asus.adr, \ #define WRITEHSCX(cs, nr, reg, data) writereg(cs, \
cs->hw.asus.hscx, reg + (nr ? 0x40 : 0), data) cs->hw.asus.hscx, reg + (nr ? 0x40 : 0), data)
#define READHSCXFIFO(cs, nr, ptr, cnt) readfifo(cs->hw.asus.adr, \ #define READHSCXFIFO(cs, nr, ptr, cnt) readfifo(cs, \
cs->hw.asus.hscx, (nr ? 0x40 : 0), ptr, cnt) cs->hw.asus.hscx, (nr ? 0x40 : 0), ptr, cnt)
#define WRITEHSCXFIFO(cs, nr, ptr, cnt) writefifo(cs->hw.asus.adr, \ #define WRITEHSCXFIFO(cs, nr, ptr, cnt) writefifo(cs, \
cs->hw.asus.hscx, (nr ? 0x40 : 0), ptr, cnt) cs->hw.asus.hscx, (nr ? 0x40 : 0), ptr, cnt)
#include "hscx_irq.c" #include "hscx_irq.c"
...@@ -192,32 +195,32 @@ asuscom_interrupt(int intno, void *dev_id, struct pt_regs *regs) ...@@ -192,32 +195,32 @@ asuscom_interrupt(int intno, void *dev_id, struct pt_regs *regs)
u_char val; u_char val;
spin_lock(&cs->lock); spin_lock(&cs->lock);
val = readreg(cs->hw.asus.adr, cs->hw.asus.hscx, HSCX_ISTA + 0x40); val = readreg(cs, cs->hw.asus.hscx, HSCX_ISTA + 0x40);
Start_HSCX: Start_HSCX:
if (val) if (val)
hscx_int_main(cs, val); hscx_int_main(cs, val);
val = readreg(cs->hw.asus.adr, cs->hw.asus.isac, ISAC_ISTA); val = readreg(cs, cs->hw.asus.isac, ISAC_ISTA);
Start_ISAC: Start_ISAC:
if (val) if (val)
isac_interrupt(cs, val); isac_interrupt(cs, val);
val = readreg(cs->hw.asus.adr, cs->hw.asus.hscx, HSCX_ISTA + 0x40); val = readreg(cs, cs->hw.asus.hscx, HSCX_ISTA + 0x40);
if (val) { if (val) {
if (cs->debug & L1_DEB_HSCX) if (cs->debug & L1_DEB_HSCX)
debugl1(cs, "HSCX IntStat after IntRoutine"); debugl1(cs, "HSCX IntStat after IntRoutine");
goto Start_HSCX; goto Start_HSCX;
} }
val = readreg(cs->hw.asus.adr, cs->hw.asus.isac, ISAC_ISTA); val = readreg(cs, cs->hw.asus.isac, ISAC_ISTA);
if (val) { if (val) {
if (cs->debug & L1_DEB_ISAC) if (cs->debug & L1_DEB_ISAC)
debugl1(cs, "ISAC IntStat after IntRoutine"); debugl1(cs, "ISAC IntStat after IntRoutine");
goto Start_ISAC; goto Start_ISAC;
} }
writereg(cs->hw.asus.adr, cs->hw.asus.hscx, HSCX_MASK, 0xFF); writereg(cs, cs->hw.asus.hscx, HSCX_MASK, 0xFF);
writereg(cs->hw.asus.adr, cs->hw.asus.hscx, HSCX_MASK + 0x40, 0xFF); writereg(cs, cs->hw.asus.hscx, HSCX_MASK + 0x40, 0xFF);
writereg(cs->hw.asus.adr, cs->hw.asus.isac, ISAC_MASK, 0xFF); writereg(cs, cs->hw.asus.isac, ISAC_MASK, 0xFF);
writereg(cs->hw.asus.adr, cs->hw.asus.isac, ISAC_MASK, 0x0); writereg(cs, cs->hw.asus.isac, ISAC_MASK, 0x0);
writereg(cs->hw.asus.adr, cs->hw.asus.hscx, HSCX_MASK, 0x0); writereg(cs, cs->hw.asus.hscx, HSCX_MASK, 0x0);
writereg(cs->hw.asus.adr, cs->hw.asus.hscx, HSCX_MASK + 0x40, 0x0); writereg(cs, cs->hw.asus.hscx, HSCX_MASK + 0x40, 0x0);
spin_unlock(&cs->lock); spin_unlock(&cs->lock);
} }
...@@ -231,12 +234,12 @@ asuscom_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs) ...@@ -231,12 +234,12 @@ asuscom_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs)
printk(KERN_WARNING "ISDNLink: Spurious interrupt!\n"); printk(KERN_WARNING "ISDNLink: Spurious interrupt!\n");
return; return;
} }
ista = readreg(cs->hw.asus.adr, cs->hw.asus.isac, IPAC_ISTA); ista = readreg(cs, cs->hw.asus.isac, IPAC_ISTA);
Start_IPAC: Start_IPAC:
if (cs->debug & L1_DEB_IPAC) if (cs->debug & L1_DEB_IPAC)
debugl1(cs, "IPAC ISTA %02X", ista); debugl1(cs, "IPAC ISTA %02X", ista);
if (ista & 0x0f) { if (ista & 0x0f) {
val = readreg(cs->hw.asus.adr, cs->hw.asus.hscx, HSCX_ISTA + 0x40); val = readreg(cs, cs->hw.asus.hscx, HSCX_ISTA + 0x40);
if (ista & 0x01) if (ista & 0x01)
val |= 0x01; val |= 0x01;
if (ista & 0x04) if (ista & 0x04)
...@@ -247,7 +250,7 @@ asuscom_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs) ...@@ -247,7 +250,7 @@ asuscom_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs)
hscx_int_main(cs, val); hscx_int_main(cs, val);
} }
if (ista & 0x20) { if (ista & 0x20) {
val = 0xfe & readreg(cs->hw.asus.adr, cs->hw.asus.isac, ISAC_ISTA | 0x80); val = 0xfe & readreg(cs, cs->hw.asus.isac, ISAC_ISTA | 0x80);
if (val) { if (val) {
isac_interrupt(cs, val); isac_interrupt(cs, val);
} }
...@@ -256,15 +259,15 @@ asuscom_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs) ...@@ -256,15 +259,15 @@ asuscom_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs)
val = 0x01; val = 0x01;
isac_interrupt(cs, val); isac_interrupt(cs, val);
} }
ista = readreg(cs->hw.asus.adr, cs->hw.asus.isac, IPAC_ISTA); ista = readreg(cs, cs->hw.asus.isac, IPAC_ISTA);
if ((ista & 0x3f) && icnt) { if ((ista & 0x3f) && icnt) {
icnt--; icnt--;
goto Start_IPAC; goto Start_IPAC;
} }
if (!icnt) if (!icnt)
printk(KERN_WARNING "ASUS IRQ LOOP\n"); printk(KERN_WARNING "ASUS IRQ LOOP\n");
writereg(cs->hw.asus.adr, cs->hw.asus.isac, IPAC_MASK, 0xFF); writereg(cs, cs->hw.asus.isac, IPAC_MASK, 0xFF);
writereg(cs->hw.asus.adr, cs->hw.asus.isac, IPAC_MASK, 0xC0); writereg(cs, cs->hw.asus.isac, IPAC_MASK, 0xC0);
} }
void void
...@@ -280,23 +283,23 @@ static void ...@@ -280,23 +283,23 @@ static void
reset_asuscom(struct IsdnCardState *cs) reset_asuscom(struct IsdnCardState *cs)
{ {
if (cs->subtyp == ASUS_IPAC) if (cs->subtyp == ASUS_IPAC)
writereg(cs->hw.asus.adr, cs->hw.asus.isac, IPAC_POTA2, 0x20); writereg(cs, cs->hw.asus.isac, IPAC_POTA2, 0x20);
else else
byteout(cs->hw.asus.adr, ASUS_RESET); /* Reset On */ byteout(cs->hw.asus.adr, ASUS_RESET); /* Reset On */
set_current_state(TASK_UNINTERRUPTIBLE); set_current_state(TASK_UNINTERRUPTIBLE);
schedule_timeout((10*HZ)/1000); schedule_timeout((10*HZ)/1000);
if (cs->subtyp == ASUS_IPAC) if (cs->subtyp == ASUS_IPAC)
writereg(cs->hw.asus.adr, cs->hw.asus.isac, IPAC_POTA2, 0x0); writereg(cs, cs->hw.asus.isac, IPAC_POTA2, 0x0);
else else
byteout(cs->hw.asus.adr, 0); /* Reset Off */ byteout(cs->hw.asus.adr, 0); /* Reset Off */
set_current_state(TASK_UNINTERRUPTIBLE); set_current_state(TASK_UNINTERRUPTIBLE);
schedule_timeout((10*HZ)/1000); schedule_timeout((10*HZ)/1000);
if (cs->subtyp == ASUS_IPAC) { if (cs->subtyp == ASUS_IPAC) {
writereg(cs->hw.asus.adr, cs->hw.asus.isac, IPAC_CONF, 0x0); writereg(cs, cs->hw.asus.isac, IPAC_CONF, 0x0);
writereg(cs->hw.asus.adr, cs->hw.asus.isac, IPAC_ACFG, 0xff); writereg(cs, cs->hw.asus.isac, IPAC_ACFG, 0xff);
writereg(cs->hw.asus.adr, cs->hw.asus.isac, IPAC_AOE, 0x0); writereg(cs, cs->hw.asus.isac, IPAC_AOE, 0x0);
writereg(cs->hw.asus.adr, cs->hw.asus.isac, IPAC_MASK, 0xc0); writereg(cs, cs->hw.asus.isac, IPAC_MASK, 0xc0);
writereg(cs->hw.asus.adr, cs->hw.asus.isac, IPAC_PCFG, 0x12); writereg(cs, cs->hw.asus.isac, IPAC_PCFG, 0x12);
} }
} }
...@@ -410,11 +413,10 @@ setup_asuscom(struct IsdnCard *card) ...@@ -410,11 +413,10 @@ setup_asuscom(struct IsdnCard *card)
cs->bc_hw_ops = &hscx_ops; cs->bc_hw_ops = &hscx_ops;
cs->BC_Send_Data = &hscx_fill_fifo; cs->BC_Send_Data = &hscx_fill_fifo;
cs->cardmsg = &Asus_card_msg; cs->cardmsg = &Asus_card_msg;
val = readreg(cs->hw.asus.cfg_reg + ASUS_IPAC_ALE, cs->hw.asus.adr = cs->hw.asus.cfg_reg + ASUS_IPAC_ALE;
cs->hw.asus.cfg_reg + ASUS_IPAC_DATA, IPAC_ID); val = readreg(cs, cs->hw.asus.cfg_reg + ASUS_IPAC_DATA, IPAC_ID);
if ((val == 1) || (val == 2)) { if ((val == 1) || (val == 2)) {
cs->subtyp = ASUS_IPAC; 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.isac = cs->hw.asus.cfg_reg + ASUS_IPAC_DATA;
cs->hw.asus.hscx = 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); test_and_set_bit(HW_IPAC, &cs->HW_Flags);
......
drivers/isdn/hisax/avm_a1p.c
View file @ 24e904bd
...@@ -59,55 +59,77 @@ ...@@ -59,55 +59,77 @@
static const char *avm_revision = "$Revision: 2.7.6.2 $"; static const char *avm_revision = "$Revision: 2.7.6.2 $";
static spinlock_t avm_a1p_lock = SPIN_LOCK_UNLOCKED; static spinlock_t avm_a1p_lock = SPIN_LOCK_UNLOCKED;
static inline u_char static inline u8
ReadISAC(struct IsdnCardState *cs, u_char offset) readreg(struct IsdnCardState *cs, int offset, u8 adr)
{ {
unsigned long flags; unsigned long flags;
u_char ret; u8 ret;
offset -= 0x20;
spin_lock_irqsave(&avm_a1p_lock, flags); spin_lock_irqsave(&avm_a1p_lock, flags);
byteout(cs->hw.avm.cfg_reg+ADDRREG_OFFSET,ISAC_REG_OFFSET+offset); byteout(cs->hw.avm.cfg_reg + ADDRREG_OFFSET, offset + adr - 0x20);
ret = bytein(cs->hw.avm.cfg_reg+DATAREG_OFFSET); ret = bytein(cs->hw.avm.cfg_reg + DATAREG_OFFSET);
spin_unlock_irqrestore(&avm_a1p_lock, flags); spin_unlock_irqrestore(&avm_a1p_lock, flags);
return ret; return ret;
} }
static inline void static inline void
WriteISAC(struct IsdnCardState *cs, u_char offset, u_char value) writereg(struct IsdnCardState *cs, int offset, u8 adr, u8 value)
{ {
unsigned long flags; unsigned long flags;
offset -= 0x20;
spin_lock_irqsave(&avm_a1p_lock, flags); spin_lock_irqsave(&avm_a1p_lock, flags);
byteout(cs->hw.avm.cfg_reg+ADDRREG_OFFSET,ISAC_REG_OFFSET+offset); byteout(cs->hw.avm.cfg_reg+ADDRREG_OFFSET, offset + adr - 0x20);
byteout(cs->hw.avm.cfg_reg+DATAREG_OFFSET, value); byteout(cs->hw.avm.cfg_reg+DATAREG_OFFSET, value);
spin_unlock_irqrestore(&avm_a1p_lock, flags); spin_unlock_irqrestore(&avm_a1p_lock, flags);
} }
static inline void static inline void
ReadISACfifo(struct IsdnCardState *cs, u_char * data, int size) readfifo(struct IsdnCardState *cs, int offset, u8 *data, int size)
{ {
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&avm_a1p_lock, flags); spin_lock_irqsave(&avm_a1p_lock, flags);
byteout(cs->hw.avm.cfg_reg+ADDRREG_OFFSET,ISAC_FIFO_OFFSET); byteout(cs->hw.avm.cfg_reg + ADDRREG_OFFSET, offset);
insb(cs->hw.avm.cfg_reg+DATAREG_OFFSET, data, size); insb(cs->hw.avm.cfg_reg + DATAREG_OFFSET, data, size);
spin_unlock_irqrestore(&avm_a1p_lock, flags); spin_unlock_irqrestore(&avm_a1p_lock, flags);
return;
} }
static inline void static inline void
WriteISACfifo(struct IsdnCardState *cs, u_char * data, int size) writefifo(struct IsdnCardState *cs, int offset, u8 *data, int size)
{ {
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&avm_a1p_lock, flags); spin_lock_irqsave(&avm_a1p_lock, flags);
byteout(cs->hw.avm.cfg_reg+ADDRREG_OFFSET,ISAC_FIFO_OFFSET); byteout(cs->hw.avm.cfg_reg+ADDRREG_OFFSET, offset);
outsb(cs->hw.avm.cfg_reg+DATAREG_OFFSET, data, size); outsb(cs->hw.avm.cfg_reg+DATAREG_OFFSET, data, size);
spin_unlock_irqrestore(&avm_a1p_lock, flags); spin_unlock_irqrestore(&avm_a1p_lock, flags);
} }
static inline u_char
ReadISAC(struct IsdnCardState *cs, u_char adr)
{
return readreg(cs, ISAC_REG_OFFSET, adr);
}
static inline void
WriteISAC(struct IsdnCardState *cs, u_char adr, u_char value)
{
writereg(cs, ISAC_REG_OFFSET, adr, value);
}
static inline void
ReadISACfifo(struct IsdnCardState *cs, u_char * data, int size)
{
readfifo(cs, ISAC_FIFO_OFFSET, data, size);
}
static inline void
WriteISACfifo(struct IsdnCardState *cs, u_char * data, int size)
{
writefifo(cs, ISAC_FIFO_OFFSET, data, size);
}
static struct dc_hw_ops isac_ops = { static struct dc_hw_ops isac_ops = {
.read_reg = ReadISAC, .read_reg = ReadISAC,
.write_reg = WriteISAC, .write_reg = WriteISAC,
...@@ -116,57 +138,27 @@ static struct dc_hw_ops isac_ops = { ...@@ -116,57 +138,27 @@ static struct dc_hw_ops isac_ops = {
}; };
static inline u_char static inline u_char
ReadHSCX(struct IsdnCardState *cs, int hscx, u_char offset) ReadHSCX(struct IsdnCardState *cs, int hscx, u_char adr)
{ {
u_char ret; return readreg(cs, HSCX_REG_OFFSET + hscx*HSCX_CH_DIFF, adr);
unsigned long flags;
offset -= 0x20;
spin_lock_irqsave(&avm_a1p_lock, flags);
byteout(cs->hw.avm.cfg_reg+ADDRREG_OFFSET,
HSCX_REG_OFFSET+hscx*HSCX_CH_DIFF+offset);
ret = bytein(cs->hw.avm.cfg_reg+DATAREG_OFFSET);
spin_unlock_irqrestore(&avm_a1p_lock, flags);
return ret;
} }
static inline void static inline void
WriteHSCX(struct IsdnCardState *cs, int hscx, u_char offset, u_char value) WriteHSCX(struct IsdnCardState *cs, int hscx, u_char adr, u_char value)
{ {
unsigned long flags; writereg(cs, HSCX_REG_OFFSET + hscx*HSCX_CH_DIFF, adr, value);
offset -= 0x20;
spin_lock_irqsave(&avm_a1p_lock, flags);
byteout(cs->hw.avm.cfg_reg+ADDRREG_OFFSET,
HSCX_REG_OFFSET+hscx*HSCX_CH_DIFF+offset);
byteout(cs->hw.avm.cfg_reg+DATAREG_OFFSET, value);
spin_unlock_irqrestore(&avm_a1p_lock, flags);
} }
static inline void static inline void
ReadHSCXfifo(struct IsdnCardState *cs, int hscx, u_char * data, int size) ReadHSCXfifo(struct IsdnCardState *cs, int hscx, u_char * data, int size)
{ {
unsigned long flags; return readfifo(cs, HSCX_FIFO_OFFSET + hscx*HSCX_CH_DIFF, data, size);
spin_lock_irqsave(&avm_a1p_lock, flags);
byteout(cs->hw.avm.cfg_reg+ADDRREG_OFFSET,
HSCX_FIFO_OFFSET+hscx*HSCX_CH_DIFF);
insb(cs->hw.avm.cfg_reg+DATAREG_OFFSET, data, size);
spin_unlock_irqrestore(&avm_a1p_lock, flags);
} }
static inline void static inline void
WriteHSCXfifo(struct IsdnCardState *cs, int hscx, u_char * data, int size) WriteHSCXfifo(struct IsdnCardState *cs, int hscx, u_char * data, int size)
{ {
unsigned long flags; writefifo(cs, HSCX_FIFO_OFFSET + hscx*HSCX_CH_DIFF, data, size);
spin_lock_irqsave(&avm_a1p_lock, flags);
byteout(cs->hw.avm.cfg_reg+ADDRREG_OFFSET,
HSCX_FIFO_OFFSET+hscx*HSCX_CH_DIFF);
outsb(cs->hw.avm.cfg_reg+DATAREG_OFFSET, data, size);
spin_unlock_irqrestore(&avm_a1p_lock, flags);
} }
static struct bc_hw_ops hscx_ops = { static struct bc_hw_ops hscx_ops = {
......
drivers/isdn/hisax/bkm_a8.c
View file @ 24e904bd
...@@ -41,47 +41,53 @@ static const char *sct_quadro_subtypes[] = ...@@ -41,47 +41,53 @@ static const char *sct_quadro_subtypes[] =
#define wordout(addr,val) outw(val,addr) #define wordout(addr,val) outw(val,addr)
#define wordin(addr) inw(addr) #define wordin(addr) inw(addr)
static inline u_char static inline u8
readreg(unsigned int ale, unsigned int adr, u_char off) readreg(struct IsdnCardState *cs, u8 off)
{ {
register u_char ret; u8 ret;
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&bkm_a8_lock, flags); spin_lock_irqsave(&bkm_a8_lock, flags);
wordout(ale, off); wordout(cs->hw.ax.base, off);
ret = wordin(adr) & 0xFF; ret = wordin(cs->hw.ax.data_adr) & 0xFF;
spin_unlock_irqrestore(&bkm_a8_lock, flags); spin_unlock_irqrestore(&bkm_a8_lock, flags);
return (ret); return (ret);
} }
static inline void static inline void
readfifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int size) writereg(struct IsdnCardState *cs, u8 off, u8 data)
{ {
/* fifo read without cli because it's allready done */ unsigned long flags;
int i; spin_lock_irqsave(&bkm_a8_lock, flags);
wordout(ale, off); wordout(cs->hw.ax.base, off);
for (i = 0; i < size; i++) wordout(cs->hw.ax.data_adr, data);
data[i] = wordin(adr) & 0xFF; spin_unlock_irqrestore(&bkm_a8_lock, flags);
} }
static inline void static inline void
writereg(unsigned int ale, unsigned int adr, u_char off, u_char data) readfifo(struct IsdnCardState *cs, u8 off, u8 *data, int size)
{ {
int i;
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&bkm_a8_lock, flags); spin_lock_irqsave(&bkm_a8_lock, flags);
wordout(ale, off); wordout(cs->hw.ax.base, off);
wordout(adr, data); for (i = 0; i < size; i++)
data[i] = wordin(cs->hw.ax.data_adr) & 0xFF;
spin_unlock_irqrestore(&bkm_a8_lock, flags); spin_unlock_irqrestore(&bkm_a8_lock, flags);
} }
static inline void static inline void
writefifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int size) writefifo(struct IsdnCardState *cs, u8 off, u8 *data, int size)
{ {
/* fifo write without cli because it's allready done */
int i; int i;
wordout(ale, off); unsigned long flags;
spin_lock_irqsave(&bkm_a8_lock, flags);
wordout(cs->hw.ax.base, off);
for (i = 0; i < size; i++) for (i = 0; i < size; i++)
wordout(adr, data[i]); wordout(cs->hw.ax.data_adr, data[i]);
spin_unlock_irqrestore(&bkm_a8_lock, flags);
} }
/* Interface functions */ /* Interface functions */
...@@ -89,25 +95,25 @@ writefifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int siz ...@@ -89,25 +95,25 @@ writefifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int siz
static u_char static u_char
ReadISAC(struct IsdnCardState *cs, u_char offset) ReadISAC(struct IsdnCardState *cs, u_char offset)
{ {
return (readreg(cs->hw.ax.base, cs->hw.ax.data_adr, offset | 0x80)); return readreg(cs, offset | 0x80);
} }
static void static void
WriteISAC(struct IsdnCardState *cs, u_char offset, u_char value) WriteISAC(struct IsdnCardState *cs, u_char offset, u_char value)
{ {
writereg(cs->hw.ax.base, cs->hw.ax.data_adr, offset | 0x80, value); writereg(cs, offset | 0x80, value);
} }
static void static void
ReadISACfifo(struct IsdnCardState *cs, u_char * data, int size) ReadISACfifo(struct IsdnCardState *cs, u_char * data, int size)
{ {
readfifo(cs->hw.ax.base, cs->hw.ax.data_adr, 0x80, data, size); readfifo(cs, 0x80, data, size);
} }
static void static void
WriteISACfifo(struct IsdnCardState *cs, u_char * data, int size) WriteISACfifo(struct IsdnCardState *cs, u_char * data, int size)
{ {
writefifo(cs->hw.ax.base, cs->hw.ax.data_adr, 0x80, data, size); writefifo(cs, 0x80, data, size);
} }
static struct dc_hw_ops isac_ops = { static struct dc_hw_ops isac_ops = {
...@@ -120,13 +126,13 @@ static struct dc_hw_ops isac_ops = { ...@@ -120,13 +126,13 @@ static struct dc_hw_ops isac_ops = {
static u_char static u_char
ReadHSCX(struct IsdnCardState *cs, int hscx, u_char offset) ReadHSCX(struct IsdnCardState *cs, int hscx, u_char offset)
{ {
return (readreg(cs->hw.ax.base, cs->hw.ax.data_adr, offset + (hscx ? 0x40 : 0))); return readreg(cs, offset + (hscx ? 0x40 : 0));
} }
static void static void
WriteHSCX(struct IsdnCardState *cs, int hscx, u_char offset, u_char value) WriteHSCX(struct IsdnCardState *cs, int hscx, u_char offset, u_char value)
{ {
writereg(cs->hw.ax.base, cs->hw.ax.data_adr, offset + (hscx ? 0x40 : 0), value); writereg(cs, offset + (hscx ? 0x40 : 0), value);
} }
static struct bc_hw_ops hscx_ops = { static struct bc_hw_ops hscx_ops = {
...@@ -139,22 +145,21 @@ static void ...@@ -139,22 +145,21 @@ static void
set_ipac_active(struct IsdnCardState *cs, u_int active) set_ipac_active(struct IsdnCardState *cs, u_int active)
{ {
/* set irq mask */ /* set irq mask */
writereg(cs->hw.ax.base, cs->hw.ax.data_adr, IPAC_MASK, writereg(cs, IPAC_MASK, active ? 0xc0 : 0xff);
active ? 0xc0 : 0xff);
} }
/* /*
* fast interrupt HSCX stuff goes here * fast interrupt HSCX stuff goes here
*/ */
#define READHSCX(cs, nr, reg) readreg(cs->hw.ax.base, \ #define READHSCX(cs, nr, reg) readreg(cs, \
cs->hw.ax.data_adr, reg + (nr ? 0x40 : 0)) reg + (nr ? 0x40 : 0))
#define WRITEHSCX(cs, nr, reg, data) writereg(cs->hw.ax.base, \ #define WRITEHSCX(cs, nr, reg, data) writereg(cs, \
cs->hw.ax.data_adr, reg + (nr ? 0x40 : 0), data) reg + (nr ? 0x40 : 0), data)
#define READHSCXFIFO(cs, nr, ptr, cnt) readfifo(cs->hw.ax.base, \ #define READHSCXFIFO(cs, nr, ptr, cnt) readfifo(cs, \
cs->hw.ax.data_adr, (nr ? 0x40 : 0), ptr, cnt) (nr ? 0x40 : 0), ptr, cnt)
#define WRITEHSCXFIFO(cs, nr, ptr, cnt) writefifo(cs->hw.ax.base, \ #define WRITEHSCXFIFO(cs, nr, ptr, cnt) writefifo(cs, \
cs->hw.ax.data_adr, (nr ? 0x40 : 0), ptr, cnt) (nr ? 0x40 : 0), ptr, cnt)
#include "hscx_irq.c" #include "hscx_irq.c"
...@@ -165,14 +170,14 @@ bkm_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs) ...@@ -165,14 +170,14 @@ bkm_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs)
u_char ista, val, icnt = 5; u_char ista, val, icnt = 5;
spin_lock(&cs->lock); spin_lock(&cs->lock);
ista = readreg(cs->hw.ax.base, cs->hw.ax.data_adr, IPAC_ISTA); ista = readreg(cs, IPAC_ISTA);
if (!(ista & 0x3f)) /* not this IPAC */ if (!(ista & 0x3f)) /* not this IPAC */
goto unlock; goto unlock;
Start_IPAC: Start_IPAC:
if (cs->debug & L1_DEB_IPAC) if (cs->debug & L1_DEB_IPAC)
debugl1(cs, "IPAC ISTA %02X", ista); debugl1(cs, "IPAC ISTA %02X", ista);
if (ista & 0x0f) { if (ista & 0x0f) {
val = readreg(cs->hw.ax.base, cs->hw.ax.data_adr, HSCX_ISTA + 0x40); val = readreg(cs, HSCX_ISTA + 0x40);
if (ista & 0x01) if (ista & 0x01)
val |= 0x01; val |= 0x01;
if (ista & 0x04) if (ista & 0x04)
...@@ -184,7 +189,7 @@ bkm_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs) ...@@ -184,7 +189,7 @@ bkm_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs)
} }
} }
if (ista & 0x20) { if (ista & 0x20) {
val = 0xfe & readreg(cs->hw.ax.base, cs->hw.ax.data_adr, ISAC_ISTA | 0x80); val = 0xfe & readreg(cs, ISAC_ISTA | 0x80);
if (val) { if (val) {
isac_interrupt(cs, val); isac_interrupt(cs, val);
} }
...@@ -193,7 +198,7 @@ bkm_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs) ...@@ -193,7 +198,7 @@ bkm_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs)
val = 0x01; val = 0x01;
isac_interrupt(cs, val); isac_interrupt(cs, val);
} }
ista = readreg(cs->hw.ax.base, cs->hw.ax.data_adr, IPAC_ISTA); ista = readreg(cs, IPAC_ISTA);
if ((ista & 0x3f) && icnt) { if ((ista & 0x3f) && icnt) {
icnt--; icnt--;
goto Start_IPAC; goto Start_IPAC;
...@@ -202,8 +207,8 @@ bkm_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs) ...@@ -202,8 +207,8 @@ bkm_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs)
printk(KERN_WARNING "HiSax: %s (%s) IRQ LOOP\n", printk(KERN_WARNING "HiSax: %s (%s) IRQ LOOP\n",
CardType[cs->typ], CardType[cs->typ],
sct_quadro_subtypes[cs->subtyp]); sct_quadro_subtypes[cs->subtyp]);
writereg(cs->hw.ax.base, cs->hw.ax.data_adr, IPAC_MASK, 0xFF); writereg(cs, IPAC_MASK, 0xFF);
writereg(cs->hw.ax.base, cs->hw.ax.data_adr, IPAC_MASK, 0xC0); writereg(cs, IPAC_MASK, 0xC0);
unlock: unlock:
spin_unlock(&cs->lock); spin_unlock(&cs->lock);
} }
...@@ -402,15 +407,6 @@ setup_sct_quadro(struct IsdnCard *card) ...@@ -402,15 +407,6 @@ setup_sct_quadro(struct IsdnCard *card)
return(0); return(0);
if (sct_alloc_io(pci_ioaddr5, 64)) if (sct_alloc_io(pci_ioaddr5, 64))
return(0); return(0);
/* disable all IPAC */
writereg(pci_ioaddr5, pci_ioaddr5 + 4,
IPAC_MASK, 0xFF);
writereg(pci_ioaddr4 + 0x08, pci_ioaddr4 + 0x0c,
IPAC_MASK, 0xFF);
writereg(pci_ioaddr3 + 0x10, pci_ioaddr3 + 0x14,
IPAC_MASK, 0xFF);
writereg(pci_ioaddr2 + 0x20, pci_ioaddr2 + 0x24,
IPAC_MASK, 0xFF);
break; break;
case 2: case 2:
cs->hw.ax.base = pci_ioaddr4 + 0x08; cs->hw.ax.base = pci_ioaddr4 + 0x08;
...@@ -428,8 +424,8 @@ setup_sct_quadro(struct IsdnCard *card) ...@@ -428,8 +424,8 @@ setup_sct_quadro(struct IsdnCard *card)
return(0); return(0);
break; break;
} }
/* For isac and hscx data path */
cs->hw.ax.data_adr = cs->hw.ax.base + 4; cs->hw.ax.data_adr = cs->hw.ax.base + 4;
writereg(cs, IPAC_MASK, 0xFF);
printk(KERN_INFO "HiSax: %s (%s) configured at 0x%.4lX, 0x%.4lX, 0x%.4lX and IRQ %d\n", printk(KERN_INFO "HiSax: %s (%s) configured at 0x%.4lX, 0x%.4lX, 0x%.4lX and IRQ %d\n",
CardType[card->typ], CardType[card->typ],
...@@ -450,7 +446,7 @@ setup_sct_quadro(struct IsdnCard *card) ...@@ -450,7 +446,7 @@ setup_sct_quadro(struct IsdnCard *card)
printk(KERN_INFO "HiSax: %s (%s): IPAC Version %d\n", printk(KERN_INFO "HiSax: %s (%s): IPAC Version %d\n",
CardType[card->typ], CardType[card->typ],
sct_quadro_subtypes[cs->subtyp], sct_quadro_subtypes[cs->subtyp],
readreg(cs->hw.ax.base, cs->hw.ax.data_adr, IPAC_ID)); readreg(cs, IPAC_ID));
return (1); return (1);
#else #else
printk(KERN_ERR "HiSax: bkm_a8 only supported on PCI Systems\n"); printk(KERN_ERR "HiSax: bkm_a8 only supported on PCI Systems\n");
......
drivers/isdn/hisax/elsa.c
View file @ 24e904bd
...@@ -142,46 +142,50 @@ static void set_arcofi(struct IsdnCardState *cs, int bc); ...@@ -142,46 +142,50 @@ static void set_arcofi(struct IsdnCardState *cs, int bc);
#include "elsa_ser.c" #include "elsa_ser.c"
#endif /* ARCOFI_USE */ #endif /* ARCOFI_USE */
static inline u_char static inline u8
readreg(unsigned int ale, unsigned int adr, u_char off) readreg(struct IsdnCardState *cs, unsigned int adr, u8 off)
{ {
register u_char ret; u8 ret;
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&elsa_lock, flags); spin_lock_irqsave(&elsa_lock, flags);
byteout(ale, off); byteout(cs->hw.elsa.ale, off);
ret = bytein(adr); ret = bytein(adr);
spin_unlock_irqrestore(&elsa_lock, flags); spin_unlock_irqrestore(&elsa_lock, flags);
return (ret); return ret;
} }
static inline void static inline void
readfifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int size) writereg(struct IsdnCardState *cs, unsigned int adr, u8 off, u8 data)
{ {
/* fifo read without cli because it's allready done */ unsigned long flags;
byteout(ale, off); spin_lock_irqsave(&elsa_lock, flags);
insb(adr, data, size); byteout(cs->hw.elsa.ale, off);
byteout(adr, data);
spin_unlock_irqrestore(&elsa_lock, flags);
} }
static inline void static inline void
writereg(unsigned int ale, unsigned int adr, u_char off, u_char data) readfifo(struct IsdnCardState *cs, unsigned int adr, u8 off, u8 * data, int size)
{ {
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&elsa_lock, flags); spin_lock_irqsave(&elsa_lock, flags);
byteout(ale, off); byteout(cs->hw.elsa.ale, off);
byteout(adr, data); insb(adr, data, size);
spin_unlock_irqrestore(&elsa_lock, flags); spin_unlock_irqrestore(&elsa_lock, flags);
} }
static inline void static inline void
writefifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int size) writefifo(struct IsdnCardState *cs, unsigned int adr, u8 off, u8 * data, int size)
{ {
/* fifo write without cli because it's allready done */ unsigned long flags;
byteout(ale, off);
spin_lock_irqsave(&elsa_lock, flags);
byteout(cs->hw.elsa.ale, off);
outsb(adr, data, size); outsb(adr, data, size);
spin_unlock_irqrestore(&elsa_lock, flags);
} }
/* Interface functions */ /* Interface functions */
...@@ -189,25 +193,25 @@ writefifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int siz ...@@ -189,25 +193,25 @@ writefifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int siz
static u_char static u_char
ReadISAC(struct IsdnCardState *cs, u_char offset) ReadISAC(struct IsdnCardState *cs, u_char offset)
{ {
return (readreg(cs->hw.elsa.ale, cs->hw.elsa.isac, offset)); return readreg(cs, cs->hw.elsa.isac, offset);
} }
static void static void
WriteISAC(struct IsdnCardState *cs, u_char offset, u_char value) WriteISAC(struct IsdnCardState *cs, u_char offset, u_char value)
{ {
writereg(cs->hw.elsa.ale, cs->hw.elsa.isac, offset, value); writereg(cs, cs->hw.elsa.isac, offset, value);
} }
static void static void
ReadISACfifo(struct IsdnCardState *cs, u_char * data, int size) ReadISACfifo(struct IsdnCardState *cs, u_char * data, int size)
{ {
readfifo(cs->hw.elsa.ale, cs->hw.elsa.isac, 0, data, size); readfifo(cs, cs->hw.elsa.isac, 0, data, size);
} }
static void static void
WriteISACfifo(struct IsdnCardState *cs, u_char * data, int size) WriteISACfifo(struct IsdnCardState *cs, u_char * data, int size)
{ {
writefifo(cs->hw.elsa.ale, cs->hw.elsa.isac, 0, data, size); writefifo(cs, cs->hw.elsa.isac, 0, data, size);
} }
static struct dc_hw_ops isac_ops = { static struct dc_hw_ops isac_ops = {
...@@ -220,25 +224,25 @@ static struct dc_hw_ops isac_ops = { ...@@ -220,25 +224,25 @@ static struct dc_hw_ops isac_ops = {
static u_char static u_char
ReadISAC_IPAC(struct IsdnCardState *cs, u_char offset) ReadISAC_IPAC(struct IsdnCardState *cs, u_char offset)
{ {
return (readreg(cs->hw.elsa.ale, cs->hw.elsa.isac, offset+0x80)); return readreg(cs, cs->hw.elsa.isac, offset+0x80);
} }
static void static void
WriteISAC_IPAC(struct IsdnCardState *cs, u_char offset, u_char value) WriteISAC_IPAC(struct IsdnCardState *cs, u_char offset, u_char value)
{ {
writereg(cs->hw.elsa.ale, cs->hw.elsa.isac, offset|0x80, value); writereg(cs, cs->hw.elsa.isac, offset|0x80, value);
} }
static void static void
ReadISACfifo_IPAC(struct IsdnCardState *cs, u_char * data, int size) ReadISACfifo_IPAC(struct IsdnCardState *cs, u_char * data, int size)
{ {
readfifo(cs->hw.elsa.ale, cs->hw.elsa.isac, 0x80, data, size); readfifo(cs, cs->hw.elsa.isac, 0x80, data, size);
} }
static void static void
WriteISACfifo_IPAC(struct IsdnCardState *cs, u_char * data, int size) WriteISACfifo_IPAC(struct IsdnCardState *cs, u_char * data, int size)
{ {
writefifo(cs->hw.elsa.ale, cs->hw.elsa.isac, 0x80, data, size); writefifo(cs, cs->hw.elsa.isac, 0x80, data, size);
} }
static struct dc_hw_ops ipac_dc_ops = { static struct dc_hw_ops ipac_dc_ops = {
...@@ -251,15 +255,13 @@ static struct dc_hw_ops ipac_dc_ops = { ...@@ -251,15 +255,13 @@ static struct dc_hw_ops ipac_dc_ops = {
static u_char static u_char
ReadHSCX(struct IsdnCardState *cs, int hscx, u_char offset) ReadHSCX(struct IsdnCardState *cs, int hscx, u_char offset)
{ {
return (readreg(cs->hw.elsa.ale, return readreg(cs, cs->hw.elsa.hscx, offset + (hscx ? 0x40 : 0));
cs->hw.elsa.hscx, offset + (hscx ? 0x40 : 0)));
} }
static void static void
WriteHSCX(struct IsdnCardState *cs, int hscx, u_char offset, u_char value) WriteHSCX(struct IsdnCardState *cs, int hscx, u_char offset, u_char value)
{ {
writereg(cs->hw.elsa.ale, writereg(cs, cs->hw.elsa.hscx, offset + (hscx ? 0x40 : 0), value);
cs->hw.elsa.hscx, offset + (hscx ? 0x40 : 0), value);
} }
static struct bc_hw_ops hscx_ops = { static struct bc_hw_ops hscx_ops = {
...@@ -307,15 +309,15 @@ TimerRun(struct IsdnCardState *cs) ...@@ -307,15 +309,15 @@ TimerRun(struct IsdnCardState *cs)
* fast interrupt HSCX stuff goes here * fast interrupt HSCX stuff goes here
*/ */
#define READHSCX(cs, nr, reg) readreg(cs->hw.elsa.ale, \ #define READHSCX(cs, nr, reg) readreg(cs, \
cs->hw.elsa.hscx, reg + (nr ? 0x40 : 0)) cs->hw.elsa.hscx, reg + (nr ? 0x40 : 0))
#define WRITEHSCX(cs, nr, reg, data) writereg(cs->hw.elsa.ale, \ #define WRITEHSCX(cs, nr, reg, data) writereg(cs, \
cs->hw.elsa.hscx, reg + (nr ? 0x40 : 0), data) cs->hw.elsa.hscx, reg + (nr ? 0x40 : 0), data)
#define READHSCXFIFO(cs, nr, ptr, cnt) readfifo(cs->hw.elsa.ale, \ #define READHSCXFIFO(cs, nr, ptr, cnt) readfifo(cs, \
cs->hw.elsa.hscx, (nr ? 0x40 : 0), ptr, cnt) cs->hw.elsa.hscx, (nr ? 0x40 : 0), ptr, cnt)
#define WRITEHSCXFIFO(cs, nr, ptr, cnt) writefifo(cs->hw.elsa.ale, \ #define WRITEHSCXFIFO(cs, nr, ptr, cnt) writefifo(cs, \
cs->hw.elsa.hscx, (nr ? 0x40 : 0), ptr, cnt) cs->hw.elsa.hscx, (nr ? 0x40 : 0), ptr, cnt)
#include "hscx_irq.c" #include "hscx_irq.c"
...@@ -343,24 +345,24 @@ elsa_interrupt(int intno, void *dev_id, struct pt_regs *regs) ...@@ -343,24 +345,24 @@ elsa_interrupt(int intno, void *dev_id, struct pt_regs *regs)
} }
} }
#endif #endif
val = readreg(cs->hw.elsa.ale, cs->hw.elsa.hscx, HSCX_ISTA + 0x40); val = readreg(cs, cs->hw.elsa.hscx, HSCX_ISTA + 0x40);
Start_HSCX: Start_HSCX:
if (val) { if (val) {
hscx_int_main(cs, val); hscx_int_main(cs, val);
} }
val = readreg(cs->hw.elsa.ale, cs->hw.elsa.isac, ISAC_ISTA); val = readreg(cs, cs->hw.elsa.isac, ISAC_ISTA);
Start_ISAC: Start_ISAC:
if (val) { if (val) {
isac_interrupt(cs, val); isac_interrupt(cs, val);
} }
val = readreg(cs->hw.elsa.ale, cs->hw.elsa.hscx, HSCX_ISTA + 0x40); val = readreg(cs, cs->hw.elsa.hscx, HSCX_ISTA + 0x40);
if (val && icnt) { if (val && icnt) {
if (cs->debug & L1_DEB_HSCX) if (cs->debug & L1_DEB_HSCX)
debugl1(cs, "HSCX IntStat after IntRoutine"); debugl1(cs, "HSCX IntStat after IntRoutine");
icnt--; icnt--;
goto Start_HSCX; goto Start_HSCX;
} }
val = readreg(cs->hw.elsa.ale, cs->hw.elsa.isac, ISAC_ISTA); val = readreg(cs, cs->hw.elsa.isac, ISAC_ISTA);
if (val && icnt) { if (val && icnt) {
if (cs->debug & L1_DEB_ISAC) if (cs->debug & L1_DEB_ISAC)
debugl1(cs, "ISAC IntStat after IntRoutine"); debugl1(cs, "ISAC IntStat after IntRoutine");
...@@ -369,9 +371,9 @@ elsa_interrupt(int intno, void *dev_id, struct pt_regs *regs) ...@@ -369,9 +371,9 @@ elsa_interrupt(int intno, void *dev_id, struct pt_regs *regs)
} }
if (!icnt) if (!icnt)
printk(KERN_WARNING"ELSA IRQ LOOP\n"); printk(KERN_WARNING"ELSA IRQ LOOP\n");
writereg(cs->hw.elsa.ale, cs->hw.elsa.hscx, HSCX_MASK, 0xFF); writereg(cs, cs->hw.elsa.hscx, HSCX_MASK, 0xFF);
writereg(cs->hw.elsa.ale, cs->hw.elsa.hscx, HSCX_MASK + 0x40, 0xFF); writereg(cs, cs->hw.elsa.hscx, HSCX_MASK + 0x40, 0xFF);
writereg(cs->hw.elsa.ale, cs->hw.elsa.isac, ISAC_MASK, 0xFF); writereg(cs, cs->hw.elsa.isac, ISAC_MASK, 0xFF);
if (cs->hw.elsa.status & ELSA_TIMER_AKTIV) { if (cs->hw.elsa.status & ELSA_TIMER_AKTIV) {
if (!TimerRun(cs)) { if (!TimerRun(cs)) {
/* Timer Restart */ /* Timer Restart */
...@@ -391,9 +393,9 @@ elsa_interrupt(int intno, void *dev_id, struct pt_regs *regs) ...@@ -391,9 +393,9 @@ elsa_interrupt(int intno, void *dev_id, struct pt_regs *regs)
#endif #endif
if (cs->hw.elsa.trig) if (cs->hw.elsa.trig)
byteout(cs->hw.elsa.trig, 0x00); byteout(cs->hw.elsa.trig, 0x00);
writereg(cs->hw.elsa.ale, cs->hw.elsa.hscx, HSCX_MASK, 0x0); writereg(cs, cs->hw.elsa.hscx, HSCX_MASK, 0x0);
writereg(cs->hw.elsa.ale, cs->hw.elsa.hscx, HSCX_MASK + 0x40, 0x0); writereg(cs, cs->hw.elsa.hscx, HSCX_MASK + 0x40, 0x0);
writereg(cs->hw.elsa.ale, cs->hw.elsa.isac, ISAC_MASK, 0x0); writereg(cs, cs->hw.elsa.isac, ISAC_MASK, 0x0);
unlock: unlock:
spin_unlock(&cs->lock); spin_unlock(&cs->lock);
} }
...@@ -424,12 +426,12 @@ elsa_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs) ...@@ -424,12 +426,12 @@ elsa_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs)
} }
} }
#endif #endif
ista = readreg(cs->hw.elsa.ale, cs->hw.elsa.isac, IPAC_ISTA); ista = readreg(cs, cs->hw.elsa.isac, IPAC_ISTA);
Start_IPAC: Start_IPAC:
if (cs->debug & L1_DEB_IPAC) if (cs->debug & L1_DEB_IPAC)
debugl1(cs, "IPAC ISTA %02X", ista); debugl1(cs, "IPAC ISTA %02X", ista);
if (ista & 0x0f) { if (ista & 0x0f) {
val = readreg(cs->hw.elsa.ale, cs->hw.elsa.hscx, HSCX_ISTA + 0x40); val = readreg(cs, cs->hw.elsa.hscx, HSCX_ISTA + 0x40);
if (ista & 0x01) if (ista & 0x01)
val |= 0x01; val |= 0x01;
if (ista & 0x04) if (ista & 0x04)
...@@ -440,7 +442,7 @@ elsa_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs) ...@@ -440,7 +442,7 @@ elsa_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs)
hscx_int_main(cs, val); hscx_int_main(cs, val);
} }
if (ista & 0x20) { if (ista & 0x20) {
val = 0xfe & readreg(cs->hw.elsa.ale, cs->hw.elsa.isac, ISAC_ISTA + 0x80); val = 0xfe & readreg(cs, cs->hw.elsa.isac, ISAC_ISTA + 0x80);
if (val) { if (val) {
isac_interrupt(cs, val); isac_interrupt(cs, val);
} }
...@@ -449,15 +451,15 @@ elsa_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs) ...@@ -449,15 +451,15 @@ elsa_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs)
val = 0x01; val = 0x01;
isac_interrupt(cs, val); isac_interrupt(cs, val);
} }
ista = readreg(cs->hw.elsa.ale, cs->hw.elsa.isac, IPAC_ISTA); ista = readreg(cs, cs->hw.elsa.isac, IPAC_ISTA);
if ((ista & 0x3f) && icnt) { if ((ista & 0x3f) && icnt) {
icnt--; icnt--;
goto Start_IPAC; goto Start_IPAC;
} }
if (!icnt) if (!icnt)
printk(KERN_WARNING "ELSA IRQ LOOP\n"); printk(KERN_WARNING "ELSA IRQ LOOP\n");
writereg(cs->hw.elsa.ale, cs->hw.elsa.isac, IPAC_MASK, 0xFF); writereg(cs, cs->hw.elsa.isac, IPAC_MASK, 0xFF);
writereg(cs->hw.elsa.ale, cs->hw.elsa.isac, IPAC_MASK, 0xC0); writereg(cs, cs->hw.elsa.isac, IPAC_MASK, 0xC0);
} }
void void
...@@ -473,17 +475,17 @@ release_io_elsa(struct IsdnCardState *cs) ...@@ -473,17 +475,17 @@ release_io_elsa(struct IsdnCardState *cs)
byteout(cs->hw.elsa.ctrl, 0); /* LEDs Out */ byteout(cs->hw.elsa.ctrl, 0); /* LEDs Out */
if (cs->subtyp == ELSA_QS1000PCI) { if (cs->subtyp == ELSA_QS1000PCI) {
byteout(cs->hw.elsa.cfg + 0x4c, 0x01); /* disable IRQ */ byteout(cs->hw.elsa.cfg + 0x4c, 0x01); /* disable IRQ */
writereg(cs->hw.elsa.ale, cs->hw.elsa.isac, IPAC_ATX, 0xff); writereg(cs, cs->hw.elsa.isac, IPAC_ATX, 0xff);
bytecnt = 2; bytecnt = 2;
release_region(cs->hw.elsa.cfg, 0x80); release_region(cs->hw.elsa.cfg, 0x80);
} }
if (cs->subtyp == ELSA_QS3000PCI) { if (cs->subtyp == ELSA_QS3000PCI) {
byteout(cs->hw.elsa.cfg + 0x4c, 0x03); /* disable ELSA PCI IRQ */ byteout(cs->hw.elsa.cfg + 0x4c, 0x03); /* disable ELSA PCI IRQ */
writereg(cs->hw.elsa.ale, cs->hw.elsa.isac, IPAC_ATX, 0xff); writereg(cs, cs->hw.elsa.isac, IPAC_ATX, 0xff);
release_region(cs->hw.elsa.cfg, 0x80); release_region(cs->hw.elsa.cfg, 0x80);
} }
if (cs->subtyp == ELSA_PCMCIA_IPAC) { if (cs->subtyp == ELSA_PCMCIA_IPAC) {
writereg(cs->hw.elsa.ale, cs->hw.elsa.isac, IPAC_ATX, 0xff); writereg(cs, cs->hw.elsa.isac, IPAC_ATX, 0xff);
} }
if ((cs->subtyp == ELSA_PCFPRO) || if ((cs->subtyp == ELSA_PCFPRO) ||
(cs->subtyp == ELSA_QS3000) || (cs->subtyp == ELSA_QS3000) ||
...@@ -520,22 +522,22 @@ reset_elsa(struct IsdnCardState *cs) ...@@ -520,22 +522,22 @@ reset_elsa(struct IsdnCardState *cs)
byteout(cs->hw.elsa.trig, 0xff); byteout(cs->hw.elsa.trig, 0xff);
} }
if ((cs->subtyp == ELSA_QS1000PCI) || (cs->subtyp == ELSA_QS3000PCI) || (cs->subtyp == ELSA_PCMCIA_IPAC)) { if ((cs->subtyp == ELSA_QS1000PCI) || (cs->subtyp == ELSA_QS3000PCI) || (cs->subtyp == ELSA_PCMCIA_IPAC)) {
writereg(cs->hw.elsa.ale, cs->hw.elsa.isac, IPAC_POTA2, 0x20); writereg(cs, cs->hw.elsa.isac, IPAC_POTA2, 0x20);
set_current_state(TASK_UNINTERRUPTIBLE); set_current_state(TASK_UNINTERRUPTIBLE);
schedule_timeout((10*HZ)/1000); /* Timeout 10ms */ schedule_timeout((10*HZ)/1000); /* Timeout 10ms */
writereg(cs->hw.elsa.ale, cs->hw.elsa.isac, IPAC_POTA2, 0x00); writereg(cs, cs->hw.elsa.isac, IPAC_POTA2, 0x00);
set_current_state(TASK_UNINTERRUPTIBLE); set_current_state(TASK_UNINTERRUPTIBLE);
writereg(cs->hw.elsa.ale, cs->hw.elsa.isac, IPAC_MASK, 0xc0); writereg(cs, cs->hw.elsa.isac, IPAC_MASK, 0xc0);
schedule_timeout((10*HZ)/1000); /* Timeout 10ms */ schedule_timeout((10*HZ)/1000); /* Timeout 10ms */
if (cs->subtyp != ELSA_PCMCIA_IPAC) { if (cs->subtyp != ELSA_PCMCIA_IPAC) {
writereg(cs->hw.elsa.ale, cs->hw.elsa.isac, IPAC_ACFG, 0x0); writereg(cs, cs->hw.elsa.isac, IPAC_ACFG, 0x0);
writereg(cs->hw.elsa.ale, cs->hw.elsa.isac, IPAC_AOE, 0x3c); writereg(cs, cs->hw.elsa.isac, IPAC_AOE, 0x3c);
} else { } else {
writereg(cs->hw.elsa.ale, cs->hw.elsa.isac, IPAC_PCFG, 0x10); writereg(cs, cs->hw.elsa.isac, IPAC_PCFG, 0x10);
writereg(cs->hw.elsa.ale, cs->hw.elsa.isac, IPAC_ACFG, 0x4); writereg(cs, cs->hw.elsa.isac, IPAC_ACFG, 0x4);
writereg(cs->hw.elsa.ale, cs->hw.elsa.isac, IPAC_AOE, 0xf8); writereg(cs, cs->hw.elsa.isac, IPAC_AOE, 0xf8);
} }
writereg(cs->hw.elsa.ale, cs->hw.elsa.isac, IPAC_ATX, 0xff); writereg(cs, cs->hw.elsa.isac, IPAC_ATX, 0xff);
if (cs->subtyp == ELSA_QS1000PCI) if (cs->subtyp == ELSA_QS1000PCI)
byteout(cs->hw.elsa.cfg + 0x4c, 0x41); /* enable ELSA PCI IRQ */ byteout(cs->hw.elsa.cfg + 0x4c, 0x41); /* enable ELSA PCI IRQ */
else if (cs->subtyp == ELSA_QS3000PCI) else if (cs->subtyp == ELSA_QS3000PCI)
...@@ -673,7 +675,7 @@ elsa_led_handler(struct IsdnCardState *cs) ...@@ -673,7 +675,7 @@ elsa_led_handler(struct IsdnCardState *cs)
led ^= ELSA_IPAC_LINE_LED; led ^= ELSA_IPAC_LINE_LED;
if (cs->hw.elsa.ctrl_reg & ELSA_STAT_LED) if (cs->hw.elsa.ctrl_reg & ELSA_STAT_LED)
led ^= ELSA_IPAC_STAT_LED; led ^= ELSA_IPAC_STAT_LED;
writereg(cs->hw.elsa.ale, cs->hw.elsa.isac, IPAC_ATX, led); writereg(cs, cs->hw.elsa.isac, IPAC_ATX, led);
} else } else
byteout(cs->hw.elsa.ctrl, cs->hw.elsa.ctrl_reg); byteout(cs->hw.elsa.ctrl, cs->hw.elsa.ctrl_reg);
if (blink) { if (blink) {
...@@ -1020,10 +1022,10 @@ setup_elsa(struct IsdnCard *card) ...@@ -1020,10 +1022,10 @@ setup_elsa(struct IsdnCard *card)
} else if (cs->typ == ISDN_CTYPE_ELSA_PCMCIA) { } else if (cs->typ == ISDN_CTYPE_ELSA_PCMCIA) {
cs->hw.elsa.base = card->para[1]; cs->hw.elsa.base = card->para[1];
cs->irq = card->para[0]; cs->irq = card->para[0];
val = readreg(cs->hw.elsa.base + 0, cs->hw.elsa.base + 2, IPAC_ID); cs->hw.elsa.ale = cs->hw.elsa.base + 0;
val = readreg(cs, cs->hw.elsa.base + 2, IPAC_ID);
if ((val == 1) || (val == 2)) { /* IPAC version 1.1/1.2 */ if ((val == 1) || (val == 2)) { /* IPAC version 1.1/1.2 */
cs->subtyp = ELSA_PCMCIA_IPAC; cs->subtyp = ELSA_PCMCIA_IPAC;
cs->hw.elsa.ale = cs->hw.elsa.base + 0;
cs->hw.elsa.isac = cs->hw.elsa.base + 2; cs->hw.elsa.isac = cs->hw.elsa.base + 2;
cs->hw.elsa.hscx = cs->hw.elsa.base + 2; cs->hw.elsa.hscx = cs->hw.elsa.base + 2;
test_and_set_bit(HW_IPAC, &cs->HW_Flags); test_and_set_bit(HW_IPAC, &cs->HW_Flags);
...@@ -1185,7 +1187,7 @@ setup_elsa(struct IsdnCard *card) ...@@ -1185,7 +1187,7 @@ setup_elsa(struct IsdnCard *card)
if ((cs->subtyp == ELSA_QS1000PCI) || (cs->subtyp == ELSA_QS3000PCI) || (cs->subtyp == ELSA_PCMCIA_IPAC)) { if ((cs->subtyp == ELSA_QS1000PCI) || (cs->subtyp == ELSA_QS3000PCI) || (cs->subtyp == ELSA_PCMCIA_IPAC)) {
cs->dc_hw_ops = &ipac_dc_ops; cs->dc_hw_ops = &ipac_dc_ops;
cs->irq_func = &elsa_interrupt_ipac; cs->irq_func = &elsa_interrupt_ipac;
val = readreg(cs->hw.elsa.ale, cs->hw.elsa.isac, IPAC_ID); val = readreg(cs, cs->hw.elsa.isac, IPAC_ID);
printk(KERN_INFO "Elsa: IPAC version %x\n", val); printk(KERN_INFO "Elsa: IPAC version %x\n", val);
} else { } else {
cs->dc_hw_ops = &isac_ops; cs->dc_hw_ops = &isac_ops;
......
drivers/isdn/hisax/ix1_micro.c
View file @ 24e904bd
...@@ -40,46 +40,51 @@ static spinlock_t ix1_micro_lock = SPIN_LOCK_UNLOCKED; ...@@ -40,46 +40,51 @@ static spinlock_t ix1_micro_lock = SPIN_LOCK_UNLOCKED;
#define TIMEOUT 50 #define TIMEOUT 50
static inline u_char static inline u8
readreg(unsigned int ale, unsigned int adr, u_char off) readreg(struct IsdnCardState *cs, unsigned int adr, u8 off)
{ {
register u_char ret; u8 ret;
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&ix1_micro_lock, flags); spin_lock_irqsave(&ix1_micro_lock, flags);
byteout(ale, off); byteout(cs->hw.ix1.isac_ale, off);
ret = bytein(adr); ret = bytein(adr);
spin_unlock_irqrestore(&ix1_micro_lock, flags); spin_unlock_irqrestore(&ix1_micro_lock, flags);
return (ret); return (ret);
} }
static inline void static inline void
readfifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int size) readfifo(struct IsdnCardState *cs, unsigned int adr, u8 off, u8 * data, int size)
{ {
/* fifo read without cli because it's allready done */ unsigned long flags;
byteout(ale, off); spin_lock_irqsave(&ix1_micro_lock, flags);
byteout(cs->hw.ix1.isac_ale, off);
insb(adr, data, size); insb(adr, data, size);
spin_unlock_irqrestore(&ix1_micro_lock, flags);
} }
static inline void static inline void
writereg(unsigned int ale, unsigned int adr, u_char off, u_char data) writereg(struct IsdnCardState *cs, unsigned int adr, u8 off, u8 data)
{ {
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&ix1_micro_lock, flags); spin_lock_irqsave(&ix1_micro_lock, flags);
byteout(ale, off); byteout(cs->hw.ix1.isac_ale, off);
byteout(adr, data); byteout(adr, data);
spin_unlock_irqrestore(&ix1_micro_lock, flags); spin_unlock_irqrestore(&ix1_micro_lock, flags);
} }
static inline void static inline void
writefifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int size) writefifo(struct IsdnCardState *cs, unsigned int adr, u8 off, u8 * data, int size)
{ {
/* fifo write without cli because it's allready done */ unsigned long flags;
byteout(ale, off);
spin_lock_irqsave(&ix1_micro_lock, flags);
byteout(cs->hw.ix1.isac_ale, off);
outsb(adr, data, size); outsb(adr, data, size);
spin_unlock_irqrestore(&ix1_micro_lock, flags);
} }
/* Interface functions */ /* Interface functions */
...@@ -87,25 +92,25 @@ writefifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int siz ...@@ -87,25 +92,25 @@ writefifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int siz
static u_char static u_char
ReadISAC(struct IsdnCardState *cs, u_char offset) ReadISAC(struct IsdnCardState *cs, u_char offset)
{ {
return (readreg(cs->hw.ix1.isac_ale, cs->hw.ix1.isac, offset)); return readreg(cs, cs->hw.ix1.isac, offset);
} }
static void static void
WriteISAC(struct IsdnCardState *cs, u_char offset, u_char value) WriteISAC(struct IsdnCardState *cs, u_char offset, u_char value)
{ {
writereg(cs->hw.ix1.isac_ale, cs->hw.ix1.isac, offset, value); writereg(cs, cs->hw.ix1.isac, offset, value);
} }
static void static void
ReadISACfifo(struct IsdnCardState *cs, u_char * data, int size) ReadISACfifo(struct IsdnCardState *cs, u_char * data, int size)
{ {
readfifo(cs->hw.ix1.isac_ale, cs->hw.ix1.isac, 0, data, size); readfifo(cs, cs->hw.ix1.isac, 0, data, size);
} }
static void static void
WriteISACfifo(struct IsdnCardState *cs, u_char * data, int size) WriteISACfifo(struct IsdnCardState *cs, u_char * data, int size)
{ {
writefifo(cs->hw.ix1.isac_ale, cs->hw.ix1.isac, 0, data, size); writefifo(cs, cs->hw.ix1.isac, 0, data, size);
} }
static struct dc_hw_ops isac_ops = { static struct dc_hw_ops isac_ops = {
...@@ -118,15 +123,13 @@ static struct dc_hw_ops isac_ops = { ...@@ -118,15 +123,13 @@ static struct dc_hw_ops isac_ops = {
static u_char static u_char
ReadHSCX(struct IsdnCardState *cs, int hscx, u_char offset) ReadHSCX(struct IsdnCardState *cs, int hscx, u_char offset)
{ {
return (readreg(cs->hw.ix1.hscx_ale, return readreg(cs, cs->hw.ix1.hscx, offset + (hscx ? 0x40 : 0));
cs->hw.ix1.hscx, offset + (hscx ? 0x40 : 0)));
} }
static void static void
WriteHSCX(struct IsdnCardState *cs, int hscx, u_char offset, u_char value) WriteHSCX(struct IsdnCardState *cs, int hscx, u_char offset, u_char value)
{ {
writereg(cs->hw.ix1.hscx_ale, writereg(cs, cs->hw.ix1.hscx, offset + (hscx ? 0x40 : 0), value);
cs->hw.ix1.hscx, offset + (hscx ? 0x40 : 0), value);
} }
static struct bc_hw_ops hscx_ops = { static struct bc_hw_ops hscx_ops = {
...@@ -134,15 +137,15 @@ static struct bc_hw_ops hscx_ops = { ...@@ -134,15 +137,15 @@ static struct bc_hw_ops hscx_ops = {
.write_reg = WriteHSCX, .write_reg = WriteHSCX,
}; };
#define READHSCX(cs, nr, reg) readreg(cs->hw.ix1.hscx_ale, \ #define READHSCX(cs, nr, reg) readreg(cs, \
cs->hw.ix1.hscx, reg + (nr ? 0x40 : 0)) cs->hw.ix1.hscx, reg + (nr ? 0x40 : 0))
#define WRITEHSCX(cs, nr, reg, data) writereg(cs->hw.ix1.hscx_ale, \ #define WRITEHSCX(cs, nr, reg, data) writereg(cs, \
cs->hw.ix1.hscx, reg + (nr ? 0x40 : 0), data) cs->hw.ix1.hscx, reg + (nr ? 0x40 : 0), data)
#define READHSCXFIFO(cs, nr, ptr, cnt) readfifo(cs->hw.ix1.hscx_ale, \ #define READHSCXFIFO(cs, nr, ptr, cnt) readfifo(cs, \
cs->hw.ix1.hscx, (nr ? 0x40 : 0), ptr, cnt) cs->hw.ix1.hscx, (nr ? 0x40 : 0), ptr, cnt)
#define WRITEHSCXFIFO(cs, nr, ptr, cnt) writefifo(cs->hw.ix1.hscx_ale, \ #define WRITEHSCXFIFO(cs, nr, ptr, cnt) writefifo(cs, \
cs->hw.ix1.hscx, (nr ? 0x40 : 0), ptr, cnt) cs->hw.ix1.hscx, (nr ? 0x40 : 0), ptr, cnt)
#include "hscx_irq.c" #include "hscx_irq.c"
...@@ -154,32 +157,32 @@ ix1micro_interrupt(int intno, void *dev_id, struct pt_regs *regs) ...@@ -154,32 +157,32 @@ ix1micro_interrupt(int intno, void *dev_id, struct pt_regs *regs)
u_char val; u_char val;
spin_lock(&cs->lock); spin_lock(&cs->lock);
val = readreg(cs->hw.ix1.hscx_ale, cs->hw.ix1.hscx, HSCX_ISTA + 0x40); val = readreg(cs, cs->hw.ix1.hscx, HSCX_ISTA + 0x40);
Start_HSCX: Start_HSCX:
if (val) if (val)
hscx_int_main(cs, val); hscx_int_main(cs, val);
val = readreg(cs->hw.ix1.isac_ale, cs->hw.ix1.isac, ISAC_ISTA); val = readreg(cs, cs->hw.ix1.isac, ISAC_ISTA);
Start_ISAC: Start_ISAC:
if (val) if (val)
isac_interrupt(cs, val); isac_interrupt(cs, val);
val = readreg(cs->hw.ix1.hscx_ale, cs->hw.ix1.hscx, HSCX_ISTA + 0x40); val = readreg(cs, cs->hw.ix1.hscx, HSCX_ISTA + 0x40);
if (val) { if (val) {
if (cs->debug & L1_DEB_HSCX) if (cs->debug & L1_DEB_HSCX)
debugl1(cs, "HSCX IntStat after IntRoutine"); debugl1(cs, "HSCX IntStat after IntRoutine");
goto Start_HSCX; goto Start_HSCX;
} }
val = readreg(cs->hw.ix1.isac_ale, cs->hw.ix1.isac, ISAC_ISTA); val = readreg(cs, cs->hw.ix1.isac, ISAC_ISTA);
if (val) { if (val) {
if (cs->debug & L1_DEB_ISAC) if (cs->debug & L1_DEB_ISAC)
debugl1(cs, "ISAC IntStat after IntRoutine"); debugl1(cs, "ISAC IntStat after IntRoutine");
goto Start_ISAC; goto Start_ISAC;
} }
writereg(cs->hw.ix1.hscx_ale, cs->hw.ix1.hscx, HSCX_MASK, 0xFF); writereg(cs, cs->hw.ix1.hscx, HSCX_MASK, 0xFF);
writereg(cs->hw.ix1.hscx_ale, cs->hw.ix1.hscx, HSCX_MASK + 0x40, 0xFF); writereg(cs, cs->hw.ix1.hscx, HSCX_MASK + 0x40, 0xFF);
writereg(cs->hw.ix1.isac_ale, cs->hw.ix1.isac, ISAC_MASK, 0xFF); writereg(cs, cs->hw.ix1.isac, ISAC_MASK, 0xFF);
writereg(cs->hw.ix1.isac_ale, cs->hw.ix1.isac, ISAC_MASK, 0); writereg(cs, cs->hw.ix1.isac, ISAC_MASK, 0);
writereg(cs->hw.ix1.hscx_ale, cs->hw.ix1.hscx, HSCX_MASK, 0); writereg(cs, cs->hw.ix1.hscx, HSCX_MASK, 0);
writereg(cs->hw.ix1.hscx_ale, cs->hw.ix1.hscx, HSCX_MASK + 0x40, 0); writereg(cs, cs->hw.ix1.hscx, HSCX_MASK + 0x40, 0);
spin_unlock(&cs->lock); spin_unlock(&cs->lock);
} }
...@@ -291,7 +294,6 @@ setup_ix1micro(struct IsdnCard *card) ...@@ -291,7 +294,6 @@ setup_ix1micro(struct IsdnCard *card)
#endif #endif
/* IO-Ports */ /* IO-Ports */
cs->hw.ix1.isac_ale = card->para[1] + ISAC_COMMAND_OFFSET; cs->hw.ix1.isac_ale = card->para[1] + ISAC_COMMAND_OFFSET;
cs->hw.ix1.hscx_ale = card->para[1] + HSCX_COMMAND_OFFSET;
cs->hw.ix1.isac = card->para[1] + ISAC_DATA_OFFSET; cs->hw.ix1.isac = card->para[1] + ISAC_DATA_OFFSET;
cs->hw.ix1.hscx = card->para[1] + HSCX_DATA_OFFSET; cs->hw.ix1.hscx = card->para[1] + HSCX_DATA_OFFSET;
cs->hw.ix1.cfg_reg = card->para[1]; cs->hw.ix1.cfg_reg = card->para[1];
......
drivers/isdn/hisax/mic.c
View file @ 24e904bd
...@@ -31,14 +31,14 @@ static spinlock_t mic_lock = SPIN_LOCK_UNLOCKED; ...@@ -31,14 +31,14 @@ static spinlock_t mic_lock = SPIN_LOCK_UNLOCKED;
/* CARD_ADR (Write) */ /* CARD_ADR (Write) */
#define MIC_RESET 0x3 /* same as DOS driver */ #define MIC_RESET 0x3 /* same as DOS driver */
static inline u_char static inline u8
readreg(unsigned int ale, unsigned int adr, u_char off) readreg(struct IsdnCardState *cs, unsigned int adr, u8 off)
{ {
register u_char ret; u8 ret;
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&mic_lock, flags); spin_lock_irqsave(&mic_lock, flags);
byteout(ale, off); byteout(cs->hw.mic.adr, off);
ret = bytein(adr); ret = bytein(adr);
spin_unlock_irqrestore(&mic_lock, flags); spin_unlock_irqrestore(&mic_lock, flags);
...@@ -46,32 +46,36 @@ readreg(unsigned int ale, unsigned int adr, u_char off) ...@@ -46,32 +46,36 @@ readreg(unsigned int ale, unsigned int adr, u_char off)
} }
static inline void static inline void
readfifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int size) writereg(struct IsdnCardState *cs, unsigned int adr, u8 off, u8 data)
{ {
/* fifo read without cli because it's allready done */ unsigned long flags;
byteout(ale, off); spin_lock_irqsave(&mic_lock, flags);
insb(adr, data, size); byteout(cs->hw.mic.adr, off);
byteout(adr, data);
spin_unlock_irqrestore(&mic_lock, flags);
} }
static inline void static inline void
writereg(unsigned int ale, unsigned int adr, u_char off, u_char data) readfifo(struct IsdnCardState *cs, unsigned int adr, u8 off, u8 * data, int size)
{ {
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&mic_lock, flags); spin_lock_irqsave(&mic_lock, flags);
byteout(ale, off); byteout(cs->hw.mic.adr, off);
byteout(adr, data); insb(adr, data, size);
spin_unlock_irqrestore(&mic_lock, flags); spin_unlock_irqrestore(&mic_lock, flags);
} }
static inline void static inline void
writefifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int size) writefifo(struct IsdnCardState *cs, unsigned int adr, u8 off, u8 * data, int size)
{ {
/* fifo write without cli because it's allready done */ unsigned long flags;
byteout(ale, off);
spin_lock_irqsave(&mic_lock, flags);
byteout(cs->hw.mic.adr, off);
outsb(adr, data, size); outsb(adr, data, size);
spin_unlock_irqrestore(&mic_lock, flags);
} }
/* Interface functions */ /* Interface functions */
...@@ -79,25 +83,25 @@ writefifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int siz ...@@ -79,25 +83,25 @@ writefifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int siz
static u_char static u_char
ReadISAC(struct IsdnCardState *cs, u_char offset) ReadISAC(struct IsdnCardState *cs, u_char offset)
{ {
return (readreg(cs->hw.mic.adr, cs->hw.mic.isac, offset)); return readreg(cs, cs->hw.mic.isac, offset);
} }
static void static void
WriteISAC(struct IsdnCardState *cs, u_char offset, u_char value) WriteISAC(struct IsdnCardState *cs, u_char offset, u_char value)
{ {
writereg(cs->hw.mic.adr, cs->hw.mic.isac, offset, value); writereg(cs, cs->hw.mic.isac, offset, value);
} }
static void static void
ReadISACfifo(struct IsdnCardState *cs, u_char * data, int size) ReadISACfifo(struct IsdnCardState *cs, u_char * data, int size)
{ {
readfifo(cs->hw.mic.adr, cs->hw.mic.isac, 0, data, size); readfifo(cs, cs->hw.mic.isac, 0, data, size);
} }
static void static void
WriteISACfifo(struct IsdnCardState *cs, u_char * data, int size) WriteISACfifo(struct IsdnCardState *cs, u_char * data, int size)
{ {
writefifo(cs->hw.mic.adr, cs->hw.mic.isac, 0, data, size); writefifo(cs, cs->hw.mic.isac, 0, data, size);
} }
static struct dc_hw_ops isac_ops = { static struct dc_hw_ops isac_ops = {
...@@ -110,15 +114,13 @@ static struct dc_hw_ops isac_ops = { ...@@ -110,15 +114,13 @@ static struct dc_hw_ops isac_ops = {
static u_char static u_char
ReadHSCX(struct IsdnCardState *cs, int hscx, u_char offset) ReadHSCX(struct IsdnCardState *cs, int hscx, u_char offset)
{ {
return (readreg(cs->hw.mic.adr, return readreg(cs, cs->hw.mic.hscx, offset + (hscx ? 0x40 : 0));
cs->hw.mic.hscx, offset + (hscx ? 0x40 : 0)));
} }
static void static void
WriteHSCX(struct IsdnCardState *cs, int hscx, u_char offset, u_char value) WriteHSCX(struct IsdnCardState *cs, int hscx, u_char offset, u_char value)
{ {
writereg(cs->hw.mic.adr, writereg(cs, cs->hw.mic.hscx, offset + (hscx ? 0x40 : 0), value);
cs->hw.mic.hscx, offset + (hscx ? 0x40 : 0), value);
} }
static struct bc_hw_ops hscx_ops = { static struct bc_hw_ops hscx_ops = {
...@@ -130,15 +132,15 @@ static struct bc_hw_ops hscx_ops = { ...@@ -130,15 +132,15 @@ static struct bc_hw_ops hscx_ops = {
* fast interrupt HSCX stuff goes here * fast interrupt HSCX stuff goes here
*/ */
#define READHSCX(cs, nr, reg) readreg(cs->hw.mic.adr, \ #define READHSCX(cs, nr, reg) readreg(cs, \
cs->hw.mic.hscx, reg + (nr ? 0x40 : 0)) cs->hw.mic.hscx, reg + (nr ? 0x40 : 0))
#define WRITEHSCX(cs, nr, reg, data) writereg(cs->hw.mic.adr, \ #define WRITEHSCX(cs, nr, reg, data) writereg(cs, \
cs->hw.mic.hscx, reg + (nr ? 0x40 : 0), data) cs->hw.mic.hscx, reg + (nr ? 0x40 : 0), data)
#define READHSCXFIFO(cs, nr, ptr, cnt) readfifo(cs->hw.mic.adr, \ #define READHSCXFIFO(cs, nr, ptr, cnt) readfifo(cs, \
cs->hw.mic.hscx, (nr ? 0x40 : 0), ptr, cnt) cs->hw.mic.hscx, (nr ? 0x40 : 0), ptr, cnt)
#define WRITEHSCXFIFO(cs, nr, ptr, cnt) writefifo(cs->hw.mic.adr, \ #define WRITEHSCXFIFO(cs, nr, ptr, cnt) writefifo(cs, \
cs->hw.mic.hscx, (nr ? 0x40 : 0), ptr, cnt) cs->hw.mic.hscx, (nr ? 0x40 : 0), ptr, cnt)
#include "hscx_irq.c" #include "hscx_irq.c"
...@@ -150,32 +152,32 @@ mic_interrupt(int intno, void *dev_id, struct pt_regs *regs) ...@@ -150,32 +152,32 @@ mic_interrupt(int intno, void *dev_id, struct pt_regs *regs)
u_char val; u_char val;
spin_lock(&cs->lock); spin_lock(&cs->lock);
val = readreg(cs->hw.mic.adr, cs->hw.mic.hscx, HSCX_ISTA + 0x40); val = readreg(cs, cs->hw.mic.hscx, HSCX_ISTA + 0x40);
Start_HSCX: Start_HSCX:
if (val) if (val)
hscx_int_main(cs, val); hscx_int_main(cs, val);
val = readreg(cs->hw.mic.adr, cs->hw.mic.isac, ISAC_ISTA); val = readreg(cs, cs->hw.mic.isac, ISAC_ISTA);
Start_ISAC: Start_ISAC:
if (val) if (val)
isac_interrupt(cs, val); isac_interrupt(cs, val);
val = readreg(cs->hw.mic.adr, cs->hw.mic.hscx, HSCX_ISTA + 0x40); val = readreg(cs, cs->hw.mic.hscx, HSCX_ISTA + 0x40);
if (val) { if (val) {
if (cs->debug & L1_DEB_HSCX) if (cs->debug & L1_DEB_HSCX)
debugl1(cs, "HSCX IntStat after IntRoutine"); debugl1(cs, "HSCX IntStat after IntRoutine");
goto Start_HSCX; goto Start_HSCX;
} }
val = readreg(cs->hw.mic.adr, cs->hw.mic.isac, ISAC_ISTA); val = readreg(cs, cs->hw.mic.isac, ISAC_ISTA);
if (val) { if (val) {
if (cs->debug & L1_DEB_ISAC) if (cs->debug & L1_DEB_ISAC)
debugl1(cs, "ISAC IntStat after IntRoutine"); debugl1(cs, "ISAC IntStat after IntRoutine");
goto Start_ISAC; goto Start_ISAC;
} }
writereg(cs->hw.mic.adr, cs->hw.mic.hscx, HSCX_MASK, 0xFF); writereg(cs, cs->hw.mic.hscx, HSCX_MASK, 0xFF);
writereg(cs->hw.mic.adr, cs->hw.mic.hscx, HSCX_MASK + 0x40, 0xFF); writereg(cs, cs->hw.mic.hscx, HSCX_MASK + 0x40, 0xFF);
writereg(cs->hw.mic.adr, cs->hw.mic.isac, ISAC_MASK, 0xFF); writereg(cs, cs->hw.mic.isac, ISAC_MASK, 0xFF);
writereg(cs->hw.mic.adr, cs->hw.mic.isac, ISAC_MASK, 0x0); writereg(cs, cs->hw.mic.isac, ISAC_MASK, 0x0);
writereg(cs->hw.mic.adr, cs->hw.mic.hscx, HSCX_MASK, 0x0); writereg(cs, cs->hw.mic.hscx, HSCX_MASK, 0x0);
writereg(cs->hw.mic.adr, cs->hw.mic.hscx, HSCX_MASK + 0x40, 0x0); writereg(cs, cs->hw.mic.hscx, HSCX_MASK + 0x40, 0x0);
spin_unlock(&cs->lock); spin_unlock(&cs->lock);
} }
......
drivers/isdn/hisax/niccy.c
View file @ 24e904bd
...@@ -47,46 +47,50 @@ static spinlock_t niccy_lock = SPIN_LOCK_UNLOCKED; ...@@ -47,46 +47,50 @@ static spinlock_t niccy_lock = SPIN_LOCK_UNLOCKED;
#define PCI_IRQ_DISABLE 0xff0000 #define PCI_IRQ_DISABLE 0xff0000
#define PCI_IRQ_ASSERT 0x800000 #define PCI_IRQ_ASSERT 0x800000
static inline u_char static inline u8
readreg(unsigned int ale, unsigned int adr, u_char off) readreg(unsigned int ale, unsigned int adr, u8 off)
{ {
register u_char ret; u8 ret;
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&niccy_lock, flags); spin_lock_irqsave(&niccy_lock, flags);
byteout(ale, off); byteout(ale, off);
ret = bytein(adr); ret = bytein(adr);
spin_unlock_irqrestore(&niccy_lock, flags); spin_unlock_irqrestore(&niccy_lock, flags);
return (ret); return ret;
} }
static inline void static inline void
readfifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int size) writereg(unsigned int ale, unsigned int adr, u8 off, u8 data)
{ {
/* fifo read without cli because it's allready done */ unsigned long flags;
spin_lock_irqsave(&niccy_lock, flags);
byteout(ale, off); byteout(ale, off);
insb(adr, data, size); byteout(adr, data);
spin_unlock_irqrestore(&niccy_lock, flags);
} }
static inline void static inline void
writereg(unsigned int ale, unsigned int adr, u_char off, u_char data) readfifo(unsigned int ale, unsigned int adr, u8 off, u8 * data, int size)
{ {
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&niccy_lock, flags); spin_lock_irqsave(&niccy_lock, flags);
byteout(ale, off); byteout(ale, off);
byteout(adr, data); insb(adr, data, size);
spin_unlock_irqrestore(&niccy_lock, flags); spin_unlock_irqrestore(&niccy_lock, flags);
} }
static inline void static inline void
writefifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int size) writefifo(unsigned int ale, unsigned int adr, u8 off, u8 * data, int size)
{ {
/* fifo write without cli because it's allready done */ unsigned long flags;
spin_lock_irqsave(&niccy_lock, flags);
byteout(ale, off); byteout(ale, off);
outsb(adr, data, size); outsb(adr, data, size);
spin_unlock_irqrestore(&niccy_lock, flags);
} }
/* Interface functions */ /* Interface functions */
......
drivers/isdn/hisax/s0box.c
View file @ 24e904bd
...@@ -21,8 +21,10 @@ const char *s0box_revision = "$Revision: 2.4.6.2 $"; ...@@ -21,8 +21,10 @@ const char *s0box_revision = "$Revision: 2.4.6.2 $";
static spinlock_t s0box_lock = SPIN_LOCK_UNLOCKED; static spinlock_t s0box_lock = SPIN_LOCK_UNLOCKED;
static inline void static inline void
writereg(unsigned int padr, signed int addr, u_char off, u_char val) { writereg(struct IsdnCardState *cs, int addr, u8 off, u8 val)
{
unsigned long flags; unsigned long flags;
unsigned long padr = cs->hw.teles3.cfg_reg;
spin_lock_irqsave(&s0box_lock, flags); spin_lock_irqsave(&s0box_lock, flags);
outb_p(0x1c,padr+2); outb_p(0x1c,padr+2);
...@@ -36,14 +38,16 @@ writereg(unsigned int padr, signed int addr, u_char off, u_char val) { ...@@ -36,14 +38,16 @@ writereg(unsigned int padr, signed int addr, u_char off, u_char val) {
spin_unlock_irqrestore(&s0box_lock, flags); spin_unlock_irqrestore(&s0box_lock, flags);
} }
static u_char nibtab[] = { 1, 9, 5, 0xd, 3, 0xb, 7, 0xf, static u8 nibtab[] = { 1, 9, 5, 0xd, 3, 0xb, 7, 0xf,
0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
0, 8, 4, 0xc, 2, 0xa, 6, 0xe } ; 0, 8, 4, 0xc, 2, 0xa, 6, 0xe } ;
static inline u_char static inline u8
readreg(unsigned int padr, signed int addr, u_char off) { readreg(struct IsdnCardState *cs, int addr, u8 off)
register u_char n1, n2; {
u8 n1, n2;
unsigned long flags; unsigned long flags;
unsigned long padr = cs->hw.teles3.cfg_reg;
spin_lock_irqsave(&s0box_lock, flags); spin_lock_irqsave(&s0box_lock, flags);
outb_p(0x1c,padr+2); outb_p(0x1c,padr+2);
...@@ -61,10 +65,11 @@ readreg(unsigned int padr, signed int addr, u_char off) { ...@@ -61,10 +65,11 @@ readreg(unsigned int padr, signed int addr, u_char off) {
} }
static inline void static inline void
read_fifo(unsigned int padr, signed int adr, u_char * data, int size) read_fifo(struct IsdnCardState *cs, signed int adr, u8 * data, int size)
{ {
int i; int i;
register u_char n1, n2; u8 n1, n2;
unsigned long padr = cs->hw.teles3.cfg_reg;
outb_p(0x1c, padr+2); outb_p(0x1c, padr+2);
outb_p(0x14, padr+2); outb_p(0x14, padr+2);
...@@ -79,13 +84,14 @@ read_fifo(unsigned int padr, signed int adr, u_char * data, int size) ...@@ -79,13 +84,14 @@ read_fifo(unsigned int padr, signed int adr, u_char * data, int size)
} }
outb_p(0x14,padr+2); outb_p(0x14,padr+2);
outb_p(0x1c,padr+2); outb_p(0x1c,padr+2);
return;
} }
static inline void static inline void
write_fifo(unsigned int padr, signed int adr, u_char * data, int size) write_fifo(struct IsdnCardState *cs, signed int adr, u8 * data, int size)
{ {
int i; int i;
unsigned long padr = cs->hw.teles3.cfg_reg;
outb_p(0x1c, padr+2); outb_p(0x1c, padr+2);
outb_p(0x14, padr+2); outb_p(0x14, padr+2);
outb_p(adr&0x7f, padr); outb_p(adr&0x7f, padr);
...@@ -96,7 +102,6 @@ write_fifo(unsigned int padr, signed int adr, u_char * data, int size) ...@@ -96,7 +102,6 @@ write_fifo(unsigned int padr, signed int adr, u_char * data, int size)
} }
outb_p(0x14,padr+2); outb_p(0x14,padr+2);
outb_p(0x1c,padr+2); outb_p(0x1c,padr+2);
return;
} }
/* Interface functions */ /* Interface functions */
...@@ -104,25 +109,25 @@ write_fifo(unsigned int padr, signed int adr, u_char * data, int size) ...@@ -104,25 +109,25 @@ write_fifo(unsigned int padr, signed int adr, u_char * data, int size)
static u_char static u_char
ReadISAC(struct IsdnCardState *cs, u_char offset) ReadISAC(struct IsdnCardState *cs, u_char offset)
{ {
return (readreg(cs->hw.teles3.cfg_reg, cs->hw.teles3.isac, offset)); return readreg(cs, cs->hw.teles3.isac, offset);
} }
static void static void
WriteISAC(struct IsdnCardState *cs, u_char offset, u_char value) WriteISAC(struct IsdnCardState *cs, u_char offset, u_char value)
{ {
writereg(cs->hw.teles3.cfg_reg, cs->hw.teles3.isac, offset, value); writereg(cs, cs->hw.teles3.isac, offset, value);
} }
static void static void
ReadISACfifo(struct IsdnCardState *cs, u_char * data, int size) ReadISACfifo(struct IsdnCardState *cs, u_char * data, int size)
{ {
read_fifo(cs->hw.teles3.cfg_reg, cs->hw.teles3.isacfifo, data, size); read_fifo(cs, cs->hw.teles3.isacfifo, data, size);
} }
static void static void
WriteISACfifo(struct IsdnCardState *cs, u_char * data, int size) WriteISACfifo(struct IsdnCardState *cs, u_char * data, int size)
{ {
write_fifo(cs->hw.teles3.cfg_reg, cs->hw.teles3.isacfifo, data, size); write_fifo(cs, cs->hw.teles3.isacfifo, data, size);
} }
static struct dc_hw_ops isac_ops = { static struct dc_hw_ops isac_ops = {
...@@ -135,13 +140,13 @@ static struct dc_hw_ops isac_ops = { ...@@ -135,13 +140,13 @@ static struct dc_hw_ops isac_ops = {
static u_char static u_char
ReadHSCX(struct IsdnCardState *cs, int hscx, u_char offset) ReadHSCX(struct IsdnCardState *cs, int hscx, u_char offset)
{ {
return (readreg(cs->hw.teles3.cfg_reg, cs->hw.teles3.hscx[hscx], offset)); return readreg(cs, cs->hw.teles3.hscx[hscx], offset);
} }
static void static void
WriteHSCX(struct IsdnCardState *cs, int hscx, u_char offset, u_char value) WriteHSCX(struct IsdnCardState *cs, int hscx, u_char offset, u_char value)
{ {
writereg(cs->hw.teles3.cfg_reg, cs->hw.teles3.hscx[hscx], offset, value); writereg(cs, cs->hw.teles3.hscx[hscx], offset, value);
} }
static struct bc_hw_ops hscx_ops = { static struct bc_hw_ops hscx_ops = {
...@@ -153,10 +158,10 @@ static struct bc_hw_ops hscx_ops = { ...@@ -153,10 +158,10 @@ static struct bc_hw_ops hscx_ops = {
* fast interrupt HSCX stuff goes here * fast interrupt HSCX stuff goes here
*/ */
#define READHSCX(cs, nr, reg) readreg(cs->hw.teles3.cfg_reg, cs->hw.teles3.hscx[nr], reg) #define READHSCX(cs, nr, reg) readreg(cs, cs->hw.teles3.hscx[nr], reg)
#define WRITEHSCX(cs, nr, reg, data) writereg(cs->hw.teles3.cfg_reg, cs->hw.teles3.hscx[nr], reg, data) #define WRITEHSCX(cs, nr, reg, data) writereg(cs, cs->hw.teles3.hscx[nr], reg, data)
#define READHSCXFIFO(cs, nr, ptr, cnt) read_fifo(cs->hw.teles3.cfg_reg, cs->hw.teles3.hscxfifo[nr], ptr, cnt) #define READHSCXFIFO(cs, nr, ptr, cnt) read_fifo(cs, cs->hw.teles3.hscxfifo[nr], ptr, cnt)
#define WRITEHSCXFIFO(cs, nr, ptr, cnt) write_fifo(cs->hw.teles3.cfg_reg, cs->hw.teles3.hscxfifo[nr], ptr, cnt) #define WRITEHSCXFIFO(cs, nr, ptr, cnt) write_fifo(cs, cs->hw.teles3.hscxfifo[nr], ptr, cnt)
#include "hscx_irq.c" #include "hscx_irq.c"
...@@ -169,22 +174,22 @@ s0box_interrupt(int intno, void *dev_id, struct pt_regs *regs) ...@@ -169,22 +174,22 @@ s0box_interrupt(int intno, void *dev_id, struct pt_regs *regs)
int count = 0; int count = 0;
spin_lock(&cs->lock); spin_lock(&cs->lock);
val = readreg(cs->hw.teles3.cfg_reg, cs->hw.teles3.hscx[1], HSCX_ISTA); val = readreg(cs, cs->hw.teles3.hscx[1], HSCX_ISTA);
Start_HSCX: Start_HSCX:
if (val) if (val)
hscx_int_main(cs, val); hscx_int_main(cs, val);
val = readreg(cs->hw.teles3.cfg_reg, cs->hw.teles3.isac, ISAC_ISTA); val = readreg(cs, cs->hw.teles3.isac, ISAC_ISTA);
Start_ISAC: Start_ISAC:
if (val) if (val)
isac_interrupt(cs, val); isac_interrupt(cs, val);
count++; count++;
val = readreg(cs->hw.teles3.cfg_reg, cs->hw.teles3.hscx[1], HSCX_ISTA); val = readreg(cs, cs->hw.teles3.hscx[1], HSCX_ISTA);
if (val && count < MAXCOUNT) { if (val && count < MAXCOUNT) {
if (cs->debug & L1_DEB_HSCX) if (cs->debug & L1_DEB_HSCX)
debugl1(cs, "HSCX IntStat after IntRoutine"); debugl1(cs, "HSCX IntStat after IntRoutine");
goto Start_HSCX; goto Start_HSCX;
} }
val = readreg(cs->hw.teles3.cfg_reg, cs->hw.teles3.isac, ISAC_ISTA); val = readreg(cs, cs->hw.teles3.isac, ISAC_ISTA);
if (val && count < MAXCOUNT) { if (val && count < MAXCOUNT) {
if (cs->debug & L1_DEB_ISAC) if (cs->debug & L1_DEB_ISAC)
debugl1(cs, "ISAC IntStat after IntRoutine"); debugl1(cs, "ISAC IntStat after IntRoutine");
...@@ -192,12 +197,12 @@ s0box_interrupt(int intno, void *dev_id, struct pt_regs *regs) ...@@ -192,12 +197,12 @@ s0box_interrupt(int intno, void *dev_id, struct pt_regs *regs)
} }
if (count >= MAXCOUNT) if (count >= MAXCOUNT)
printk(KERN_WARNING "S0Box: more than %d loops in s0box_interrupt\n", count); printk(KERN_WARNING "S0Box: more than %d loops in s0box_interrupt\n", count);
writereg(cs->hw.teles3.cfg_reg, cs->hw.teles3.hscx[0], HSCX_MASK, 0xFF); writereg(cs, cs->hw.teles3.hscx[0], HSCX_MASK, 0xFF);
writereg(cs->hw.teles3.cfg_reg, cs->hw.teles3.hscx[1], HSCX_MASK, 0xFF); writereg(cs, cs->hw.teles3.hscx[1], HSCX_MASK, 0xFF);
writereg(cs->hw.teles3.cfg_reg, cs->hw.teles3.isac, ISAC_MASK, 0xFF); writereg(cs, cs->hw.teles3.isac, ISAC_MASK, 0xFF);
writereg(cs->hw.teles3.cfg_reg, cs->hw.teles3.isac, ISAC_MASK, 0x0); writereg(cs, cs->hw.teles3.isac, ISAC_MASK, 0x0);
writereg(cs->hw.teles3.cfg_reg, cs->hw.teles3.hscx[0], HSCX_MASK, 0x0); writereg(cs, cs->hw.teles3.hscx[0], HSCX_MASK, 0x0);
writereg(cs->hw.teles3.cfg_reg, cs->hw.teles3.hscx[1], HSCX_MASK, 0x0); writereg(cs, cs->hw.teles3.hscx[1], HSCX_MASK, 0x0);
spin_unlock(&cs->lock); spin_unlock(&cs->lock);
} }
......
drivers/isdn/hisax/saphir.c
View file @ 24e904bd
...@@ -32,46 +32,50 @@ static spinlock_t saphir_lock = SPIN_LOCK_UNLOCKED; ...@@ -32,46 +32,50 @@ static spinlock_t saphir_lock = SPIN_LOCK_UNLOCKED;
#define SPARE_REG 4 #define SPARE_REG 4
#define RESET_REG 5 #define RESET_REG 5
static inline u_char static inline u8
readreg(unsigned int ale, unsigned int adr, u_char off) readreg(struct IsdnCardState *cs, unsigned int adr, u8 off)
{ {
register u_char ret; u8 ret;
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&saphir_lock, flags); spin_lock_irqsave(&saphir_lock, flags);
byteout(ale, off); byteout(cs->hw.saphir.ale, off);
ret = bytein(adr); ret = bytein(adr);
spin_unlock_irqrestore(&saphir_lock, flags); spin_unlock_irqrestore(&saphir_lock, flags);
return (ret); return ret;
} }
static inline void static inline void
readfifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int size) writereg(struct IsdnCardState *cs, unsigned int adr, u8 off, u8 data)
{ {
/* fifo read without cli because it's allready done */ unsigned long flags;
byteout(ale, off); spin_lock_irqsave(&saphir_lock, flags);
insb(adr, data, size); byteout(cs->hw.saphir.ale, off);
byteout(adr, data);
spin_unlock_irqrestore(&saphir_lock, flags);
} }
static inline void static inline void
writereg(unsigned int ale, unsigned int adr, u_char off, u_char data) readfifo(struct IsdnCardState *cs, unsigned int adr, u8 off, u8 *data, int size)
{ {
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&saphir_lock, flags); spin_lock_irqsave(&saphir_lock, flags);
byteout(ale, off); byteout(cs->hw.saphir.ale, off);
byteout(adr, data); insb(adr, data, size);
spin_unlock_irqrestore(&saphir_lock, flags); spin_unlock_irqrestore(&saphir_lock, flags);
} }
static inline void static inline void
writefifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int size) writefifo(struct IsdnCardState *cs, unsigned int adr, u8 off, u8 *data, int size)
{ {
/* fifo write without cli because it's allready done */ unsigned long flags;
byteout(ale, off);
spin_lock_irqsave(&saphir_lock, flags);
byteout(cs->hw.saphir.ale, off);
outsb(adr, data, size); outsb(adr, data, size);
spin_unlock_irqrestore(&saphir_lock, flags);
} }
/* Interface functions */ /* Interface functions */
...@@ -79,25 +83,25 @@ writefifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int siz ...@@ -79,25 +83,25 @@ writefifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int siz
static u_char static u_char
ReadISAC(struct IsdnCardState *cs, u_char offset) ReadISAC(struct IsdnCardState *cs, u_char offset)
{ {
return (readreg(cs->hw.saphir.ale, cs->hw.saphir.isac, offset)); return readreg(cs, cs->hw.saphir.isac, offset);
} }
static void static void
WriteISAC(struct IsdnCardState *cs, u_char offset, u_char value) WriteISAC(struct IsdnCardState *cs, u_char offset, u_char value)
{ {
writereg(cs->hw.saphir.ale, cs->hw.saphir.isac, offset, value); writereg(cs, cs->hw.saphir.isac, offset, value);
} }
static void static void
ReadISACfifo(struct IsdnCardState *cs, u_char * data, int size) ReadISACfifo(struct IsdnCardState *cs, u_char * data, int size)
{ {
readfifo(cs->hw.saphir.ale, cs->hw.saphir.isac, 0, data, size); readfifo(cs, cs->hw.saphir.isac, 0, data, size);
} }
static void static void
WriteISACfifo(struct IsdnCardState *cs, u_char * data, int size) WriteISACfifo(struct IsdnCardState *cs, u_char * data, int size)
{ {
writefifo(cs->hw.saphir.ale, cs->hw.saphir.isac, 0, data, size); writefifo(cs, cs->hw.saphir.isac, 0, data, size);
} }
static struct dc_hw_ops isac_ops = { static struct dc_hw_ops isac_ops = {
...@@ -110,15 +114,13 @@ static struct dc_hw_ops isac_ops = { ...@@ -110,15 +114,13 @@ static struct dc_hw_ops isac_ops = {
static u_char static u_char
ReadHSCX(struct IsdnCardState *cs, int hscx, u_char offset) ReadHSCX(struct IsdnCardState *cs, int hscx, u_char offset)
{ {
return (readreg(cs->hw.saphir.ale, cs->hw.saphir.hscx, return readreg(cs, cs->hw.saphir.hscx, offset + (hscx ? 0x40 : 0));
offset + (hscx ? 0x40 : 0)));
} }
static void static void
WriteHSCX(struct IsdnCardState *cs, int hscx, u_char offset, u_char value) WriteHSCX(struct IsdnCardState *cs, int hscx, u_char offset, u_char value)
{ {
writereg(cs->hw.saphir.ale, cs->hw.saphir.hscx, writereg(cs, cs->hw.saphir.hscx, offset + (hscx ? 0x40 : 0), value);
offset + (hscx ? 0x40 : 0), value);
} }
static struct bc_hw_ops hscx_ops = { static struct bc_hw_ops hscx_ops = {
...@@ -126,15 +128,15 @@ static struct bc_hw_ops hscx_ops = { ...@@ -126,15 +128,15 @@ static struct bc_hw_ops hscx_ops = {
.write_reg = WriteHSCX, .write_reg = WriteHSCX,
}; };
#define READHSCX(cs, nr, reg) readreg(cs->hw.saphir.ale, \ #define READHSCX(cs, nr, reg) readreg(cs, \
cs->hw.saphir.hscx, reg + (nr ? 0x40 : 0)) cs->hw.saphir.hscx, reg + (nr ? 0x40 : 0))
#define WRITEHSCX(cs, nr, reg, data) writereg(cs->hw.saphir.ale, \ #define WRITEHSCX(cs, nr, reg, data) writereg(cs, \
cs->hw.saphir.hscx, reg + (nr ? 0x40 : 0), data) cs->hw.saphir.hscx, reg + (nr ? 0x40 : 0), data)
#define READHSCXFIFO(cs, nr, ptr, cnt) readfifo(cs->hw.saphir.ale, \ #define READHSCXFIFO(cs, nr, ptr, cnt) readfifo(cs, \
cs->hw.saphir.hscx, (nr ? 0x40 : 0), ptr, cnt) cs->hw.saphir.hscx, (nr ? 0x40 : 0), ptr, cnt)
#define WRITEHSCXFIFO(cs, nr, ptr, cnt) writefifo(cs->hw.saphir.ale, \ #define WRITEHSCXFIFO(cs, nr, ptr, cnt) writefifo(cs, \
cs->hw.saphir.hscx, (nr ? 0x40 : 0), ptr, cnt) cs->hw.saphir.hscx, (nr ? 0x40 : 0), ptr, cnt)
#include "hscx_irq.c" #include "hscx_irq.c"
...@@ -146,21 +148,21 @@ saphir_interrupt(int intno, void *dev_id, struct pt_regs *regs) ...@@ -146,21 +148,21 @@ saphir_interrupt(int intno, void *dev_id, struct pt_regs *regs)
u_char val; u_char val;
spin_lock(&cs->lock); spin_lock(&cs->lock);
val = readreg(cs->hw.saphir.ale, cs->hw.saphir.hscx, HSCX_ISTA + 0x40); val = readreg(cs, cs->hw.saphir.hscx, HSCX_ISTA + 0x40);
Start_HSCX: Start_HSCX:
if (val) if (val)
hscx_int_main(cs, val); hscx_int_main(cs, val);
val = readreg(cs->hw.saphir.ale, cs->hw.saphir.isac, ISAC_ISTA); val = readreg(cs, cs->hw.saphir.isac, ISAC_ISTA);
Start_ISAC: Start_ISAC:
if (val) if (val)
isac_interrupt(cs, val); isac_interrupt(cs, val);
val = readreg(cs->hw.saphir.ale, cs->hw.saphir.hscx, HSCX_ISTA + 0x40); val = readreg(cs, cs->hw.saphir.hscx, HSCX_ISTA + 0x40);
if (val) { if (val) {
if (cs->debug & L1_DEB_HSCX) if (cs->debug & L1_DEB_HSCX)
debugl1(cs, "HSCX IntStat after IntRoutine"); debugl1(cs, "HSCX IntStat after IntRoutine");
goto Start_HSCX; goto Start_HSCX;
} }
val = readreg(cs->hw.saphir.ale, cs->hw.saphir.isac, ISAC_ISTA); val = readreg(cs, cs->hw.saphir.isac, ISAC_ISTA);
if (val) { if (val) {
if (cs->debug & L1_DEB_ISAC) if (cs->debug & L1_DEB_ISAC)
debugl1(cs, "ISAC IntStat after IntRoutine"); debugl1(cs, "ISAC IntStat after IntRoutine");
...@@ -171,12 +173,12 @@ saphir_interrupt(int intno, void *dev_id, struct pt_regs *regs) ...@@ -171,12 +173,12 @@ saphir_interrupt(int intno, void *dev_id, struct pt_regs *regs)
mod_timer(&cs->hw.saphir.timer, jiffies+1*HZ); mod_timer(&cs->hw.saphir.timer, jiffies+1*HZ);
else else
printk(KERN_WARNING "saphir: Spurious timer!\n"); printk(KERN_WARNING "saphir: Spurious timer!\n");
writereg(cs->hw.saphir.ale, cs->hw.saphir.hscx, HSCX_MASK, 0xFF); writereg(cs, cs->hw.saphir.hscx, HSCX_MASK, 0xFF);
writereg(cs->hw.saphir.ale, cs->hw.saphir.hscx, HSCX_MASK + 0x40, 0xFF); writereg(cs, cs->hw.saphir.hscx, HSCX_MASK + 0x40, 0xFF);
writereg(cs->hw.saphir.ale, cs->hw.saphir.isac, ISAC_MASK, 0xFF); writereg(cs, cs->hw.saphir.isac, ISAC_MASK, 0xFF);
writereg(cs->hw.saphir.ale, cs->hw.saphir.isac, ISAC_MASK, 0); writereg(cs, cs->hw.saphir.isac, ISAC_MASK, 0);
writereg(cs->hw.saphir.ale, cs->hw.saphir.hscx, HSCX_MASK, 0); writereg(cs, cs->hw.saphir.hscx, HSCX_MASK, 0);
writereg(cs->hw.saphir.ale, cs->hw.saphir.hscx, HSCX_MASK + 0x40, 0); writereg(cs, cs->hw.saphir.hscx, HSCX_MASK + 0x40, 0);
spin_unlock(&cs->lock); spin_unlock(&cs->lock);
} }
......
drivers/isdn/hisax/sedlbauer.c
View file @ 24e904bd
...@@ -118,46 +118,51 @@ const char *Sedlbauer_Types[] = ...@@ -118,46 +118,51 @@ const char *Sedlbauer_Types[] =
#define SEDL_RESET 0x3 /* same as DOS driver */ #define SEDL_RESET 0x3 /* same as DOS driver */
static inline u_char static inline u8
readreg(unsigned int ale, unsigned int adr, u_char off) readreg(struct IsdnCardState *cs, unsigned int adr, u8 off)
{ {
register u_char ret; u8 ret;
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&sedlbauer_lock, flags); spin_lock_irqsave(&sedlbauer_lock, flags);
byteout(ale, off); byteout(cs->hw.sedl.adr, off);
ret = bytein(adr); ret = bytein(adr);
spin_unlock_irqrestore(&sedlbauer_lock, flags); spin_unlock_irqrestore(&sedlbauer_lock, flags);
return (ret); return ret;
} }
static inline void static inline void
readfifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int size) readfifo(struct IsdnCardState *cs, unsigned int adr, u8 off, u8 * data, int size)
{ {
/* fifo read without cli because it's allready done */ unsigned long flags;
byteout(ale, off); spin_lock_irqsave(&sedlbauer_lock, flags);
byteout(cs->hw.sedl.adr, off);
insb(adr, data, size); insb(adr, data, size);
spin_unlock_irqrestore(&sedlbauer_lock, flags);
} }
static inline void static inline void
writereg(unsigned int ale, unsigned int adr, u_char off, u_char data) writereg(struct IsdnCardState *cs, unsigned int adr, u8 off, u8 data)
{ {
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&sedlbauer_lock, flags); spin_lock_irqsave(&sedlbauer_lock, flags);
byteout(ale, off); byteout(cs->hw.sedl.adr, off);
byteout(adr, data); byteout(adr, data);
spin_unlock_irqrestore(&sedlbauer_lock, flags); spin_unlock_irqrestore(&sedlbauer_lock, flags);
} }
static inline void static inline void
writefifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int size) writefifo(struct IsdnCardState *cs, unsigned int adr, u8 off, u8 * data, int size)
{ {
/* fifo write without cli because it's allready done */ unsigned long flags;
byteout(ale, off);
spin_lock_irqsave(&sedlbauer_lock, flags);
byteout(cs->hw.sedl.adr, off);
outsb(adr, data, size); outsb(adr, data, size);
spin_unlock_irqrestore(&sedlbauer_lock, flags);
} }
/* Interface functions */ /* Interface functions */
...@@ -165,25 +170,25 @@ writefifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int siz ...@@ -165,25 +170,25 @@ writefifo(unsigned int ale, unsigned int adr, u_char off, u_char * data, int siz
static u_char static u_char
ReadISAC(struct IsdnCardState *cs, u_char offset) ReadISAC(struct IsdnCardState *cs, u_char offset)
{ {
return (readreg(cs->hw.sedl.adr, cs->hw.sedl.isac, offset)); return readreg(cs, cs->hw.sedl.isac, offset);
} }
static void static void
WriteISAC(struct IsdnCardState *cs, u_char offset, u_char value) WriteISAC(struct IsdnCardState *cs, u_char offset, u_char value)
{ {
writereg(cs->hw.sedl.adr, cs->hw.sedl.isac, offset, value); writereg(cs, cs->hw.sedl.isac, offset, value);
} }
static void static void
ReadISACfifo(struct IsdnCardState *cs, u_char * data, int size) ReadISACfifo(struct IsdnCardState *cs, u_char * data, int size)
{ {
readfifo(cs->hw.sedl.adr, cs->hw.sedl.isac, 0, data, size); readfifo(cs, cs->hw.sedl.isac, 0, data, size);
} }
static void static void
WriteISACfifo(struct IsdnCardState *cs, u_char * data, int size) WriteISACfifo(struct IsdnCardState *cs, u_char * data, int size)
{ {
writefifo(cs->hw.sedl.adr, cs->hw.sedl.isac, 0, data, size); writefifo(cs, cs->hw.sedl.isac, 0, data, size);
} }
static struct dc_hw_ops isac_ops = { static struct dc_hw_ops isac_ops = {
...@@ -196,25 +201,25 @@ static struct dc_hw_ops isac_ops = { ...@@ -196,25 +201,25 @@ static struct dc_hw_ops isac_ops = {
static u_char static u_char
ReadISAC_IPAC(struct IsdnCardState *cs, u_char offset) ReadISAC_IPAC(struct IsdnCardState *cs, u_char offset)
{ {
return (readreg(cs->hw.sedl.adr, cs->hw.sedl.isac, offset|0x80)); return readreg(cs, cs->hw.sedl.isac, offset|0x80);
} }
static void static void
WriteISAC_IPAC(struct IsdnCardState *cs, u_char offset, u_char value) WriteISAC_IPAC(struct IsdnCardState *cs, u_char offset, u_char value)
{ {
writereg(cs->hw.sedl.adr, cs->hw.sedl.isac, offset|0x80, value); writereg(cs, cs->hw.sedl.isac, offset|0x80, value);
} }
static void static void
ReadISACfifo_IPAC(struct IsdnCardState *cs, u_char * data, int size) ReadISACfifo_IPAC(struct IsdnCardState *cs, u_char * data, int size)
{ {
readfifo(cs->hw.sedl.adr, cs->hw.sedl.isac, 0x80, data, size); readfifo(cs, cs->hw.sedl.isac, 0x80, data, size);
} }
static void static void
WriteISACfifo_IPAC(struct IsdnCardState *cs, u_char * data, int size) WriteISACfifo_IPAC(struct IsdnCardState *cs, u_char * data, int size)
{ {
writefifo(cs->hw.sedl.adr, cs->hw.sedl.isac, 0x80, data, size); writefifo(cs, cs->hw.sedl.isac, 0x80, data, size);
} }
static struct dc_hw_ops ipac_dc_ops = { static struct dc_hw_ops ipac_dc_ops = {
...@@ -227,15 +232,13 @@ static struct dc_hw_ops ipac_dc_ops = { ...@@ -227,15 +232,13 @@ static struct dc_hw_ops ipac_dc_ops = {
static u_char static u_char
ReadHSCX(struct IsdnCardState *cs, int hscx, u_char offset) ReadHSCX(struct IsdnCardState *cs, int hscx, u_char offset)
{ {
return (readreg(cs->hw.sedl.adr, return readreg(cs, cs->hw.sedl.hscx, offset + (hscx ? 0x40 : 0));
cs->hw.sedl.hscx, offset + (hscx ? 0x40 : 0)));
} }
static void static void
WriteHSCX(struct IsdnCardState *cs, int hscx, u_char offset, u_char value) WriteHSCX(struct IsdnCardState *cs, int hscx, u_char offset, u_char value)
{ {
writereg(cs->hw.sedl.adr, writereg(cs, cs->hw.sedl.hscx, offset + (hscx ? 0x40 : 0), value);
cs->hw.sedl.hscx, offset + (hscx ? 0x40 : 0), value);
} }
static struct bc_hw_ops hscx_ops = { static struct bc_hw_ops hscx_ops = {
...@@ -253,7 +256,7 @@ static u_char ...@@ -253,7 +256,7 @@ static u_char
ReadISAR(struct IsdnCardState *cs, int mode, u_char offset) ReadISAR(struct IsdnCardState *cs, int mode, u_char offset)
{ {
if (mode == 0) if (mode == 0)
return (readreg(cs->hw.sedl.adr, cs->hw.sedl.hscx, offset)); return readreg(cs, cs->hw.sedl.hscx, offset);
else if (mode == 1) else if (mode == 1)
byteout(cs->hw.sedl.adr, offset); byteout(cs->hw.sedl.adr, offset);
return(bytein(cs->hw.sedl.hscx)); return(bytein(cs->hw.sedl.hscx));
...@@ -263,7 +266,7 @@ static void ...@@ -263,7 +266,7 @@ static void
WriteISAR(struct IsdnCardState *cs, int mode, u_char offset, u_char value) WriteISAR(struct IsdnCardState *cs, int mode, u_char offset, u_char value)
{ {
if (mode == 0) if (mode == 0)
writereg(cs->hw.sedl.adr, cs->hw.sedl.hscx, offset, value); writereg(cs, cs->hw.sedl.hscx, offset, value);
else { else {
if (mode == 1) if (mode == 1)
byteout(cs->hw.sedl.adr, offset); byteout(cs->hw.sedl.adr, offset);
...@@ -280,15 +283,15 @@ static struct bc_hw_ops isar_ops = { ...@@ -280,15 +283,15 @@ static struct bc_hw_ops isar_ops = {
* fast interrupt HSCX stuff goes here * fast interrupt HSCX stuff goes here
*/ */
#define READHSCX(cs, nr, reg) readreg(cs->hw.sedl.adr, \ #define READHSCX(cs, nr, reg) readreg(cs, \
cs->hw.sedl.hscx, reg + (nr ? 0x40 : 0)) cs->hw.sedl.hscx, reg + (nr ? 0x40 : 0))
#define WRITEHSCX(cs, nr, reg, data) writereg(cs->hw.sedl.adr, \ #define WRITEHSCX(cs, nr, reg, data) writereg(cs, \
cs->hw.sedl.hscx, reg + (nr ? 0x40 : 0), data) cs->hw.sedl.hscx, reg + (nr ? 0x40 : 0), data)
#define READHSCXFIFO(cs, nr, ptr, cnt) readfifo(cs->hw.sedl.adr, \ #define READHSCXFIFO(cs, nr, ptr, cnt) readfifo(cs, \
cs->hw.sedl.hscx, (nr ? 0x40 : 0), ptr, cnt) cs->hw.sedl.hscx, (nr ? 0x40 : 0), ptr, cnt)
#define WRITEHSCXFIFO(cs, nr, ptr, cnt) writefifo(cs->hw.sedl.adr, \ #define WRITEHSCXFIFO(cs, nr, ptr, cnt) writefifo(cs, \
cs->hw.sedl.hscx, (nr ? 0x40 : 0), ptr, cnt) cs->hw.sedl.hscx, (nr ? 0x40 : 0), ptr, cnt)
#include "hscx_irq.c" #include "hscx_irq.c"
...@@ -311,32 +314,32 @@ sedlbauer_interrupt(int intno, void *dev_id, struct pt_regs *regs) ...@@ -311,32 +314,32 @@ sedlbauer_interrupt(int intno, void *dev_id, struct pt_regs *regs)
return; return;
} }
val = readreg(cs->hw.sedl.adr, cs->hw.sedl.hscx, HSCX_ISTA + 0x40); val = readreg(cs, cs->hw.sedl.hscx, HSCX_ISTA + 0x40);
Start_HSCX: Start_HSCX:
if (val) if (val)
hscx_int_main(cs, val); hscx_int_main(cs, val);
val = readreg(cs->hw.sedl.adr, cs->hw.sedl.isac, ISAC_ISTA); val = readreg(cs, cs->hw.sedl.isac, ISAC_ISTA);
Start_ISAC: Start_ISAC:
if (val) if (val)
isac_interrupt(cs, val); isac_interrupt(cs, val);
val = readreg(cs->hw.sedl.adr, cs->hw.sedl.hscx, HSCX_ISTA + 0x40); val = readreg(cs, cs->hw.sedl.hscx, HSCX_ISTA + 0x40);
if (val) { if (val) {
if (cs->debug & L1_DEB_HSCX) if (cs->debug & L1_DEB_HSCX)
debugl1(cs, "HSCX IntStat after IntRoutine"); debugl1(cs, "HSCX IntStat after IntRoutine");
goto Start_HSCX; goto Start_HSCX;
} }
val = readreg(cs->hw.sedl.adr, cs->hw.sedl.isac, ISAC_ISTA); val = readreg(cs, cs->hw.sedl.isac, ISAC_ISTA);
if (val) { if (val) {
if (cs->debug & L1_DEB_ISAC) if (cs->debug & L1_DEB_ISAC)
debugl1(cs, "ISAC IntStat after IntRoutine"); debugl1(cs, "ISAC IntStat after IntRoutine");
goto Start_ISAC; goto Start_ISAC;
} }
writereg(cs->hw.sedl.adr, cs->hw.sedl.hscx, HSCX_MASK, 0xFF); writereg(cs, cs->hw.sedl.hscx, HSCX_MASK, 0xFF);
writereg(cs->hw.sedl.adr, cs->hw.sedl.hscx, HSCX_MASK + 0x40, 0xFF); writereg(cs, cs->hw.sedl.hscx, HSCX_MASK + 0x40, 0xFF);
writereg(cs->hw.sedl.adr, cs->hw.sedl.isac, ISAC_MASK, 0xFF); writereg(cs, cs->hw.sedl.isac, ISAC_MASK, 0xFF);
writereg(cs->hw.sedl.adr, cs->hw.sedl.isac, ISAC_MASK, 0x0); writereg(cs, cs->hw.sedl.isac, ISAC_MASK, 0x0);
writereg(cs->hw.sedl.adr, cs->hw.sedl.hscx, HSCX_MASK, 0x0); writereg(cs, cs->hw.sedl.hscx, HSCX_MASK, 0x0);
writereg(cs->hw.sedl.adr, cs->hw.sedl.hscx, HSCX_MASK + 0x40, 0x0); writereg(cs, cs->hw.sedl.hscx, HSCX_MASK + 0x40, 0x0);
} }
static void static void
...@@ -349,12 +352,12 @@ sedlbauer_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs) ...@@ -349,12 +352,12 @@ sedlbauer_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs)
printk(KERN_WARNING "Sedlbauer: Spurious interrupt!\n"); printk(KERN_WARNING "Sedlbauer: Spurious interrupt!\n");
return; return;
} }
ista = readreg(cs->hw.sedl.adr, cs->hw.sedl.isac, IPAC_ISTA); ista = readreg(cs, cs->hw.sedl.isac, IPAC_ISTA);
Start_IPAC: Start_IPAC:
if (cs->debug & L1_DEB_IPAC) if (cs->debug & L1_DEB_IPAC)
debugl1(cs, "IPAC ISTA %02X", ista); debugl1(cs, "IPAC ISTA %02X", ista);
if (ista & 0x0f) { if (ista & 0x0f) {
val = readreg(cs->hw.sedl.adr, cs->hw.sedl.hscx, HSCX_ISTA + 0x40); val = readreg(cs, cs->hw.sedl.hscx, HSCX_ISTA + 0x40);
if (ista & 0x01) if (ista & 0x01)
val |= 0x01; val |= 0x01;
if (ista & 0x04) if (ista & 0x04)
...@@ -365,7 +368,7 @@ sedlbauer_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs) ...@@ -365,7 +368,7 @@ sedlbauer_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs)
hscx_int_main(cs, val); hscx_int_main(cs, val);
} }
if (ista & 0x20) { if (ista & 0x20) {
val = 0xfe & readreg(cs->hw.sedl.adr, cs->hw.sedl.isac, ISAC_ISTA | 0x80); val = 0xfe & readreg(cs, cs->hw.sedl.isac, ISAC_ISTA | 0x80);
if (val) { if (val) {
isac_interrupt(cs, val); isac_interrupt(cs, val);
} }
...@@ -374,7 +377,7 @@ sedlbauer_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs) ...@@ -374,7 +377,7 @@ sedlbauer_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs)
val = 0x01; val = 0x01;
isac_interrupt(cs, val); isac_interrupt(cs, val);
} }
ista = readreg(cs->hw.sedl.adr, cs->hw.sedl.isac, IPAC_ISTA); ista = readreg(cs, cs->hw.sedl.isac, IPAC_ISTA);
if ((ista & 0x3f) && icnt) { if ((ista & 0x3f) && icnt) {
icnt--; icnt--;
goto Start_IPAC; goto Start_IPAC;
...@@ -382,8 +385,8 @@ sedlbauer_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs) ...@@ -382,8 +385,8 @@ sedlbauer_interrupt_ipac(int intno, void *dev_id, struct pt_regs *regs)
if (!icnt) if (!icnt)
if (cs->debug & L1_DEB_ISAC) if (cs->debug & L1_DEB_ISAC)
debugl1(cs, "Sedlbauer IRQ LOOP"); debugl1(cs, "Sedlbauer IRQ LOOP");
writereg(cs->hw.sedl.adr, cs->hw.sedl.isac, IPAC_MASK, 0xFF); writereg(cs, cs->hw.sedl.isac, IPAC_MASK, 0xFF);
writereg(cs->hw.sedl.adr, cs->hw.sedl.isac, IPAC_MASK, 0xC0); writereg(cs, cs->hw.sedl.isac, IPAC_MASK, 0xC0);
} }
static void static void
...@@ -394,21 +397,21 @@ sedlbauer_interrupt_isar(int intno, void *dev_id, struct pt_regs *regs) ...@@ -394,21 +397,21 @@ sedlbauer_interrupt_isar(int intno, void *dev_id, struct pt_regs *regs)
int cnt = 5; int cnt = 5;
spin_lock(&cs->lock); spin_lock(&cs->lock);
val = readreg(cs->hw.sedl.adr, cs->hw.sedl.hscx, ISAR_IRQBIT); val = readreg(cs, cs->hw.sedl.hscx, ISAR_IRQBIT);
Start_ISAR: Start_ISAR:
if (val & ISAR_IRQSTA) if (val & ISAR_IRQSTA)
isar_int_main(cs); isar_int_main(cs);
val = readreg(cs->hw.sedl.adr, cs->hw.sedl.isac, ISAC_ISTA); val = readreg(cs, cs->hw.sedl.isac, ISAC_ISTA);
Start_ISAC: Start_ISAC:
if (val) if (val)
isac_interrupt(cs, val); isac_interrupt(cs, val);
val = readreg(cs->hw.sedl.adr, cs->hw.sedl.hscx, ISAR_IRQBIT); val = readreg(cs, cs->hw.sedl.hscx, ISAR_IRQBIT);
if ((val & ISAR_IRQSTA) && --cnt) { if ((val & ISAR_IRQSTA) && --cnt) {
if (cs->debug & L1_DEB_HSCX) if (cs->debug & L1_DEB_HSCX)
debugl1(cs, "ISAR IntStat after IntRoutine"); debugl1(cs, "ISAR IntStat after IntRoutine");
goto Start_ISAR; goto Start_ISAR;
} }
val = readreg(cs->hw.sedl.adr, cs->hw.sedl.isac, ISAC_ISTA); val = readreg(cs, cs->hw.sedl.isac, ISAC_ISTA);
if (val && --cnt) { if (val && --cnt) {
if (cs->debug & L1_DEB_ISAC) if (cs->debug & L1_DEB_ISAC)
debugl1(cs, "ISAC IntStat after IntRoutine"); debugl1(cs, "ISAC IntStat after IntRoutine");
...@@ -418,10 +421,10 @@ sedlbauer_interrupt_isar(int intno, void *dev_id, struct pt_regs *regs) ...@@ -418,10 +421,10 @@ sedlbauer_interrupt_isar(int intno, void *dev_id, struct pt_regs *regs)
if (cs->debug & L1_DEB_ISAC) if (cs->debug & L1_DEB_ISAC)
debugl1(cs, "Sedlbauer IRQ LOOP"); debugl1(cs, "Sedlbauer IRQ LOOP");
writereg(cs->hw.sedl.adr, cs->hw.sedl.hscx, ISAR_IRQBIT, 0); writereg(cs, cs->hw.sedl.hscx, ISAR_IRQBIT, 0);
writereg(cs->hw.sedl.adr, cs->hw.sedl.isac, ISAC_MASK, 0xFF); writereg(cs, cs->hw.sedl.isac, ISAC_MASK, 0xFF);
writereg(cs->hw.sedl.adr, cs->hw.sedl.isac, ISAC_MASK, 0x0); writereg(cs, cs->hw.sedl.isac, ISAC_MASK, 0x0);
writereg(cs->hw.sedl.adr, cs->hw.sedl.hscx, ISAR_IRQBIT, ISAR_IRQMSK); writereg(cs, cs->hw.sedl.hscx, ISAR_IRQBIT, ISAR_IRQMSK);
spin_unlock(&cs->lock); spin_unlock(&cs->lock);
} }
...@@ -447,17 +450,17 @@ reset_sedlbauer(struct IsdnCardState *cs) ...@@ -447,17 +450,17 @@ reset_sedlbauer(struct IsdnCardState *cs)
if (!((cs->hw.sedl.bus == SEDL_BUS_PCMCIA) && if (!((cs->hw.sedl.bus == SEDL_BUS_PCMCIA) &&
(cs->hw.sedl.chip == SEDL_CHIP_ISAC_HSCX))) { (cs->hw.sedl.chip == SEDL_CHIP_ISAC_HSCX))) {
if (cs->hw.sedl.chip == SEDL_CHIP_IPAC) { if (cs->hw.sedl.chip == SEDL_CHIP_IPAC) {
writereg(cs->hw.sedl.adr, cs->hw.sedl.isac, IPAC_POTA2, 0x20); writereg(cs, cs->hw.sedl.isac, IPAC_POTA2, 0x20);
set_current_state(TASK_UNINTERRUPTIBLE); set_current_state(TASK_UNINTERRUPTIBLE);
schedule_timeout((10*HZ)/1000); schedule_timeout((10*HZ)/1000);
writereg(cs->hw.sedl.adr, cs->hw.sedl.isac, IPAC_POTA2, 0x0); writereg(cs, cs->hw.sedl.isac, IPAC_POTA2, 0x0);
set_current_state(TASK_UNINTERRUPTIBLE); set_current_state(TASK_UNINTERRUPTIBLE);
schedule_timeout((10*HZ)/1000); schedule_timeout((10*HZ)/1000);
writereg(cs->hw.sedl.adr, cs->hw.sedl.isac, IPAC_CONF, 0x0); writereg(cs, cs->hw.sedl.isac, IPAC_CONF, 0x0);
writereg(cs->hw.sedl.adr, cs->hw.sedl.isac, IPAC_ACFG, 0xff); writereg(cs, cs->hw.sedl.isac, IPAC_ACFG, 0xff);
writereg(cs->hw.sedl.adr, cs->hw.sedl.isac, IPAC_AOE, 0x0); writereg(cs, cs->hw.sedl.isac, IPAC_AOE, 0x0);
writereg(cs->hw.sedl.adr, cs->hw.sedl.isac, IPAC_MASK, 0xc0); writereg(cs, cs->hw.sedl.isac, IPAC_MASK, 0xc0);
writereg(cs->hw.sedl.adr, cs->hw.sedl.isac, IPAC_PCFG, 0x12); writereg(cs, cs->hw.sedl.isac, IPAC_PCFG, 0x12);
} else if ((cs->hw.sedl.chip == SEDL_CHIP_ISAC_ISAR) && } else if ((cs->hw.sedl.chip == SEDL_CHIP_ISAC_ISAR) &&
(cs->hw.sedl.bus == SEDL_BUS_PCI)) { (cs->hw.sedl.bus == SEDL_BUS_PCI)) {
byteout(cs->hw.sedl.cfg_reg +3, cs->hw.sedl.reset_on); byteout(cs->hw.sedl.cfg_reg +3, cs->hw.sedl.reset_on);
...@@ -486,21 +489,21 @@ Sedl_card_msg(struct IsdnCardState *cs, int mt, void *arg) ...@@ -486,21 +489,21 @@ Sedl_card_msg(struct IsdnCardState *cs, int mt, void *arg)
return(0); return(0);
case CARD_RELEASE: case CARD_RELEASE:
if (cs->hw.sedl.chip == SEDL_CHIP_ISAC_ISAR) { if (cs->hw.sedl.chip == SEDL_CHIP_ISAC_ISAR) {
writereg(cs->hw.sedl.adr, cs->hw.sedl.hscx, writereg(cs, cs->hw.sedl.hscx,
ISAR_IRQBIT, 0); ISAR_IRQBIT, 0);
writereg(cs->hw.sedl.adr, cs->hw.sedl.isac, writereg(cs, cs->hw.sedl.isac,
ISAC_MASK, 0xFF); ISAC_MASK, 0xFF);
reset_sedlbauer(cs); reset_sedlbauer(cs);
writereg(cs->hw.sedl.adr, cs->hw.sedl.hscx, writereg(cs, cs->hw.sedl.hscx,
ISAR_IRQBIT, 0); ISAR_IRQBIT, 0);
writereg(cs->hw.sedl.adr, cs->hw.sedl.isac, writereg(cs, cs->hw.sedl.isac,
ISAC_MASK, 0xFF); ISAC_MASK, 0xFF);
} }
release_io_sedlbauer(cs); release_io_sedlbauer(cs);
return(0); return(0);
case CARD_INIT: case CARD_INIT:
if (cs->hw.sedl.chip == SEDL_CHIP_ISAC_ISAR) { if (cs->hw.sedl.chip == SEDL_CHIP_ISAC_ISAR) {
writereg(cs->hw.sedl.adr, cs->hw.sedl.hscx, writereg(cs, cs->hw.sedl.hscx,
ISAR_IRQBIT, 0); ISAR_IRQBIT, 0);
initisac(cs); initisac(cs);
initisar(cs); initisar(cs);
...@@ -729,7 +732,8 @@ setup_sedlbauer(struct IsdnCard *card) ...@@ -729,7 +732,8 @@ setup_sedlbauer(struct IsdnCard *card)
* and PCI card uses only IPAC (for the moment) * and PCI card uses only IPAC (for the moment)
*/ */
if (cs->hw.sedl.bus != SEDL_BUS_PCI) { if (cs->hw.sedl.bus != SEDL_BUS_PCI) {
val = readreg(cs->hw.sedl.cfg_reg + SEDL_IPAC_ANY_ADR, cs->hw.sedl.adr = cs->hw.sedl.cfg_reg + SEDL_IPAC_ANY_ADR;
val = readreg(cs,
cs->hw.sedl.cfg_reg + SEDL_IPAC_ANY_IPAC, IPAC_ID); cs->hw.sedl.cfg_reg + SEDL_IPAC_ANY_IPAC, IPAC_ID);
printk(KERN_DEBUG "Sedlbauer: testing IPAC version %x\n", val); printk(KERN_DEBUG "Sedlbauer: testing IPAC version %x\n", val);
if ((val == 1) || (val == 2)) { if ((val == 1) || (val == 2)) {
...@@ -768,7 +772,7 @@ setup_sedlbauer(struct IsdnCard *card) ...@@ -768,7 +772,7 @@ setup_sedlbauer(struct IsdnCard *card)
cs->dc_hw_ops = &ipac_dc_ops; cs->dc_hw_ops = &ipac_dc_ops;
cs->irq_func = &sedlbauer_interrupt_ipac; cs->irq_func = &sedlbauer_interrupt_ipac;
val = readreg(cs->hw.sedl.adr, cs->hw.sedl.isac, IPAC_ID); val = readreg(cs, cs->hw.sedl.isac, IPAC_ID);
printk(KERN_INFO "Sedlbauer: IPAC version %x\n", val); printk(KERN_INFO "Sedlbauer: IPAC version %x\n", val);
reset_sedlbauer(cs); reset_sedlbauer(cs);
} else { } else {
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment
GitLab Nexedi Edition | About GitLab | About Nexedi | 沪ICP备2021021310号-2 | 沪ICP备2021021310号-7