1
2
3
4
5
6
7
8
9
10
11
12
13
14
15#include <linux/init.h>
16#include "hisax.h"
17#include "isac.h"
18#include "hscx.h"
19#include "isdnl1.h"
20
21static char *saphir_rev = "$Revision: 1.10.2.4 $";
22
23#define byteout(addr, val) outb(val, addr)
24#define bytein(addr) inb(addr)
25
26#define ISAC_DATA 0
27#define HSCX_DATA 1
28#define ADDRESS_REG 2
29#define IRQ_REG 3
30#define SPARE_REG 4
31#define RESET_REG 5
32
33static inline u_char
34readreg(unsigned int ale, unsigned int adr, u_char off)
35{
36 register u_char ret;
37
38 byteout(ale, off);
39 ret = bytein(adr);
40 return (ret);
41}
42
43static inline void
44readfifo(unsigned int ale, unsigned int adr, u_char off, u_char *data, int size)
45{
46 byteout(ale, off);
47 insb(adr, data, size);
48}
49
50
51static inline void
52writereg(unsigned int ale, unsigned int adr, u_char off, u_char data)
53{
54 byteout(ale, off);
55 byteout(adr, data);
56}
57
58static inline void
59writefifo(unsigned int ale, unsigned int adr, u_char off, u_char *data, int size)
60{
61 byteout(ale, off);
62 outsb(adr, data, size);
63}
64
65
66
67static u_char
68ReadISAC(struct IsdnCardState *cs, u_char offset)
69{
70 return (readreg(cs->hw.saphir.ale, cs->hw.saphir.isac, offset));
71}
72
73static void
74WriteISAC(struct IsdnCardState *cs, u_char offset, u_char value)
75{
76 writereg(cs->hw.saphir.ale, cs->hw.saphir.isac, offset, value);
77}
78
79static void
80ReadISACfifo(struct IsdnCardState *cs, u_char *data, int size)
81{
82 readfifo(cs->hw.saphir.ale, cs->hw.saphir.isac, 0, data, size);
83}
84
85static void
86WriteISACfifo(struct IsdnCardState *cs, u_char *data, int size)
87{
88 writefifo(cs->hw.saphir.ale, cs->hw.saphir.isac, 0, data, size);
89}
90
91static u_char
92ReadHSCX(struct IsdnCardState *cs, int hscx, u_char offset)
93{
94 return (readreg(cs->hw.saphir.ale, cs->hw.saphir.hscx,
95 offset + (hscx ? 0x40 : 0)));
96}
97
98static void
99WriteHSCX(struct IsdnCardState *cs, int hscx, u_char offset, u_char value)
100{
101 writereg(cs->hw.saphir.ale, cs->hw.saphir.hscx,
102 offset + (hscx ? 0x40 : 0), value);
103}
104
105#define READHSCX(cs, nr, reg) readreg(cs->hw.saphir.ale, \
106 cs->hw.saphir.hscx, reg + (nr ? 0x40 : 0))
107#define WRITEHSCX(cs, nr, reg, data) writereg(cs->hw.saphir.ale, \
108 cs->hw.saphir.hscx, reg + (nr ? 0x40 : 0), data)
109
110#define READHSCXFIFO(cs, nr, ptr, cnt) readfifo(cs->hw.saphir.ale, \
111 cs->hw.saphir.hscx, (nr ? 0x40 : 0), ptr, cnt)
112
113#define WRITEHSCXFIFO(cs, nr, ptr, cnt) writefifo(cs->hw.saphir.ale, \
114 cs->hw.saphir.hscx, (nr ? 0x40 : 0), ptr, cnt)
115
116#include "hscx_irq.c"
117
118static irqreturn_t
119saphir_interrupt(int intno, void *dev_id)
120{
121 struct IsdnCardState *cs = dev_id;
122 u_char val;
123 u_long flags;
124
125 spin_lock_irqsave(&cs->lock, flags);
126 val = readreg(cs->hw.saphir.ale, cs->hw.saphir.hscx, HSCX_ISTA + 0x40);
127Start_HSCX:
128 if (val)
129 hscx_int_main(cs, val);
130 val = readreg(cs->hw.saphir.ale, cs->hw.saphir.isac, ISAC_ISTA);
131Start_ISAC:
132 if (val)
133 isac_interrupt(cs, val);
134 val = readreg(cs->hw.saphir.ale, cs->hw.saphir.hscx, HSCX_ISTA + 0x40);
135 if (val) {
136 if (cs->debug & L1_DEB_HSCX)
137 debugl1(cs, "HSCX IntStat after IntRoutine");
138 goto Start_HSCX;
139 }
140 val = readreg(cs->hw.saphir.ale, cs->hw.saphir.isac, ISAC_ISTA);
141 if (val) {
142 if (cs->debug & L1_DEB_ISAC)
143 debugl1(cs, "ISAC IntStat after IntRoutine");
144 goto Start_ISAC;
145 }
146
147 if (cs->hw.saphir.timer.function)
148 mod_timer(&cs->hw.saphir.timer, jiffies + 1 * HZ);
149 else
150 printk(KERN_WARNING "saphir: Spurious timer!\n");
151 writereg(cs->hw.saphir.ale, cs->hw.saphir.hscx, HSCX_MASK, 0xFF);
152 writereg(cs->hw.saphir.ale, cs->hw.saphir.hscx, HSCX_MASK + 0x40, 0xFF);
153 writereg(cs->hw.saphir.ale, cs->hw.saphir.isac, ISAC_MASK, 0xFF);
154 writereg(cs->hw.saphir.ale, cs->hw.saphir.isac, ISAC_MASK, 0);
155 writereg(cs->hw.saphir.ale, cs->hw.saphir.hscx, HSCX_MASK, 0);
156 writereg(cs->hw.saphir.ale, cs->hw.saphir.hscx, HSCX_MASK + 0x40, 0);
157 spin_unlock_irqrestore(&cs->lock, flags);
158 return IRQ_HANDLED;
159}
160
161static void
162SaphirWatchDog(struct IsdnCardState *cs)
163{
164 u_long flags;
165
166 spin_lock_irqsave(&cs->lock, flags);
167
168 cs->readisac(cs, ISAC_RBCH);
169 spin_unlock_irqrestore(&cs->lock, flags);
170 mod_timer(&cs->hw.saphir.timer, jiffies + 1 * HZ);
171}
172
173static void
174release_io_saphir(struct IsdnCardState *cs)
175{
176 byteout(cs->hw.saphir.cfg_reg + IRQ_REG, 0xff);
177 del_timer(&cs->hw.saphir.timer);
178 cs->hw.saphir.timer.function = NULL;
179 if (cs->hw.saphir.cfg_reg)
180 release_region(cs->hw.saphir.cfg_reg, 6);
181}
182
183static int
184saphir_reset(struct IsdnCardState *cs)
185{
186 u_char irq_val;
187
188 switch (cs->irq) {
189 case 5: irq_val = 0;
190 break;
191 case 3: irq_val = 1;
192 break;
193 case 11:
194 irq_val = 2;
195 break;
196 case 12:
197 irq_val = 3;
198 break;
199 case 15:
200 irq_val = 4;
201 break;
202 default:
203 printk(KERN_WARNING "HiSax: saphir wrong IRQ %d\n",
204 cs->irq);
205 return (1);
206 }
207 byteout(cs->hw.saphir.cfg_reg + IRQ_REG, irq_val);
208 byteout(cs->hw.saphir.cfg_reg + RESET_REG, 1);
209 mdelay(10);
210 byteout(cs->hw.saphir.cfg_reg + RESET_REG, 0);
211 mdelay(10);
212 byteout(cs->hw.saphir.cfg_reg + IRQ_REG, irq_val);
213 byteout(cs->hw.saphir.cfg_reg + SPARE_REG, 0x02);
214 return (0);
215}
216
217static int
218saphir_card_msg(struct IsdnCardState *cs, int mt, void *arg)
219{
220 u_long flags;
221
222 switch (mt) {
223 case CARD_RESET:
224 spin_lock_irqsave(&cs->lock, flags);
225 saphir_reset(cs);
226 spin_unlock_irqrestore(&cs->lock, flags);
227 return (0);
228 case CARD_RELEASE:
229 release_io_saphir(cs);
230 return (0);
231 case CARD_INIT:
232 spin_lock_irqsave(&cs->lock, flags);
233 inithscxisac(cs, 3);
234 spin_unlock_irqrestore(&cs->lock, flags);
235 return (0);
236 case CARD_TEST:
237 return (0);
238 }
239 return (0);
240}
241
242
243int __devinit
244setup_saphir(struct IsdnCard *card)
245{
246 struct IsdnCardState *cs = card->cs;
247 char tmp[64];
248
249 strcpy(tmp, saphir_rev);
250 printk(KERN_INFO "HiSax: HST Saphir driver Rev. %s\n", HiSax_getrev(tmp));
251 if (cs->typ != ISDN_CTYPE_HSTSAPHIR)
252 return (0);
253
254
255 cs->hw.saphir.cfg_reg = card->para[1];
256 cs->hw.saphir.isac = card->para[1] + ISAC_DATA;
257 cs->hw.saphir.hscx = card->para[1] + HSCX_DATA;
258 cs->hw.saphir.ale = card->para[1] + ADDRESS_REG;
259 cs->irq = card->para[0];
260 if (!request_region(cs->hw.saphir.cfg_reg, 6, "saphir")) {
261 printk(KERN_WARNING
262 "HiSax: HST Saphir config port %x-%x already in use\n",
263 cs->hw.saphir.cfg_reg,
264 cs->hw.saphir.cfg_reg + 5);
265 return (0);
266 }
267
268 printk(KERN_INFO "HiSax: HST Saphir config irq:%d io:0x%X\n",
269 cs->irq, cs->hw.saphir.cfg_reg);
270
271 setup_isac(cs);
272 cs->hw.saphir.timer.function = (void *) SaphirWatchDog;
273 cs->hw.saphir.timer.data = (long) cs;
274 init_timer(&cs->hw.saphir.timer);
275 cs->hw.saphir.timer.expires = jiffies + 4 * HZ;
276 add_timer(&cs->hw.saphir.timer);
277 if (saphir_reset(cs)) {
278 release_io_saphir(cs);
279 return (0);
280 }
281 cs->readisac = &ReadISAC;
282 cs->writeisac = &WriteISAC;
283 cs->readisacfifo = &ReadISACfifo;
284 cs->writeisacfifo = &WriteISACfifo;
285 cs->BC_Read_Reg = &ReadHSCX;
286 cs->BC_Write_Reg = &WriteHSCX;
287 cs->BC_Send_Data = &hscx_fill_fifo;
288 cs->cardmsg = &saphir_card_msg;
289 cs->irq_func = &saphir_interrupt;
290 ISACVersion(cs, "saphir:");
291 if (HscxVersion(cs, "saphir:")) {
292 printk(KERN_WARNING
293 "saphir: wrong HSCX versions check IO address\n");
294 release_io_saphir(cs);
295 return (0);
296 }
297 return (1);
298}
299
