1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * ISA Plug & Play support
4 * Copyright (c) by Jaroslav Kysela <perex@perex.cz>
5 *
6 * Changelog:
7 * 2000-01-01 Added quirks handling for buggy hardware
8 * Peter Denison <peterd@pnd-pc.demon.co.uk>
9 * 2000-06-14 Added isapnp_probe_devs() and isapnp_activate_dev()
10 * Christoph Hellwig <hch@infradead.org>
11 * 2001-06-03 Added release_region calls to correspond with
12 * request_region calls when a failure occurs. Also
13 * added KERN_* constants to printk() calls.
14 * 2001-11-07 Added isapnp_{,un}register_driver calls along the lines
15 * of the pci driver interface
16 * Kai Germaschewski <kai.germaschewski@gmx.de>
17 * 2002-06-06 Made the use of dma channel 0 configurable
18 * Gerald Teschl <gerald.teschl@univie.ac.at>
19 * 2002-10-06 Ported to PnP Layer - Adam Belay <ambx1@neo.rr.com>
20 * 2003-08-11 Resource Management Updates - Adam Belay <ambx1@neo.rr.com>
21 */
22
23 #include <linux/moduleparam.h>
24 #include <linux/kernel.h>
25 #include <linux/errno.h>
26 #include <linux/delay.h>
27 #include <linux/init.h>
28 #include <linux/isapnp.h>
29 #include <linux/mutex.h>
30 #include <asm/io.h>
31
32 #include "../base.h"
33
34 #if 0
35 #define ISAPNP_REGION_OK
36 #endif
37
38 int isapnp_disable; /* Disable ISA PnP */
39 static int isapnp_rdp; /* Read Data Port */
40 static int isapnp_reset = 1; /* reset all PnP cards (deactivate) */
41 static int isapnp_verbose = 1; /* verbose mode */
42
43 module_param(isapnp_disable, int, 0);
44 MODULE_PARM_DESC(isapnp_disable, "ISA Plug & Play disable");
45 module_param(isapnp_rdp, int, 0);
46 MODULE_PARM_DESC(isapnp_rdp, "ISA Plug & Play read data port");
47 module_param(isapnp_reset, int, 0);
48 MODULE_PARM_DESC(isapnp_reset, "ISA Plug & Play reset all cards");
49 module_param(isapnp_verbose, int, 0);
50 MODULE_PARM_DESC(isapnp_verbose, "ISA Plug & Play verbose mode");
51
52 #define _PIDXR 0x279
53 #define _PNPWRP 0xa79
54
55 /* short tags */
56 #define _STAG_PNPVERNO 0x01
57 #define _STAG_LOGDEVID 0x02
58 #define _STAG_COMPATDEVID 0x03
59 #define _STAG_IRQ 0x04
60 #define _STAG_DMA 0x05
61 #define _STAG_STARTDEP 0x06
62 #define _STAG_ENDDEP 0x07
63 #define _STAG_IOPORT 0x08
64 #define _STAG_FIXEDIO 0x09
65 #define _STAG_VENDOR 0x0e
66 #define _STAG_END 0x0f
67 /* long tags */
68 #define _LTAG_MEMRANGE 0x81
69 #define _LTAG_ANSISTR 0x82
70 #define _LTAG_UNICODESTR 0x83
71 #define _LTAG_VENDOR 0x84
72 #define _LTAG_MEM32RANGE 0x85
73 #define _LTAG_FIXEDMEM32RANGE 0x86
74
75 /* Logical device control and configuration registers */
76
77 #define ISAPNP_CFG_ACTIVATE 0x30 /* byte */
78 #define ISAPNP_CFG_MEM 0x40 /* 4 * dword */
79 #define ISAPNP_CFG_PORT 0x60 /* 8 * word */
80 #define ISAPNP_CFG_IRQ 0x70 /* 2 * word */
81 #define ISAPNP_CFG_DMA 0x74 /* 2 * byte */
82
83 /*
84 * Sizes of ISAPNP logical device configuration register sets.
85 * See PNP-ISA-v1.0a.pdf, Appendix A.
86 */
87 #define ISAPNP_MAX_MEM 4
88 #define ISAPNP_MAX_PORT 8
89 #define ISAPNP_MAX_IRQ 2
90 #define ISAPNP_MAX_DMA 2
91
92 static unsigned char isapnp_checksum_value;
93 static DEFINE_MUTEX(isapnp_cfg_mutex);
94 static int isapnp_csn_count;
95
96 /* some prototypes */
97
write_data(unsigned char x)98 static inline void write_data(unsigned char x)
99 {
100 outb(x, _PNPWRP);
101 }
102
write_address(unsigned char x)103 static inline void write_address(unsigned char x)
104 {
105 outb(x, _PIDXR);
106 udelay(20);
107 }
108
read_data(void)109 static inline unsigned char read_data(void)
110 {
111 unsigned char val = inb(isapnp_rdp);
112 return val;
113 }
114
isapnp_read_byte(unsigned char idx)115 unsigned char isapnp_read_byte(unsigned char idx)
116 {
117 write_address(idx);
118 return read_data();
119 }
120
isapnp_read_word(unsigned char idx)121 static unsigned short isapnp_read_word(unsigned char idx)
122 {
123 unsigned short val;
124
125 val = isapnp_read_byte(idx);
126 val = (val << 8) + isapnp_read_byte(idx + 1);
127 return val;
128 }
129
isapnp_write_byte(unsigned char idx,unsigned char val)130 void isapnp_write_byte(unsigned char idx, unsigned char val)
131 {
132 write_address(idx);
133 write_data(val);
134 }
135
isapnp_write_word(unsigned char idx,unsigned short val)136 static void isapnp_write_word(unsigned char idx, unsigned short val)
137 {
138 isapnp_write_byte(idx, val >> 8);
139 isapnp_write_byte(idx + 1, val);
140 }
141
isapnp_key(void)142 static void isapnp_key(void)
143 {
144 unsigned char code = 0x6a, msb;
145 int i;
146
147 mdelay(1);
148 write_address(0x00);
149 write_address(0x00);
150
151 write_address(code);
152
153 for (i = 1; i < 32; i++) {
154 msb = ((code & 0x01) ^ ((code & 0x02) >> 1)) << 7;
155 code = (code >> 1) | msb;
156 write_address(code);
157 }
158 }
159
160 /* place all pnp cards in wait-for-key state */
isapnp_wait(void)161 static void isapnp_wait(void)
162 {
163 isapnp_write_byte(0x02, 0x02);
164 }
165
isapnp_wake(unsigned char csn)166 static void isapnp_wake(unsigned char csn)
167 {
168 isapnp_write_byte(0x03, csn);
169 }
170
isapnp_device(unsigned char logdev)171 static void isapnp_device(unsigned char logdev)
172 {
173 isapnp_write_byte(0x07, logdev);
174 }
175
isapnp_activate(unsigned char logdev)176 static void isapnp_activate(unsigned char logdev)
177 {
178 isapnp_device(logdev);
179 isapnp_write_byte(ISAPNP_CFG_ACTIVATE, 1);
180 udelay(250);
181 }
182
isapnp_deactivate(unsigned char logdev)183 static void isapnp_deactivate(unsigned char logdev)
184 {
185 isapnp_device(logdev);
186 isapnp_write_byte(ISAPNP_CFG_ACTIVATE, 0);
187 udelay(500);
188 }
189
isapnp_peek(unsigned char * data,int bytes)190 static void __init isapnp_peek(unsigned char *data, int bytes)
191 {
192 int i, j;
193 unsigned char d = 0;
194
195 for (i = 1; i <= bytes; i++) {
196 for (j = 0; j < 20; j++) {
197 d = isapnp_read_byte(0x05);
198 if (d & 1)
199 break;
200 udelay(100);
201 }
202 if (!(d & 1)) {
203 if (data != NULL)
204 *data++ = 0xff;
205 continue;
206 }
207 d = isapnp_read_byte(0x04); /* PRESDI */
208 isapnp_checksum_value += d;
209 if (data != NULL)
210 *data++ = d;
211 }
212 }
213
214 #define RDP_STEP 32 /* minimum is 4 */
215
isapnp_next_rdp(void)216 static int isapnp_next_rdp(void)
217 {
218 int rdp = isapnp_rdp;
219 static int old_rdp = 0;
220
221 if (old_rdp) {
222 release_region(old_rdp, 1);
223 old_rdp = 0;
224 }
225 while (rdp <= 0x3ff) {
226 /*
227 * We cannot use NE2000 probe spaces for ISAPnP or we
228 * will lock up machines.
229 */
230 if ((rdp < 0x280 || rdp > 0x380)
231 && request_region(rdp, 1, "ISAPnP")) {
232 isapnp_rdp = rdp;
233 old_rdp = rdp;
234 return 0;
235 }
236 rdp += RDP_STEP;
237 }
238 return -1;
239 }
240
241 /* Set read port address */
isapnp_set_rdp(void)242 static inline void isapnp_set_rdp(void)
243 {
244 isapnp_write_byte(0x00, isapnp_rdp >> 2);
245 udelay(100);
246 }
247
248 /*
249 * Perform an isolation. The port selection code now tries to avoid
250 * "dangerous to read" ports.
251 */
isapnp_isolate_rdp_select(void)252 static int __init isapnp_isolate_rdp_select(void)
253 {
254 isapnp_wait();
255 isapnp_key();
256
257 /* Control: reset CSN and conditionally everything else too */
258 isapnp_write_byte(0x02, isapnp_reset ? 0x05 : 0x04);
259 mdelay(2);
260
261 isapnp_wait();
262 isapnp_key();
263 isapnp_wake(0x00);
264
265 if (isapnp_next_rdp() < 0) {
266 isapnp_wait();
267 return -1;
268 }
269
270 isapnp_set_rdp();
271 udelay(1000);
272 write_address(0x01);
273 udelay(1000);
274 return 0;
275 }
276
277 /*
278 * Isolate (assign uniqued CSN) to all ISA PnP devices.
279 */
isapnp_isolate(void)280 static int __init isapnp_isolate(void)
281 {
282 unsigned char checksum = 0x6a;
283 unsigned char chksum = 0x00;
284 unsigned char bit = 0x00;
285 int data;
286 int csn = 0;
287 int i;
288 int iteration = 1;
289
290 isapnp_rdp = 0x213;
291 if (isapnp_isolate_rdp_select() < 0)
292 return -1;
293
294 while (1) {
295 for (i = 1; i <= 64; i++) {
296 data = read_data() << 8;
297 udelay(250);
298 data = data | read_data();
299 udelay(250);
300 if (data == 0x55aa)
301 bit = 0x01;
302 checksum =
303 ((((checksum ^ (checksum >> 1)) & 0x01) ^ bit) << 7)
304 | (checksum >> 1);
305 bit = 0x00;
306 }
307 for (i = 65; i <= 72; i++) {
308 data = read_data() << 8;
309 udelay(250);
310 data = data | read_data();
311 udelay(250);
312 if (data == 0x55aa)
313 chksum |= (1 << (i - 65));
314 }
315 if (checksum != 0x00 && checksum == chksum) {
316 csn++;
317
318 isapnp_write_byte(0x06, csn);
319 udelay(250);
320 iteration++;
321 isapnp_wake(0x00);
322 isapnp_set_rdp();
323 udelay(1000);
324 write_address(0x01);
325 udelay(1000);
326 goto __next;
327 }
328 if (iteration == 1) {
329 isapnp_rdp += RDP_STEP;
330 if (isapnp_isolate_rdp_select() < 0)
331 return -1;
332 } else if (iteration > 1) {
333 break;
334 }
335 __next:
336 if (csn == 255)
337 break;
338 checksum = 0x6a;
339 chksum = 0x00;
340 bit = 0x00;
341 }
342 isapnp_wait();
343 isapnp_csn_count = csn;
344 return csn;
345 }
346
347 /*
348 * Read one tag from stream.
349 */
isapnp_read_tag(unsigned char * type,unsigned short * size)350 static int __init isapnp_read_tag(unsigned char *type, unsigned short *size)
351 {
352 unsigned char tag, tmp[2];
353
354 isapnp_peek(&tag, 1);
355 if (tag == 0) /* invalid tag */
356 return -1;
357 if (tag & 0x80) { /* large item */
358 *type = tag;
359 isapnp_peek(tmp, 2);
360 *size = (tmp[1] << 8) | tmp[0];
361 } else {
362 *type = (tag >> 3) & 0x0f;
363 *size = tag & 0x07;
364 }
365 if (*type == 0xff && *size == 0xffff) /* probably invalid data */
366 return -1;
367 return 0;
368 }
369
370 /*
371 * Skip specified number of bytes from stream.
372 */
isapnp_skip_bytes(int count)373 static void __init isapnp_skip_bytes(int count)
374 {
375 isapnp_peek(NULL, count);
376 }
377
378 /*
379 * Parse logical device tag.
380 */
isapnp_parse_device(struct pnp_card * card,int size,int number)381 static struct pnp_dev *__init isapnp_parse_device(struct pnp_card *card,
382 int size, int number)
383 {
384 unsigned char tmp[6];
385 struct pnp_dev *dev;
386 u32 eisa_id;
387 char id[8];
388
389 isapnp_peek(tmp, size);
390 eisa_id = tmp[0] | tmp[1] << 8 | tmp[2] << 16 | tmp[3] << 24;
391 pnp_eisa_id_to_string(eisa_id, id);
392
393 dev = pnp_alloc_dev(&isapnp_protocol, number, id);
394 if (!dev)
395 return NULL;
396
397 dev->card = card;
398 dev->capabilities |= PNP_CONFIGURABLE;
399 dev->capabilities |= PNP_READ;
400 dev->capabilities |= PNP_WRITE;
401 dev->capabilities |= PNP_DISABLE;
402 pnp_init_resources(dev);
403 return dev;
404 }
405
406 /*
407 * Add IRQ resource to resources list.
408 */
isapnp_parse_irq_resource(struct pnp_dev * dev,unsigned int option_flags,int size)409 static void __init isapnp_parse_irq_resource(struct pnp_dev *dev,
410 unsigned int option_flags,
411 int size)
412 {
413 unsigned char tmp[3];
414 unsigned long bits;
415 pnp_irq_mask_t map;
416 unsigned char flags = IORESOURCE_IRQ_HIGHEDGE;
417
418 isapnp_peek(tmp, size);
419 bits = (tmp[1] << 8) | tmp[0];
420
421 bitmap_zero(map.bits, PNP_IRQ_NR);
422 bitmap_copy(map.bits, &bits, 16);
423
424 if (size > 2)
425 flags = tmp[2];
426
427 pnp_register_irq_resource(dev, option_flags, &map, flags);
428 }
429
430 /*
431 * Add DMA resource to resources list.
432 */
isapnp_parse_dma_resource(struct pnp_dev * dev,unsigned int option_flags,int size)433 static void __init isapnp_parse_dma_resource(struct pnp_dev *dev,
434 unsigned int option_flags,
435 int size)
436 {
437 unsigned char tmp[2];
438
439 isapnp_peek(tmp, size);
440 pnp_register_dma_resource(dev, option_flags, tmp[0], tmp[1]);
441 }
442
443 /*
444 * Add port resource to resources list.
445 */
isapnp_parse_port_resource(struct pnp_dev * dev,unsigned int option_flags,int size)446 static void __init isapnp_parse_port_resource(struct pnp_dev *dev,
447 unsigned int option_flags,
448 int size)
449 {
450 unsigned char tmp[7];
451 resource_size_t min, max, align, len;
452 unsigned char flags;
453
454 isapnp_peek(tmp, size);
455 min = (tmp[2] << 8) | tmp[1];
456 max = (tmp[4] << 8) | tmp[3];
457 align = tmp[5];
458 len = tmp[6];
459 flags = tmp[0] ? IORESOURCE_IO_16BIT_ADDR : 0;
460 pnp_register_port_resource(dev, option_flags,
461 min, max, align, len, flags);
462 }
463
464 /*
465 * Add fixed port resource to resources list.
466 */
isapnp_parse_fixed_port_resource(struct pnp_dev * dev,unsigned int option_flags,int size)467 static void __init isapnp_parse_fixed_port_resource(struct pnp_dev *dev,
468 unsigned int option_flags,
469 int size)
470 {
471 unsigned char tmp[3];
472 resource_size_t base, len;
473
474 isapnp_peek(tmp, size);
475 base = (tmp[1] << 8) | tmp[0];
476 len = tmp[2];
477 pnp_register_port_resource(dev, option_flags, base, base, 0, len,
478 IORESOURCE_IO_FIXED);
479 }
480
481 /*
482 * Add memory resource to resources list.
483 */
isapnp_parse_mem_resource(struct pnp_dev * dev,unsigned int option_flags,int size)484 static void __init isapnp_parse_mem_resource(struct pnp_dev *dev,
485 unsigned int option_flags,
486 int size)
487 {
488 unsigned char tmp[9];
489 resource_size_t min, max, align, len;
490 unsigned char flags;
491
492 isapnp_peek(tmp, size);
493 min = ((tmp[2] << 8) | tmp[1]) << 8;
494 max = ((tmp[4] << 8) | tmp[3]) << 8;
495 align = (tmp[6] << 8) | tmp[5];
496 len = ((tmp[8] << 8) | tmp[7]) << 8;
497 flags = tmp[0];
498 pnp_register_mem_resource(dev, option_flags,
499 min, max, align, len, flags);
500 }
501
502 /*
503 * Add 32-bit memory resource to resources list.
504 */
isapnp_parse_mem32_resource(struct pnp_dev * dev,unsigned int option_flags,int size)505 static void __init isapnp_parse_mem32_resource(struct pnp_dev *dev,
506 unsigned int option_flags,
507 int size)
508 {
509 unsigned char tmp[17];
510 resource_size_t min, max, align, len;
511 unsigned char flags;
512
513 isapnp_peek(tmp, size);
514 min = (tmp[4] << 24) | (tmp[3] << 16) | (tmp[2] << 8) | tmp[1];
515 max = (tmp[8] << 24) | (tmp[7] << 16) | (tmp[6] << 8) | tmp[5];
516 align = (tmp[12] << 24) | (tmp[11] << 16) | (tmp[10] << 8) | tmp[9];
517 len = (tmp[16] << 24) | (tmp[15] << 16) | (tmp[14] << 8) | tmp[13];
518 flags = tmp[0];
519 pnp_register_mem_resource(dev, option_flags,
520 min, max, align, len, flags);
521 }
522
523 /*
524 * Add 32-bit fixed memory resource to resources list.
525 */
isapnp_parse_fixed_mem32_resource(struct pnp_dev * dev,unsigned int option_flags,int size)526 static void __init isapnp_parse_fixed_mem32_resource(struct pnp_dev *dev,
527 unsigned int option_flags,
528 int size)
529 {
530 unsigned char tmp[9];
531 resource_size_t base, len;
532 unsigned char flags;
533
534 isapnp_peek(tmp, size);
535 base = (tmp[4] << 24) | (tmp[3] << 16) | (tmp[2] << 8) | tmp[1];
536 len = (tmp[8] << 24) | (tmp[7] << 16) | (tmp[6] << 8) | tmp[5];
537 flags = tmp[0];
538 pnp_register_mem_resource(dev, option_flags, base, base, 0, len, flags);
539 }
540
541 /*
542 * Parse card name for ISA PnP device.
543 */
544 static void __init
isapnp_parse_name(char * name,unsigned int name_max,unsigned short * size)545 isapnp_parse_name(char *name, unsigned int name_max, unsigned short *size)
546 {
547 if (name[0] == '\0') {
548 unsigned short size1 =
549 *size >= name_max ? (name_max - 1) : *size;
550 isapnp_peek(name, size1);
551 name[size1] = '\0';
552 *size -= size1;
553
554 /* clean whitespace from end of string */
555 while (size1 > 0 && name[--size1] == ' ')
556 name[size1] = '\0';
557 }
558 }
559
560 /*
561 * Parse resource map for logical device.
562 */
isapnp_create_device(struct pnp_card * card,unsigned short size)563 static int __init isapnp_create_device(struct pnp_card *card,
564 unsigned short size)
565 {
566 int number = 0, skip = 0, priority, compat = 0;
567 unsigned char type, tmp[17];
568 unsigned int option_flags;
569 struct pnp_dev *dev;
570 u32 eisa_id;
571 char id[8];
572
573 if ((dev = isapnp_parse_device(card, size, number++)) == NULL)
574 return 1;
575 option_flags = 0;
576 pnp_add_card_device(card, dev);
577
578 while (1) {
579 if (isapnp_read_tag(&type, &size) < 0)
580 return 1;
581 if (skip && type != _STAG_LOGDEVID && type != _STAG_END)
582 goto __skip;
583 switch (type) {
584 case _STAG_LOGDEVID:
585 if (size >= 5 && size <= 6) {
586 if ((dev =
587 isapnp_parse_device(card, size,
588 number++)) == NULL)
589 return 1;
590 size = 0;
591 skip = 0;
592 option_flags = 0;
593 pnp_add_card_device(card, dev);
594 } else {
595 skip = 1;
596 }
597 compat = 0;
598 break;
599 case _STAG_COMPATDEVID:
600 if (size == 4 && compat < DEVICE_COUNT_COMPATIBLE) {
601 isapnp_peek(tmp, 4);
602 eisa_id = tmp[0] | tmp[1] << 8 |
603 tmp[2] << 16 | tmp[3] << 24;
604 pnp_eisa_id_to_string(eisa_id, id);
605 pnp_add_id(dev, id);
606 compat++;
607 size = 0;
608 }
609 break;
610 case _STAG_IRQ:
611 if (size < 2 || size > 3)
612 goto __skip;
613 isapnp_parse_irq_resource(dev, option_flags, size);
614 size = 0;
615 break;
616 case _STAG_DMA:
617 if (size != 2)
618 goto __skip;
619 isapnp_parse_dma_resource(dev, option_flags, size);
620 size = 0;
621 break;
622 case _STAG_STARTDEP:
623 if (size > 1)
624 goto __skip;
625 priority = PNP_RES_PRIORITY_ACCEPTABLE;
626 if (size > 0) {
627 isapnp_peek(tmp, size);
628 priority = tmp[0];
629 size = 0;
630 }
631 option_flags = pnp_new_dependent_set(dev, priority);
632 break;
633 case _STAG_ENDDEP:
634 if (size != 0)
635 goto __skip;
636 option_flags = 0;
637 break;
638 case _STAG_IOPORT:
639 if (size != 7)
640 goto __skip;
641 isapnp_parse_port_resource(dev, option_flags, size);
642 size = 0;
643 break;
644 case _STAG_FIXEDIO:
645 if (size != 3)
646 goto __skip;
647 isapnp_parse_fixed_port_resource(dev, option_flags,
648 size);
649 size = 0;
650 break;
651 case _STAG_VENDOR:
652 break;
653 case _LTAG_MEMRANGE:
654 if (size != 9)
655 goto __skip;
656 isapnp_parse_mem_resource(dev, option_flags, size);
657 size = 0;
658 break;
659 case _LTAG_ANSISTR:
660 isapnp_parse_name(dev->name, sizeof(dev->name), &size);
661 break;
662 case _LTAG_UNICODESTR:
663 /* silently ignore */
664 /* who use unicode for hardware identification? */
665 break;
666 case _LTAG_VENDOR:
667 break;
668 case _LTAG_MEM32RANGE:
669 if (size != 17)
670 goto __skip;
671 isapnp_parse_mem32_resource(dev, option_flags, size);
672 size = 0;
673 break;
674 case _LTAG_FIXEDMEM32RANGE:
675 if (size != 9)
676 goto __skip;
677 isapnp_parse_fixed_mem32_resource(dev, option_flags,
678 size);
679 size = 0;
680 break;
681 case _STAG_END:
682 if (size > 0)
683 isapnp_skip_bytes(size);
684 return 1;
685 default:
686 dev_err(&dev->dev, "unknown tag %#x (card %i), "
687 "ignored\n", type, card->number);
688 }
689 __skip:
690 if (size > 0)
691 isapnp_skip_bytes(size);
692 }
693 return 0;
694 }
695
696 /*
697 * Parse resource map for ISA PnP card.
698 */
isapnp_parse_resource_map(struct pnp_card * card)699 static void __init isapnp_parse_resource_map(struct pnp_card *card)
700 {
701 unsigned char type, tmp[17];
702 unsigned short size;
703
704 while (1) {
705 if (isapnp_read_tag(&type, &size) < 0)
706 return;
707 switch (type) {
708 case _STAG_PNPVERNO:
709 if (size != 2)
710 goto __skip;
711 isapnp_peek(tmp, 2);
712 card->pnpver = tmp[0];
713 card->productver = tmp[1];
714 size = 0;
715 break;
716 case _STAG_LOGDEVID:
717 if (size >= 5 && size <= 6) {
718 if (isapnp_create_device(card, size) == 1)
719 return;
720 size = 0;
721 }
722 break;
723 case _STAG_VENDOR:
724 break;
725 case _LTAG_ANSISTR:
726 isapnp_parse_name(card->name, sizeof(card->name),
727 &size);
728 break;
729 case _LTAG_UNICODESTR:
730 /* silently ignore */
731 /* who use unicode for hardware identification? */
732 break;
733 case _LTAG_VENDOR:
734 break;
735 case _STAG_END:
736 if (size > 0)
737 isapnp_skip_bytes(size);
738 return;
739 default:
740 dev_err(&card->dev, "unknown tag %#x, ignored\n",
741 type);
742 }
743 __skip:
744 if (size > 0)
745 isapnp_skip_bytes(size);
746 }
747 }
748
749 /*
750 * Compute ISA PnP checksum for first eight bytes.
751 */
isapnp_checksum(unsigned char * data)752 static unsigned char __init isapnp_checksum(unsigned char *data)
753 {
754 int i, j;
755 unsigned char checksum = 0x6a, bit, b;
756
757 for (i = 0; i < 8; i++) {
758 b = data[i];
759 for (j = 0; j < 8; j++) {
760 bit = 0;
761 if (b & (1 << j))
762 bit = 1;
763 checksum =
764 ((((checksum ^ (checksum >> 1)) & 0x01) ^ bit) << 7)
765 | (checksum >> 1);
766 }
767 }
768 return checksum;
769 }
770
771 /*
772 * Build device list for all present ISA PnP devices.
773 */
isapnp_build_device_list(void)774 static int __init isapnp_build_device_list(void)
775 {
776 int csn;
777 unsigned char header[9], checksum;
778 struct pnp_card *card;
779 u32 eisa_id;
780 char id[8];
781
782 isapnp_wait();
783 isapnp_key();
784 for (csn = 1; csn <= isapnp_csn_count; csn++) {
785 isapnp_wake(csn);
786 isapnp_peek(header, 9);
787 checksum = isapnp_checksum(header);
788 eisa_id = header[0] | header[1] << 8 |
789 header[2] << 16 | header[3] << 24;
790 pnp_eisa_id_to_string(eisa_id, id);
791 card = pnp_alloc_card(&isapnp_protocol, csn, id);
792 if (!card)
793 continue;
794
795 INIT_LIST_HEAD(&card->devices);
796 card->serial =
797 (header[7] << 24) | (header[6] << 16) | (header[5] << 8) |
798 header[4];
799 isapnp_checksum_value = 0x00;
800 isapnp_parse_resource_map(card);
801 if (isapnp_checksum_value != 0x00)
802 dev_err(&card->dev, "invalid checksum %#x\n",
803 isapnp_checksum_value);
804 card->checksum = isapnp_checksum_value;
805
806 pnp_add_card(card);
807 }
808 isapnp_wait();
809 return 0;
810 }
811
812 /*
813 * Basic configuration routines.
814 */
815
isapnp_present(void)816 int isapnp_present(void)
817 {
818 struct pnp_card *card;
819
820 pnp_for_each_card(card) {
821 if (card->protocol == &isapnp_protocol)
822 return 1;
823 }
824 return 0;
825 }
826
isapnp_cfg_begin(int csn,int logdev)827 int isapnp_cfg_begin(int csn, int logdev)
828 {
829 if (csn < 1 || csn > isapnp_csn_count || logdev > 10)
830 return -EINVAL;
831 mutex_lock(&isapnp_cfg_mutex);
832 isapnp_wait();
833 isapnp_key();
834 isapnp_wake(csn);
835 #if 0
836 /* to avoid malfunction when the isapnptools package is used */
837 /* we must set RDP to our value again */
838 /* it is possible to set RDP only in the isolation phase */
839 /* Jens Thoms Toerring <Jens.Toerring@physik.fu-berlin.de> */
840 isapnp_write_byte(0x02, 0x04); /* clear CSN of card */
841 mdelay(2); /* is this necessary? */
842 isapnp_wake(csn); /* bring card into sleep state */
843 isapnp_wake(0); /* bring card into isolation state */
844 isapnp_set_rdp(); /* reset the RDP port */
845 udelay(1000); /* delay 1000us */
846 isapnp_write_byte(0x06, csn); /* reset CSN to previous value */
847 udelay(250); /* is this necessary? */
848 #endif
849 if (logdev >= 0)
850 isapnp_device(logdev);
851 return 0;
852 }
853
isapnp_cfg_end(void)854 int isapnp_cfg_end(void)
855 {
856 isapnp_wait();
857 mutex_unlock(&isapnp_cfg_mutex);
858 return 0;
859 }
860
861 /*
862 * Initialization.
863 */
864
865 EXPORT_SYMBOL(isapnp_protocol);
866 EXPORT_SYMBOL(isapnp_present);
867 EXPORT_SYMBOL(isapnp_cfg_begin);
868 EXPORT_SYMBOL(isapnp_cfg_end);
869 EXPORT_SYMBOL(isapnp_write_byte);
870
isapnp_get_resources(struct pnp_dev * dev)871 static int isapnp_get_resources(struct pnp_dev *dev)
872 {
873 int i, ret;
874
875 pnp_dbg(&dev->dev, "get resources\n");
876 pnp_init_resources(dev);
877 isapnp_cfg_begin(dev->card->number, dev->number);
878 dev->active = isapnp_read_byte(ISAPNP_CFG_ACTIVATE);
879 if (!dev->active)
880 goto __end;
881
882 for (i = 0; i < ISAPNP_MAX_PORT; i++) {
883 ret = isapnp_read_word(ISAPNP_CFG_PORT + (i << 1));
884 pnp_add_io_resource(dev, ret, ret,
885 ret == 0 ? IORESOURCE_DISABLED : 0);
886 }
887 for (i = 0; i < ISAPNP_MAX_MEM; i++) {
888 ret = isapnp_read_word(ISAPNP_CFG_MEM + (i << 3)) << 8;
889 pnp_add_mem_resource(dev, ret, ret,
890 ret == 0 ? IORESOURCE_DISABLED : 0);
891 }
892 for (i = 0; i < ISAPNP_MAX_IRQ; i++) {
893 ret = isapnp_read_word(ISAPNP_CFG_IRQ + (i << 1)) >> 8;
894 pnp_add_irq_resource(dev, ret,
895 ret == 0 ? IORESOURCE_DISABLED : 0);
896 }
897 for (i = 0; i < ISAPNP_MAX_DMA; i++) {
898 ret = isapnp_read_byte(ISAPNP_CFG_DMA + i);
899 pnp_add_dma_resource(dev, ret,
900 ret == 4 ? IORESOURCE_DISABLED : 0);
901 }
902
903 __end:
904 isapnp_cfg_end();
905 return 0;
906 }
907
isapnp_set_resources(struct pnp_dev * dev)908 static int isapnp_set_resources(struct pnp_dev *dev)
909 {
910 struct resource *res;
911 int tmp;
912
913 pnp_dbg(&dev->dev, "set resources\n");
914 isapnp_cfg_begin(dev->card->number, dev->number);
915 dev->active = 1;
916 for (tmp = 0; tmp < ISAPNP_MAX_PORT; tmp++) {
917 res = pnp_get_resource(dev, IORESOURCE_IO, tmp);
918 if (pnp_resource_enabled(res)) {
919 pnp_dbg(&dev->dev, " set io %d to %#llx\n",
920 tmp, (unsigned long long) res->start);
921 isapnp_write_word(ISAPNP_CFG_PORT + (tmp << 1),
922 res->start);
923 }
924 }
925 for (tmp = 0; tmp < ISAPNP_MAX_IRQ; tmp++) {
926 res = pnp_get_resource(dev, IORESOURCE_IRQ, tmp);
927 if (pnp_resource_enabled(res)) {
928 int irq = res->start;
929 if (irq == 2)
930 irq = 9;
931 pnp_dbg(&dev->dev, " set irq %d to %d\n", tmp, irq);
932 isapnp_write_byte(ISAPNP_CFG_IRQ + (tmp << 1), irq);
933 }
934 }
935 for (tmp = 0; tmp < ISAPNP_MAX_DMA; tmp++) {
936 res = pnp_get_resource(dev, IORESOURCE_DMA, tmp);
937 if (pnp_resource_enabled(res)) {
938 pnp_dbg(&dev->dev, " set dma %d to %lld\n",
939 tmp, (unsigned long long) res->start);
940 isapnp_write_byte(ISAPNP_CFG_DMA + tmp, res->start);
941 }
942 }
943 for (tmp = 0; tmp < ISAPNP_MAX_MEM; tmp++) {
944 res = pnp_get_resource(dev, IORESOURCE_MEM, tmp);
945 if (pnp_resource_enabled(res)) {
946 pnp_dbg(&dev->dev, " set mem %d to %#llx\n",
947 tmp, (unsigned long long) res->start);
948 isapnp_write_word(ISAPNP_CFG_MEM + (tmp << 3),
949 (res->start >> 8) & 0xffff);
950 }
951 }
952 /* FIXME: We aren't handling 32bit mems properly here */
953 isapnp_activate(dev->number);
954 isapnp_cfg_end();
955 return 0;
956 }
957
isapnp_disable_resources(struct pnp_dev * dev)958 static int isapnp_disable_resources(struct pnp_dev *dev)
959 {
960 if (!dev->active)
961 return -EINVAL;
962 isapnp_cfg_begin(dev->card->number, dev->number);
963 isapnp_deactivate(dev->number);
964 dev->active = 0;
965 isapnp_cfg_end();
966 return 0;
967 }
968
969 struct pnp_protocol isapnp_protocol = {
970 .name = "ISA Plug and Play",
971 .get = isapnp_get_resources,
972 .set = isapnp_set_resources,
973 .disable = isapnp_disable_resources,
974 };
975
isapnp_init(void)976 static int __init isapnp_init(void)
977 {
978 int cards;
979 struct pnp_card *card;
980 struct pnp_dev *dev;
981
982 if (isapnp_disable) {
983 printk(KERN_INFO "isapnp: ISA Plug & Play support disabled\n");
984 return 0;
985 }
986 #ifdef CONFIG_PPC
987 if (check_legacy_ioport(_PIDXR) || check_legacy_ioport(_PNPWRP))
988 return -EINVAL;
989 #endif
990 #ifdef ISAPNP_REGION_OK
991 if (!request_region(_PIDXR, 1, "isapnp index")) {
992 printk(KERN_ERR "isapnp: Index Register 0x%x already used\n",
993 _PIDXR);
994 return -EBUSY;
995 }
996 #endif
997 if (!request_region(_PNPWRP, 1, "isapnp write")) {
998 printk(KERN_ERR
999 "isapnp: Write Data Register 0x%x already used\n",
1000 _PNPWRP);
1001 #ifdef ISAPNP_REGION_OK
1002 release_region(_PIDXR, 1);
1003 #endif
1004 return -EBUSY;
1005 }
1006
1007 if (pnp_register_protocol(&isapnp_protocol) < 0)
1008 return -EBUSY;
1009
1010 /*
1011 * Print a message. The existing ISAPnP code is hanging machines
1012 * so let the user know where.
1013 */
1014
1015 printk(KERN_INFO "isapnp: Scanning for PnP cards...\n");
1016 if (isapnp_rdp >= 0x203 && isapnp_rdp <= 0x3ff) {
1017 isapnp_rdp |= 3;
1018 if (!request_region(isapnp_rdp, 1, "isapnp read")) {
1019 printk(KERN_ERR
1020 "isapnp: Read Data Register 0x%x already used\n",
1021 isapnp_rdp);
1022 #ifdef ISAPNP_REGION_OK
1023 release_region(_PIDXR, 1);
1024 #endif
1025 release_region(_PNPWRP, 1);
1026 return -EBUSY;
1027 }
1028 isapnp_set_rdp();
1029 }
1030 if (isapnp_rdp < 0x203 || isapnp_rdp > 0x3ff) {
1031 cards = isapnp_isolate();
1032 if (cards < 0 || (isapnp_rdp < 0x203 || isapnp_rdp > 0x3ff)) {
1033 #ifdef ISAPNP_REGION_OK
1034 release_region(_PIDXR, 1);
1035 #endif
1036 release_region(_PNPWRP, 1);
1037 printk(KERN_INFO
1038 "isapnp: No Plug & Play device found\n");
1039 return 0;
1040 }
1041 request_region(isapnp_rdp, 1, "isapnp read");
1042 }
1043 isapnp_build_device_list();
1044 cards = 0;
1045
1046 protocol_for_each_card(&isapnp_protocol, card) {
1047 cards++;
1048 if (isapnp_verbose) {
1049 dev_info(&card->dev, "card '%s'\n",
1050 card->name[0] ? card->name : "unknown");
1051 if (isapnp_verbose < 2)
1052 continue;
1053 card_for_each_dev(card, dev) {
1054 dev_info(&card->dev, "device '%s'\n",
1055 dev->name[0] ? dev->name : "unknown");
1056 }
1057 }
1058 }
1059 if (cards)
1060 printk(KERN_INFO
1061 "isapnp: %i Plug & Play card%s detected total\n", cards,
1062 cards > 1 ? "s" : "");
1063 else
1064 printk(KERN_INFO "isapnp: No Plug & Play card found\n");
1065
1066 isapnp_proc_init();
1067 return 0;
1068 }
1069
1070 device_initcall(isapnp_init);
1071
1072 /* format is: noisapnp */
1073
isapnp_setup_disable(char * str)1074 static int __init isapnp_setup_disable(char *str)
1075 {
1076 isapnp_disable = 1;
1077 return 1;
1078 }
1079
1080 __setup("noisapnp", isapnp_setup_disable);
1081
1082 /* format is: isapnp=rdp,reset,skip_pci_scan,verbose */
1083
isapnp_setup_isapnp(char * str)1084 static int __init isapnp_setup_isapnp(char *str)
1085 {
1086 (void)((get_option(&str, &isapnp_rdp) == 2) &&
1087 (get_option(&str, &isapnp_reset) == 2) &&
1088 (get_option(&str, &isapnp_verbose) == 2));
1089 return 1;
1090 }
1091
1092 __setup("isapnp=", isapnp_setup_isapnp);
1093
