usb: xhci-plat: properly handle probe deferral for devm_clk_get()
[linux/fpc-iii.git] / drivers / isdn / hisax / teles3.c
blob38fb2c1a3f0f48cdbbf3511a467d09e16b042e33
1 /* $Id: teles3.c,v 2.19.2.4 2004/01/13 23:48:39 keil Exp $
3 * low level stuff for Teles 16.3 & PNP isdn cards
5 * Author Karsten Keil
6 * Copyright by Karsten Keil <keil@isdn4linux.de>
8 * This software may be used and distributed according to the terms
9 * of the GNU General Public License, incorporated herein by reference.
11 * Thanks to Jan den Ouden
12 * Fritz Elfert
13 * Beat Doebeli
16 #include <linux/init.h>
17 #include <linux/isapnp.h>
18 #include "hisax.h"
19 #include "isac.h"
20 #include "hscx.h"
21 #include "isdnl1.h"
23 static const char *teles3_revision = "$Revision: 2.19.2.4 $";
25 #define byteout(addr, val) outb(val, addr)
26 #define bytein(addr) inb(addr)
28 static inline u_char
29 readreg(unsigned int adr, u_char off)
31 return (bytein(adr + off));
34 static inline void
35 writereg(unsigned int adr, u_char off, u_char data)
37 byteout(adr + off, data);
41 static inline void
42 read_fifo(unsigned int adr, u_char *data, int size)
44 insb(adr, data, size);
47 static void
48 write_fifo(unsigned int adr, u_char *data, int size)
50 outsb(adr, data, size);
53 /* Interface functions */
55 static u_char
56 ReadISAC(struct IsdnCardState *cs, u_char offset)
58 return (readreg(cs->hw.teles3.isac, offset));
61 static void
62 WriteISAC(struct IsdnCardState *cs, u_char offset, u_char value)
64 writereg(cs->hw.teles3.isac, offset, value);
67 static void
68 ReadISACfifo(struct IsdnCardState *cs, u_char *data, int size)
70 read_fifo(cs->hw.teles3.isacfifo, data, size);
73 static void
74 WriteISACfifo(struct IsdnCardState *cs, u_char *data, int size)
76 write_fifo(cs->hw.teles3.isacfifo, data, size);
79 static u_char
80 ReadHSCX(struct IsdnCardState *cs, int hscx, u_char offset)
82 return (readreg(cs->hw.teles3.hscx[hscx], offset));
85 static void
86 WriteHSCX(struct IsdnCardState *cs, int hscx, u_char offset, u_char value)
88 writereg(cs->hw.teles3.hscx[hscx], offset, value);
92 * fast interrupt HSCX stuff goes here
95 #define READHSCX(cs, nr, reg) readreg(cs->hw.teles3.hscx[nr], reg)
96 #define WRITEHSCX(cs, nr, reg, data) writereg(cs->hw.teles3.hscx[nr], reg, data)
97 #define READHSCXFIFO(cs, nr, ptr, cnt) read_fifo(cs->hw.teles3.hscxfifo[nr], ptr, cnt)
98 #define WRITEHSCXFIFO(cs, nr, ptr, cnt) write_fifo(cs->hw.teles3.hscxfifo[nr], ptr, cnt)
100 #include "hscx_irq.c"
102 static irqreturn_t
103 teles3_interrupt(int intno, void *dev_id)
105 #define MAXCOUNT 5
106 struct IsdnCardState *cs = dev_id;
107 u_char val;
108 u_long flags;
109 int count = 0;
111 spin_lock_irqsave(&cs->lock, flags);
112 val = readreg(cs->hw.teles3.hscx[1], HSCX_ISTA);
113 Start_HSCX:
114 if (val)
115 hscx_int_main(cs, val);
116 val = readreg(cs->hw.teles3.isac, ISAC_ISTA);
117 Start_ISAC:
118 if (val)
119 isac_interrupt(cs, val);
120 count++;
121 val = readreg(cs->hw.teles3.hscx[1], HSCX_ISTA);
122 if (val && count < MAXCOUNT) {
123 if (cs->debug & L1_DEB_HSCX)
124 debugl1(cs, "HSCX IntStat after IntRoutine");
125 goto Start_HSCX;
127 val = readreg(cs->hw.teles3.isac, ISAC_ISTA);
128 if (val && count < MAXCOUNT) {
129 if (cs->debug & L1_DEB_ISAC)
130 debugl1(cs, "ISAC IntStat after IntRoutine");
131 goto Start_ISAC;
133 if (count >= MAXCOUNT)
134 printk(KERN_WARNING "Teles3: more than %d loops in teles3_interrupt\n", count);
135 writereg(cs->hw.teles3.hscx[0], HSCX_MASK, 0xFF);
136 writereg(cs->hw.teles3.hscx[1], HSCX_MASK, 0xFF);
137 writereg(cs->hw.teles3.isac, ISAC_MASK, 0xFF);
138 writereg(cs->hw.teles3.isac, ISAC_MASK, 0x0);
139 writereg(cs->hw.teles3.hscx[0], HSCX_MASK, 0x0);
140 writereg(cs->hw.teles3.hscx[1], HSCX_MASK, 0x0);
141 spin_unlock_irqrestore(&cs->lock, flags);
142 return IRQ_HANDLED;
145 static inline void
146 release_ioregs(struct IsdnCardState *cs, int mask)
148 if (mask & 1)
149 release_region(cs->hw.teles3.isac + 32, 32);
150 if (mask & 2)
151 release_region(cs->hw.teles3.hscx[0] + 32, 32);
152 if (mask & 4)
153 release_region(cs->hw.teles3.hscx[1] + 32, 32);
156 static void
157 release_io_teles3(struct IsdnCardState *cs)
159 if (cs->typ == ISDN_CTYPE_TELESPCMCIA) {
160 release_region(cs->hw.teles3.hscx[1], 96);
161 } else {
162 if (cs->hw.teles3.cfg_reg) {
163 if (cs->typ == ISDN_CTYPE_COMPAQ_ISA) {
164 release_region(cs->hw.teles3.cfg_reg, 1);
165 } else {
166 release_region(cs->hw.teles3.cfg_reg, 8);
169 release_ioregs(cs, 0x7);
173 static int
174 reset_teles3(struct IsdnCardState *cs)
176 u_char irqcfg;
178 if (cs->typ != ISDN_CTYPE_TELESPCMCIA) {
179 if ((cs->hw.teles3.cfg_reg) && (cs->typ != ISDN_CTYPE_COMPAQ_ISA)) {
180 switch (cs->irq) {
181 case 2:
182 case 9:
183 irqcfg = 0x00;
184 break;
185 case 3:
186 irqcfg = 0x02;
187 break;
188 case 4:
189 irqcfg = 0x04;
190 break;
191 case 5:
192 irqcfg = 0x06;
193 break;
194 case 10:
195 irqcfg = 0x08;
196 break;
197 case 11:
198 irqcfg = 0x0A;
199 break;
200 case 12:
201 irqcfg = 0x0C;
202 break;
203 case 15:
204 irqcfg = 0x0E;
205 break;
206 default:
207 return (1);
209 byteout(cs->hw.teles3.cfg_reg + 4, irqcfg);
210 HZDELAY(HZ / 10 + 1);
211 byteout(cs->hw.teles3.cfg_reg + 4, irqcfg | 1);
212 HZDELAY(HZ / 10 + 1);
213 } else if (cs->typ == ISDN_CTYPE_COMPAQ_ISA) {
214 byteout(cs->hw.teles3.cfg_reg, 0xff);
215 HZDELAY(2);
216 byteout(cs->hw.teles3.cfg_reg, 0x00);
217 HZDELAY(2);
218 } else {
219 /* Reset off for 16.3 PnP , thanks to Georg Acher */
220 byteout(cs->hw.teles3.isac + 0x3c, 0);
221 HZDELAY(2);
222 byteout(cs->hw.teles3.isac + 0x3c, 1);
223 HZDELAY(2);
226 return (0);
229 static int
230 Teles_card_msg(struct IsdnCardState *cs, int mt, void *arg)
232 u_long flags;
234 switch (mt) {
235 case CARD_RESET:
236 spin_lock_irqsave(&cs->lock, flags);
237 reset_teles3(cs);
238 spin_unlock_irqrestore(&cs->lock, flags);
239 return (0);
240 case CARD_RELEASE:
241 release_io_teles3(cs);
242 return (0);
243 case CARD_INIT:
244 spin_lock_irqsave(&cs->lock, flags);
245 inithscxisac(cs, 3);
246 spin_unlock_irqrestore(&cs->lock, flags);
247 return (0);
248 case CARD_TEST:
249 return (0);
251 return (0);
254 #ifdef __ISAPNP__
256 static struct isapnp_device_id teles_ids[] = {
257 { ISAPNP_VENDOR('T', 'A', 'G'), ISAPNP_FUNCTION(0x2110),
258 ISAPNP_VENDOR('T', 'A', 'G'), ISAPNP_FUNCTION(0x2110),
259 (unsigned long) "Teles 16.3 PnP" },
260 { ISAPNP_VENDOR('C', 'T', 'X'), ISAPNP_FUNCTION(0x0),
261 ISAPNP_VENDOR('C', 'T', 'X'), ISAPNP_FUNCTION(0x0),
262 (unsigned long) "Creatix 16.3 PnP" },
263 { ISAPNP_VENDOR('C', 'P', 'Q'), ISAPNP_FUNCTION(0x1002),
264 ISAPNP_VENDOR('C', 'P', 'Q'), ISAPNP_FUNCTION(0x1002),
265 (unsigned long) "Compaq ISDN S0" },
266 { 0, }
269 static struct isapnp_device_id *ipid = &teles_ids[0];
270 static struct pnp_card *pnp_c = NULL;
271 #endif
273 int setup_teles3(struct IsdnCard *card)
275 u_char val;
276 struct IsdnCardState *cs = card->cs;
277 char tmp[64];
279 strcpy(tmp, teles3_revision);
280 printk(KERN_INFO "HiSax: Teles IO driver Rev. %s\n", HiSax_getrev(tmp));
281 if ((cs->typ != ISDN_CTYPE_16_3) && (cs->typ != ISDN_CTYPE_PNP)
282 && (cs->typ != ISDN_CTYPE_TELESPCMCIA) && (cs->typ != ISDN_CTYPE_COMPAQ_ISA))
283 return (0);
285 #ifdef __ISAPNP__
286 if (!card->para[1] && isapnp_present()) {
287 struct pnp_dev *pnp_d;
288 while (ipid->card_vendor) {
289 if ((pnp_c = pnp_find_card(ipid->card_vendor,
290 ipid->card_device, pnp_c))) {
291 pnp_d = NULL;
292 if ((pnp_d = pnp_find_dev(pnp_c,
293 ipid->vendor, ipid->function, pnp_d))) {
294 int err;
296 printk(KERN_INFO "HiSax: %s detected\n",
297 (char *)ipid->driver_data);
298 pnp_disable_dev(pnp_d);
299 err = pnp_activate_dev(pnp_d);
300 if (err < 0) {
301 printk(KERN_WARNING "%s: pnp_activate_dev ret(%d)\n",
302 __func__, err);
303 return (0);
305 card->para[3] = pnp_port_start(pnp_d, 2);
306 card->para[2] = pnp_port_start(pnp_d, 1);
307 card->para[1] = pnp_port_start(pnp_d, 0);
308 card->para[0] = pnp_irq(pnp_d, 0);
309 if (!card->para[0] || !card->para[1] || !card->para[2]) {
310 printk(KERN_ERR "Teles PnP:some resources are missing %ld/%lx/%lx\n",
311 card->para[0], card->para[1], card->para[2]);
312 pnp_disable_dev(pnp_d);
313 return (0);
315 break;
316 } else {
317 printk(KERN_ERR "Teles PnP: PnP error card found, no device\n");
320 ipid++;
321 pnp_c = NULL;
323 if (!ipid->card_vendor) {
324 printk(KERN_INFO "Teles PnP: no ISAPnP card found\n");
325 return (0);
328 #endif
329 if (cs->typ == ISDN_CTYPE_16_3) {
330 cs->hw.teles3.cfg_reg = card->para[1];
331 switch (cs->hw.teles3.cfg_reg) {
332 case 0x180:
333 case 0x280:
334 case 0x380:
335 cs->hw.teles3.cfg_reg |= 0xc00;
336 break;
338 cs->hw.teles3.isac = cs->hw.teles3.cfg_reg - 0x420;
339 cs->hw.teles3.hscx[0] = cs->hw.teles3.cfg_reg - 0xc20;
340 cs->hw.teles3.hscx[1] = cs->hw.teles3.cfg_reg - 0x820;
341 } else if (cs->typ == ISDN_CTYPE_TELESPCMCIA) {
342 cs->hw.teles3.cfg_reg = 0;
343 cs->hw.teles3.hscx[0] = card->para[1] - 0x20;
344 cs->hw.teles3.hscx[1] = card->para[1];
345 cs->hw.teles3.isac = card->para[1] + 0x20;
346 } else if (cs->typ == ISDN_CTYPE_COMPAQ_ISA) {
347 cs->hw.teles3.cfg_reg = card->para[3];
348 cs->hw.teles3.isac = card->para[2] - 32;
349 cs->hw.teles3.hscx[0] = card->para[1] - 32;
350 cs->hw.teles3.hscx[1] = card->para[1];
351 } else { /* PNP */
352 cs->hw.teles3.cfg_reg = 0;
353 cs->hw.teles3.isac = card->para[1] - 32;
354 cs->hw.teles3.hscx[0] = card->para[2] - 32;
355 cs->hw.teles3.hscx[1] = card->para[2];
357 cs->irq = card->para[0];
358 cs->hw.teles3.isacfifo = cs->hw.teles3.isac + 0x3e;
359 cs->hw.teles3.hscxfifo[0] = cs->hw.teles3.hscx[0] + 0x3e;
360 cs->hw.teles3.hscxfifo[1] = cs->hw.teles3.hscx[1] + 0x3e;
361 if (cs->typ == ISDN_CTYPE_TELESPCMCIA) {
362 if (!request_region(cs->hw.teles3.hscx[1], 96, "HiSax Teles PCMCIA")) {
363 printk(KERN_WARNING
364 "HiSax: %s ports %x-%x already in use\n",
365 CardType[cs->typ],
366 cs->hw.teles3.hscx[1],
367 cs->hw.teles3.hscx[1] + 96);
368 return (0);
370 cs->irq_flags |= IRQF_SHARED; /* cardbus can share */
371 } else {
372 if (cs->hw.teles3.cfg_reg) {
373 if (cs->typ == ISDN_CTYPE_COMPAQ_ISA) {
374 if (!request_region(cs->hw.teles3.cfg_reg, 1, "teles3 cfg")) {
375 printk(KERN_WARNING
376 "HiSax: %s config port %x already in use\n",
377 CardType[card->typ],
378 cs->hw.teles3.cfg_reg);
379 return (0);
381 } else {
382 if (!request_region(cs->hw.teles3.cfg_reg, 8, "teles3 cfg")) {
383 printk(KERN_WARNING
384 "HiSax: %s config port %x-%x already in use\n",
385 CardType[card->typ],
386 cs->hw.teles3.cfg_reg,
387 cs->hw.teles3.cfg_reg + 8);
388 return (0);
392 if (!request_region(cs->hw.teles3.isac + 32, 32, "HiSax isac")) {
393 printk(KERN_WARNING
394 "HiSax: %s isac ports %x-%x already in use\n",
395 CardType[cs->typ],
396 cs->hw.teles3.isac + 32,
397 cs->hw.teles3.isac + 64);
398 if (cs->hw.teles3.cfg_reg) {
399 if (cs->typ == ISDN_CTYPE_COMPAQ_ISA) {
400 release_region(cs->hw.teles3.cfg_reg, 1);
401 } else {
402 release_region(cs->hw.teles3.cfg_reg, 8);
405 return (0);
407 if (!request_region(cs->hw.teles3.hscx[0] + 32, 32, "HiSax hscx A")) {
408 printk(KERN_WARNING
409 "HiSax: %s hscx A ports %x-%x already in use\n",
410 CardType[cs->typ],
411 cs->hw.teles3.hscx[0] + 32,
412 cs->hw.teles3.hscx[0] + 64);
413 if (cs->hw.teles3.cfg_reg) {
414 if (cs->typ == ISDN_CTYPE_COMPAQ_ISA) {
415 release_region(cs->hw.teles3.cfg_reg, 1);
416 } else {
417 release_region(cs->hw.teles3.cfg_reg, 8);
420 release_ioregs(cs, 1);
421 return (0);
423 if (!request_region(cs->hw.teles3.hscx[1] + 32, 32, "HiSax hscx B")) {
424 printk(KERN_WARNING
425 "HiSax: %s hscx B ports %x-%x already in use\n",
426 CardType[cs->typ],
427 cs->hw.teles3.hscx[1] + 32,
428 cs->hw.teles3.hscx[1] + 64);
429 if (cs->hw.teles3.cfg_reg) {
430 if (cs->typ == ISDN_CTYPE_COMPAQ_ISA) {
431 release_region(cs->hw.teles3.cfg_reg, 1);
432 } else {
433 release_region(cs->hw.teles3.cfg_reg, 8);
436 release_ioregs(cs, 3);
437 return (0);
440 if ((cs->hw.teles3.cfg_reg) && (cs->typ != ISDN_CTYPE_COMPAQ_ISA)) {
441 if ((val = bytein(cs->hw.teles3.cfg_reg + 0)) != 0x51) {
442 printk(KERN_WARNING "Teles: 16.3 Byte at %x is %x\n",
443 cs->hw.teles3.cfg_reg + 0, val);
444 release_io_teles3(cs);
445 return (0);
447 if ((val = bytein(cs->hw.teles3.cfg_reg + 1)) != 0x93) {
448 printk(KERN_WARNING "Teles: 16.3 Byte at %x is %x\n",
449 cs->hw.teles3.cfg_reg + 1, val);
450 release_io_teles3(cs);
451 return (0);
453 val = bytein(cs->hw.teles3.cfg_reg + 2);/* 0x1e=without AB
454 * 0x1f=with AB
455 * 0x1c 16.3 ???
456 * 0x39 16.3 1.1
457 * 0x38 16.3 1.3
458 * 0x46 16.3 with AB + Video (Teles-Vision)
460 if (val != 0x46 && val != 0x39 && val != 0x38 && val != 0x1c && val != 0x1e && val != 0x1f) {
461 printk(KERN_WARNING "Teles: 16.3 Byte at %x is %x\n",
462 cs->hw.teles3.cfg_reg + 2, val);
463 release_io_teles3(cs);
464 return (0);
467 printk(KERN_INFO
468 "HiSax: %s config irq:%d isac:0x%X cfg:0x%X\n",
469 CardType[cs->typ], cs->irq,
470 cs->hw.teles3.isac + 32, cs->hw.teles3.cfg_reg);
471 printk(KERN_INFO
472 "HiSax: hscx A:0x%X hscx B:0x%X\n",
473 cs->hw.teles3.hscx[0] + 32, cs->hw.teles3.hscx[1] + 32);
475 setup_isac(cs);
476 if (reset_teles3(cs)) {
477 printk(KERN_WARNING "Teles3: wrong IRQ\n");
478 release_io_teles3(cs);
479 return (0);
481 cs->readisac = &ReadISAC;
482 cs->writeisac = &WriteISAC;
483 cs->readisacfifo = &ReadISACfifo;
484 cs->writeisacfifo = &WriteISACfifo;
485 cs->BC_Read_Reg = &ReadHSCX;
486 cs->BC_Write_Reg = &WriteHSCX;
487 cs->BC_Send_Data = &hscx_fill_fifo;
488 cs->cardmsg = &Teles_card_msg;
489 cs->irq_func = &teles3_interrupt;
490 ISACVersion(cs, "Teles3:");
491 if (HscxVersion(cs, "Teles3:")) {
492 printk(KERN_WARNING
493 "Teles3: wrong HSCX versions check IO address\n");
494 release_io_teles3(cs);
495 return (0);
497 return (1);