File: /usr/src/linux/drivers/isdn/hisax/s0box.c

1     /* $Id: s0box.c,v 2.4.6.1 2001/02/16 16:43:29 kai Exp $
2      *
3      * s0box.c      low level stuff for Creatix S0BOX
4      *
5      * Author       S0BOX specific stuff: Enrik Berkhan (enrik@starfleet.inka.de)
6      *
7      * This file is (c) under GNU General Public License
8      *
9      */
10     #define __NO_VERSION__
11     #include <linux/init.h>
12     #include "hisax.h"
13     #include "isac.h"
14     #include "hscx.h"
15     #include "isdnl1.h"
16     
17     extern const char *CardType[];
18     const char *s0box_revision = "$Revision: 2.4.6.1 $";
19     
20     static inline void
21     writereg(unsigned int padr, signed int addr, u_char off, u_char val) {
22     	unsigned long flags;
23     
24     	save_flags(flags);
25     	cli();
26     	outb_p(0x1c,padr+2);
27     	outb_p(0x14,padr+2);
28     	outb_p((addr+off)&0x7f,padr);
29     	outb_p(0x16,padr+2);
30     	outb_p(val,padr);
31     	outb_p(0x17,padr+2);
32     	outb_p(0x14,padr+2);
33     	outb_p(0x1c,padr+2);
34     	restore_flags(flags);
35     }
36     
37     static u_char nibtab[] = { 1, 9, 5, 0xd, 3, 0xb, 7, 0xf,
38     			 0, 0, 0, 0, 0, 0, 0, 0,
39     			 0, 8, 4, 0xc, 2, 0xa, 6, 0xe } ;
40     
41     static inline u_char
42     readreg(unsigned int padr, signed int addr, u_char off) {
43     	register u_char n1, n2;
44     	unsigned long flags;
45     
46     	save_flags(flags);
47     	cli();
48     	outb_p(0x1c,padr+2);
49     	outb_p(0x14,padr+2);
50     	outb_p((addr+off)|0x80,padr);
51     	outb_p(0x16,padr+2);
52     	outb_p(0x17,padr+2);
53     	n1 = (inb_p(padr+1) >> 3) & 0x17;
54     	outb_p(0x16,padr+2);
55     	n2 = (inb_p(padr+1) >> 3) & 0x17;
56     	outb_p(0x14,padr+2);
57     	outb_p(0x1c,padr+2);
58     	restore_flags(flags);
59     	return nibtab[n1] | (nibtab[n2] << 4);
60     }
61     
62     static inline void
63     read_fifo(unsigned int padr, signed int adr, u_char * data, int size)
64     {
65     	int i;
66     	register u_char n1, n2;
67     	
68     	outb_p(0x1c, padr+2);
69     	outb_p(0x14, padr+2);
70     	outb_p(adr|0x80, padr);
71     	outb_p(0x16, padr+2);
72     	for (i=0; i<size; i++) {
73     		outb_p(0x17, padr+2);
74     		n1 = (inb_p(padr+1) >> 3) & 0x17;
75     		outb_p(0x16,padr+2);
76     		n2 = (inb_p(padr+1) >> 3) & 0x17;
77     		*(data++)=nibtab[n1] | (nibtab[n2] << 4);
78     	}
79     	outb_p(0x14,padr+2);
80     	outb_p(0x1c,padr+2);
81     	return;
82     }
83     
84     static inline void
85     write_fifo(unsigned int padr, signed int adr, u_char * data, int size)
86     {
87     	int i;
88     	outb_p(0x1c, padr+2);
89     	outb_p(0x14, padr+2);
90     	outb_p(adr&0x7f, padr);
91     	for (i=0; i<size; i++) {
92     		outb_p(0x16, padr+2);
93     		outb_p(*(data++), padr);
94     		outb_p(0x17, padr+2);
95     	}
96     	outb_p(0x14,padr+2);
97     	outb_p(0x1c,padr+2);
98     	return;
99     }
100     
101     /* Interface functions */
102     
103     static u_char
104     ReadISAC(struct IsdnCardState *cs, u_char offset)
105     {
106     	return (readreg(cs->hw.teles3.cfg_reg, cs->hw.teles3.isac, offset));
107     }
108     
109     static void
110     WriteISAC(struct IsdnCardState *cs, u_char offset, u_char value)
111     {
112     	writereg(cs->hw.teles3.cfg_reg, cs->hw.teles3.isac, offset, value);
113     }
114     
115     static void
116     ReadISACfifo(struct IsdnCardState *cs, u_char * data, int size)
117     {
118     	read_fifo(cs->hw.teles3.cfg_reg, cs->hw.teles3.isacfifo, data, size);
119     }
120     
121     static void
122     WriteISACfifo(struct IsdnCardState *cs, u_char * data, int size)
123     {
124     	write_fifo(cs->hw.teles3.cfg_reg, cs->hw.teles3.isacfifo, data, size);
125     }
126     
127     static u_char
128     ReadHSCX(struct IsdnCardState *cs, int hscx, u_char offset)
129     {
130     	return (readreg(cs->hw.teles3.cfg_reg, cs->hw.teles3.hscx[hscx], offset));
131     }
132     
133     static void
134     WriteHSCX(struct IsdnCardState *cs, int hscx, u_char offset, u_char value)
135     {
136     	writereg(cs->hw.teles3.cfg_reg, cs->hw.teles3.hscx[hscx], offset, value);
137     }
138     
139     /*
140      * fast interrupt HSCX stuff goes here
141      */
142     
143     #define READHSCX(cs, nr, reg) readreg(cs->hw.teles3.cfg_reg, cs->hw.teles3.hscx[nr], reg)
144     #define WRITEHSCX(cs, nr, reg, data) writereg(cs->hw.teles3.cfg_reg, cs->hw.teles3.hscx[nr], reg, data)
145     #define READHSCXFIFO(cs, nr, ptr, cnt) read_fifo(cs->hw.teles3.cfg_reg, cs->hw.teles3.hscxfifo[nr], ptr, cnt)
146     #define WRITEHSCXFIFO(cs, nr, ptr, cnt) write_fifo(cs->hw.teles3.cfg_reg, cs->hw.teles3.hscxfifo[nr], ptr, cnt)
147     
148     #include "hscx_irq.c"
149     
150     static void
151     s0box_interrupt(int intno, void *dev_id, struct pt_regs *regs)
152     {
153     #define MAXCOUNT 5
154     	struct IsdnCardState *cs = dev_id;
155     	u_char val;
156     	int count = 0;
157     
158     	if (!cs) {
159     		printk(KERN_WARNING "Teles: Spurious interrupt!\n");
160     		return;
161     	}
162     	val = readreg(cs->hw.teles3.cfg_reg, cs->hw.teles3.hscx[1], HSCX_ISTA);
163           Start_HSCX:
164     	if (val)
165     		hscx_int_main(cs, val);
166     	val = readreg(cs->hw.teles3.cfg_reg, cs->hw.teles3.isac, ISAC_ISTA);
167           Start_ISAC:
168     	if (val)
169     		isac_interrupt(cs, val);
170     	count++;
171     	val = readreg(cs->hw.teles3.cfg_reg, cs->hw.teles3.hscx[1], HSCX_ISTA);
172     	if (val && count < MAXCOUNT) {
173     		if (cs->debug & L1_DEB_HSCX)
174     			debugl1(cs, "HSCX IntStat after IntRoutine");
175     		goto Start_HSCX;
176     	}
177     	val = readreg(cs->hw.teles3.cfg_reg, cs->hw.teles3.isac, ISAC_ISTA);
178     	if (val && count < MAXCOUNT) {
179     		if (cs->debug & L1_DEB_ISAC)
180     			debugl1(cs, "ISAC IntStat after IntRoutine");
181     		goto Start_ISAC;
182     	}
183     	if (count >= MAXCOUNT)
184     		printk(KERN_WARNING "S0Box: more than %d loops in s0box_interrupt\n", count);
185     	writereg(cs->hw.teles3.cfg_reg, cs->hw.teles3.hscx[0], HSCX_MASK, 0xFF);
186     	writereg(cs->hw.teles3.cfg_reg, cs->hw.teles3.hscx[1], HSCX_MASK, 0xFF);
187     	writereg(cs->hw.teles3.cfg_reg, cs->hw.teles3.isac, ISAC_MASK, 0xFF);
188     	writereg(cs->hw.teles3.cfg_reg, cs->hw.teles3.isac, ISAC_MASK, 0x0);
189     	writereg(cs->hw.teles3.cfg_reg, cs->hw.teles3.hscx[0], HSCX_MASK, 0x0);
190     	writereg(cs->hw.teles3.cfg_reg, cs->hw.teles3.hscx[1], HSCX_MASK, 0x0);
191     }
192     
193     void
194     release_io_s0box(struct IsdnCardState *cs)
195     {
196     	release_region(cs->hw.teles3.cfg_reg, 8);
197     }
198     
199     static int
200     S0Box_card_msg(struct IsdnCardState *cs, int mt, void *arg)
201     {
202     	switch (mt) {
203     		case CARD_RESET:
204     			break;
205     		case CARD_RELEASE:
206     			release_io_s0box(cs);
207     			break;
208     		case CARD_INIT:
209     			inithscxisac(cs, 3);
210     			break;
211     		case CARD_TEST:
212     			break;
213     	}
214     	return(0);
215     }
216     
217     int __init
218     setup_s0box(struct IsdnCard *card)
219     {
220     	struct IsdnCardState *cs = card->cs;
221     	char tmp[64];
222     
223     	strcpy(tmp, s0box_revision);
224     	printk(KERN_INFO "HiSax: S0Box IO driver Rev. %s\n", HiSax_getrev(tmp));
225     	if (cs->typ != ISDN_CTYPE_S0BOX)
226     		return (0);
227     
228     	cs->hw.teles3.cfg_reg = card->para[1];
229     	cs->hw.teles3.hscx[0] = -0x20;
230     	cs->hw.teles3.hscx[1] = 0x0;
231     	cs->hw.teles3.isac = 0x20;
232     	cs->hw.teles3.isacfifo = cs->hw.teles3.isac + 0x3e;
233     	cs->hw.teles3.hscxfifo[0] = cs->hw.teles3.hscx[0] + 0x3e;
234     	cs->hw.teles3.hscxfifo[1] = cs->hw.teles3.hscx[1] + 0x3e;
235     	cs->irq = card->para[0];
236     	if (check_region(cs->hw.teles3.cfg_reg,8)) {
237     		printk(KERN_WARNING
238     		       "HiSax: %s ports %x-%x already in use\n",
239     		       CardType[cs->typ],
240                            cs->hw.teles3.cfg_reg,
241                            cs->hw.teles3.cfg_reg + 7);
242     		return 0;
243     	} else
244     		request_region(cs->hw.teles3.cfg_reg, 8, "S0Box parallel I/O");
245     	printk(KERN_INFO
246     	       "HiSax: %s config irq:%d isac:0x%x  cfg:0x%x\n",
247     	       CardType[cs->typ], cs->irq,
248     	       cs->hw.teles3.isac, cs->hw.teles3.cfg_reg);
249     	printk(KERN_INFO
250     	       "HiSax: hscx A:0x%x  hscx B:0x%x\n",
251     	       cs->hw.teles3.hscx[0], cs->hw.teles3.hscx[1]);
252     	cs->readisac = &ReadISAC;
253     	cs->writeisac = &WriteISAC;
254     	cs->readisacfifo = &ReadISACfifo;
255     	cs->writeisacfifo = &WriteISACfifo;
256     	cs->BC_Read_Reg = &ReadHSCX;
257     	cs->BC_Write_Reg = &WriteHSCX;
258     	cs->BC_Send_Data = &hscx_fill_fifo;
259     	cs->cardmsg = &S0Box_card_msg;
260     	cs->irq_func = &s0box_interrupt;
261     	ISACVersion(cs, "S0Box:");
262     	if (HscxVersion(cs, "S0Box:")) {
263     		printk(KERN_WARNING
264     		       "S0Box: wrong HSCX versions check IO address\n");
265     		release_io_s0box(cs);
266     		return (0);
267     	}
268     	return (1);
269     }
270