11da177e4SLinus Torvalds /* 21da177e4SLinus Torvalds * ISA Plug & Play support 31da177e4SLinus Torvalds * Copyright (c) by Jaroslav Kysela <perex@suse.cz> 41da177e4SLinus Torvalds * 51da177e4SLinus Torvalds * 61da177e4SLinus Torvalds * This program is free software; you can redistribute it and/or modify 71da177e4SLinus Torvalds * it under the terms of the GNU General Public License as published by 81da177e4SLinus Torvalds * the Free Software Foundation; either version 2 of the License, or 91da177e4SLinus Torvalds * (at your option) any later version. 101da177e4SLinus Torvalds * 111da177e4SLinus Torvalds * This program is distributed in the hope that it will be useful, 121da177e4SLinus Torvalds * but WITHOUT ANY WARRANTY; without even the implied warranty of 131da177e4SLinus Torvalds * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 141da177e4SLinus Torvalds * GNU General Public License for more details. 151da177e4SLinus Torvalds * 161da177e4SLinus Torvalds * You should have received a copy of the GNU General Public License 171da177e4SLinus Torvalds * along with this program; if not, write to the Free Software 181da177e4SLinus Torvalds * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 191da177e4SLinus Torvalds * 201da177e4SLinus Torvalds * Changelog: 211da177e4SLinus Torvalds * 2000-01-01 Added quirks handling for buggy hardware 221da177e4SLinus Torvalds * Peter Denison <peterd@pnd-pc.demon.co.uk> 231da177e4SLinus Torvalds * 2000-06-14 Added isapnp_probe_devs() and isapnp_activate_dev() 241da177e4SLinus Torvalds * Christoph Hellwig <hch@infradead.org> 251da177e4SLinus Torvalds * 2001-06-03 Added release_region calls to correspond with 261da177e4SLinus Torvalds * request_region calls when a failure occurs. Also 271da177e4SLinus Torvalds * added KERN_* constants to printk() calls. 281da177e4SLinus Torvalds * 2001-11-07 Added isapnp_{,un}register_driver calls along the lines 291da177e4SLinus Torvalds * of the pci driver interface 301da177e4SLinus Torvalds * Kai Germaschewski <kai.germaschewski@gmx.de> 311da177e4SLinus Torvalds * 2002-06-06 Made the use of dma channel 0 configurable 321da177e4SLinus Torvalds * Gerald Teschl <gerald.teschl@univie.ac.at> 331da177e4SLinus Torvalds * 2002-10-06 Ported to PnP Layer - Adam Belay <ambx1@neo.rr.com> 341da177e4SLinus Torvalds * 2003-08-11 Resource Management Updates - Adam Belay <ambx1@neo.rr.com> 351da177e4SLinus Torvalds */ 361da177e4SLinus Torvalds 371da177e4SLinus Torvalds #include <linux/module.h> 381da177e4SLinus Torvalds #include <linux/kernel.h> 391da177e4SLinus Torvalds #include <linux/errno.h> 401da177e4SLinus Torvalds #include <linux/slab.h> 411da177e4SLinus Torvalds #include <linux/delay.h> 421da177e4SLinus Torvalds #include <linux/init.h> 431da177e4SLinus Torvalds #include <linux/isapnp.h> 4414cc3e2bSIngo Molnar #include <linux/mutex.h> 451da177e4SLinus Torvalds #include <asm/io.h> 461da177e4SLinus Torvalds 471da177e4SLinus Torvalds #if 0 481da177e4SLinus Torvalds #define ISAPNP_REGION_OK 491da177e4SLinus Torvalds #endif 501da177e4SLinus Torvalds #if 0 511da177e4SLinus Torvalds #define ISAPNP_DEBUG 521da177e4SLinus Torvalds #endif 531da177e4SLinus Torvalds 541da177e4SLinus Torvalds int isapnp_disable; /* Disable ISA PnP */ 551da177e4SLinus Torvalds static int isapnp_rdp; /* Read Data Port */ 561da177e4SLinus Torvalds static int isapnp_reset = 1; /* reset all PnP cards (deactivate) */ 571da177e4SLinus Torvalds static int isapnp_verbose = 1; /* verbose mode */ 581da177e4SLinus Torvalds 591da177e4SLinus Torvalds MODULE_AUTHOR("Jaroslav Kysela <perex@suse.cz>"); 601da177e4SLinus Torvalds MODULE_DESCRIPTION("Generic ISA Plug & Play support"); 611da177e4SLinus Torvalds module_param(isapnp_disable, int, 0); 621da177e4SLinus Torvalds MODULE_PARM_DESC(isapnp_disable, "ISA Plug & Play disable"); 631da177e4SLinus Torvalds module_param(isapnp_rdp, int, 0); 641da177e4SLinus Torvalds MODULE_PARM_DESC(isapnp_rdp, "ISA Plug & Play read data port"); 651da177e4SLinus Torvalds module_param(isapnp_reset, int, 0); 661da177e4SLinus Torvalds MODULE_PARM_DESC(isapnp_reset, "ISA Plug & Play reset all cards"); 671da177e4SLinus Torvalds module_param(isapnp_verbose, int, 0); 681da177e4SLinus Torvalds MODULE_PARM_DESC(isapnp_verbose, "ISA Plug & Play verbose mode"); 691da177e4SLinus Torvalds MODULE_LICENSE("GPL"); 701da177e4SLinus Torvalds 711da177e4SLinus Torvalds #define _PIDXR 0x279 721da177e4SLinus Torvalds #define _PNPWRP 0xa79 731da177e4SLinus Torvalds 741da177e4SLinus Torvalds /* short tags */ 751da177e4SLinus Torvalds #define _STAG_PNPVERNO 0x01 761da177e4SLinus Torvalds #define _STAG_LOGDEVID 0x02 771da177e4SLinus Torvalds #define _STAG_COMPATDEVID 0x03 781da177e4SLinus Torvalds #define _STAG_IRQ 0x04 791da177e4SLinus Torvalds #define _STAG_DMA 0x05 801da177e4SLinus Torvalds #define _STAG_STARTDEP 0x06 811da177e4SLinus Torvalds #define _STAG_ENDDEP 0x07 821da177e4SLinus Torvalds #define _STAG_IOPORT 0x08 831da177e4SLinus Torvalds #define _STAG_FIXEDIO 0x09 841da177e4SLinus Torvalds #define _STAG_VENDOR 0x0e 851da177e4SLinus Torvalds #define _STAG_END 0x0f 861da177e4SLinus Torvalds /* long tags */ 871da177e4SLinus Torvalds #define _LTAG_MEMRANGE 0x81 881da177e4SLinus Torvalds #define _LTAG_ANSISTR 0x82 891da177e4SLinus Torvalds #define _LTAG_UNICODESTR 0x83 901da177e4SLinus Torvalds #define _LTAG_VENDOR 0x84 911da177e4SLinus Torvalds #define _LTAG_MEM32RANGE 0x85 921da177e4SLinus Torvalds #define _LTAG_FIXEDMEM32RANGE 0x86 931da177e4SLinus Torvalds 941da177e4SLinus Torvalds static unsigned char isapnp_checksum_value; 9514cc3e2bSIngo Molnar static DEFINE_MUTEX(isapnp_cfg_mutex); 961da177e4SLinus Torvalds static int isapnp_detected; 971da177e4SLinus Torvalds static int isapnp_csn_count; 981da177e4SLinus Torvalds 991da177e4SLinus Torvalds /* some prototypes */ 1001da177e4SLinus Torvalds 1011da177e4SLinus Torvalds static inline void write_data(unsigned char x) 1021da177e4SLinus Torvalds { 1031da177e4SLinus Torvalds outb(x, _PNPWRP); 1041da177e4SLinus Torvalds } 1051da177e4SLinus Torvalds 1061da177e4SLinus Torvalds static inline void write_address(unsigned char x) 1071da177e4SLinus Torvalds { 1081da177e4SLinus Torvalds outb(x, _PIDXR); 1091da177e4SLinus Torvalds udelay(20); 1101da177e4SLinus Torvalds } 1111da177e4SLinus Torvalds 1121da177e4SLinus Torvalds static inline unsigned char read_data(void) 1131da177e4SLinus Torvalds { 1141da177e4SLinus Torvalds unsigned char val = inb(isapnp_rdp); 1151da177e4SLinus Torvalds return val; 1161da177e4SLinus Torvalds } 1171da177e4SLinus Torvalds 1181da177e4SLinus Torvalds unsigned char isapnp_read_byte(unsigned char idx) 1191da177e4SLinus Torvalds { 1201da177e4SLinus Torvalds write_address(idx); 1211da177e4SLinus Torvalds return read_data(); 1221da177e4SLinus Torvalds } 1231da177e4SLinus Torvalds 1241da177e4SLinus Torvalds static unsigned short isapnp_read_word(unsigned char idx) 1251da177e4SLinus Torvalds { 1261da177e4SLinus Torvalds unsigned short val; 1271da177e4SLinus Torvalds 1281da177e4SLinus Torvalds val = isapnp_read_byte(idx); 1291da177e4SLinus Torvalds val = (val << 8) + isapnp_read_byte(idx + 1); 1301da177e4SLinus Torvalds return val; 1311da177e4SLinus Torvalds } 1321da177e4SLinus Torvalds 1331da177e4SLinus Torvalds void isapnp_write_byte(unsigned char idx, unsigned char val) 1341da177e4SLinus Torvalds { 1351da177e4SLinus Torvalds write_address(idx); 1361da177e4SLinus Torvalds write_data(val); 1371da177e4SLinus Torvalds } 1381da177e4SLinus Torvalds 1391da177e4SLinus Torvalds static void isapnp_write_word(unsigned char idx, unsigned short val) 1401da177e4SLinus Torvalds { 1411da177e4SLinus Torvalds isapnp_write_byte(idx, val >> 8); 1421da177e4SLinus Torvalds isapnp_write_byte(idx + 1, val); 1431da177e4SLinus Torvalds } 1441da177e4SLinus Torvalds 1451da177e4SLinus Torvalds static void isapnp_key(void) 1461da177e4SLinus Torvalds { 1471da177e4SLinus Torvalds unsigned char code = 0x6a, msb; 1481da177e4SLinus Torvalds int i; 1491da177e4SLinus Torvalds 1501da177e4SLinus Torvalds mdelay(1); 1511da177e4SLinus Torvalds write_address(0x00); 1521da177e4SLinus Torvalds write_address(0x00); 1531da177e4SLinus Torvalds 1541da177e4SLinus Torvalds write_address(code); 1551da177e4SLinus Torvalds 1561da177e4SLinus Torvalds for (i = 1; i < 32; i++) { 1571da177e4SLinus Torvalds msb = ((code & 0x01) ^ ((code & 0x02) >> 1)) << 7; 1581da177e4SLinus Torvalds code = (code >> 1) | msb; 1591da177e4SLinus Torvalds write_address(code); 1601da177e4SLinus Torvalds } 1611da177e4SLinus Torvalds } 1621da177e4SLinus Torvalds 1631da177e4SLinus Torvalds /* place all pnp cards in wait-for-key state */ 1641da177e4SLinus Torvalds static void isapnp_wait(void) 1651da177e4SLinus Torvalds { 1661da177e4SLinus Torvalds isapnp_write_byte(0x02, 0x02); 1671da177e4SLinus Torvalds } 1681da177e4SLinus Torvalds 1691da177e4SLinus Torvalds static void isapnp_wake(unsigned char csn) 1701da177e4SLinus Torvalds { 1711da177e4SLinus Torvalds isapnp_write_byte(0x03, csn); 1721da177e4SLinus Torvalds } 1731da177e4SLinus Torvalds 1741da177e4SLinus Torvalds static void isapnp_device(unsigned char logdev) 1751da177e4SLinus Torvalds { 1761da177e4SLinus Torvalds isapnp_write_byte(0x07, logdev); 1771da177e4SLinus Torvalds } 1781da177e4SLinus Torvalds 1791da177e4SLinus Torvalds static void isapnp_activate(unsigned char logdev) 1801da177e4SLinus Torvalds { 1811da177e4SLinus Torvalds isapnp_device(logdev); 1821da177e4SLinus Torvalds isapnp_write_byte(ISAPNP_CFG_ACTIVATE, 1); 1831da177e4SLinus Torvalds udelay(250); 1841da177e4SLinus Torvalds } 1851da177e4SLinus Torvalds 1861da177e4SLinus Torvalds static void isapnp_deactivate(unsigned char logdev) 1871da177e4SLinus Torvalds { 1881da177e4SLinus Torvalds isapnp_device(logdev); 1891da177e4SLinus Torvalds isapnp_write_byte(ISAPNP_CFG_ACTIVATE, 0); 1901da177e4SLinus Torvalds udelay(500); 1911da177e4SLinus Torvalds } 1921da177e4SLinus Torvalds 1931da177e4SLinus Torvalds static void __init isapnp_peek(unsigned char *data, int bytes) 1941da177e4SLinus Torvalds { 1951da177e4SLinus Torvalds int i, j; 1961da177e4SLinus Torvalds unsigned char d = 0; 1971da177e4SLinus Torvalds 1981da177e4SLinus Torvalds for (i = 1; i <= bytes; i++) { 1991da177e4SLinus Torvalds for (j = 0; j < 20; j++) { 2001da177e4SLinus Torvalds d = isapnp_read_byte(0x05); 2011da177e4SLinus Torvalds if (d & 1) 2021da177e4SLinus Torvalds break; 2031da177e4SLinus Torvalds udelay(100); 2041da177e4SLinus Torvalds } 2051da177e4SLinus Torvalds if (!(d & 1)) { 2061da177e4SLinus Torvalds if (data != NULL) 2071da177e4SLinus Torvalds *data++ = 0xff; 2081da177e4SLinus Torvalds continue; 2091da177e4SLinus Torvalds } 2101da177e4SLinus Torvalds d = isapnp_read_byte(0x04); /* PRESDI */ 2111da177e4SLinus Torvalds isapnp_checksum_value += d; 2121da177e4SLinus Torvalds if (data != NULL) 2131da177e4SLinus Torvalds *data++ = d; 2141da177e4SLinus Torvalds } 2151da177e4SLinus Torvalds } 2161da177e4SLinus Torvalds 2171da177e4SLinus Torvalds #define RDP_STEP 32 /* minimum is 4 */ 2181da177e4SLinus Torvalds 2191da177e4SLinus Torvalds static int isapnp_next_rdp(void) 2201da177e4SLinus Torvalds { 2211da177e4SLinus Torvalds int rdp = isapnp_rdp; 2221da177e4SLinus Torvalds static int old_rdp = 0; 2231da177e4SLinus Torvalds 2249dd78466SBjorn Helgaas if (old_rdp) { 2251da177e4SLinus Torvalds release_region(old_rdp, 1); 2261da177e4SLinus Torvalds old_rdp = 0; 2271da177e4SLinus Torvalds } 2281da177e4SLinus Torvalds while (rdp <= 0x3ff) { 2291da177e4SLinus Torvalds /* 2301da177e4SLinus Torvalds * We cannot use NE2000 probe spaces for ISAPnP or we 2311da177e4SLinus Torvalds * will lock up machines. 2321da177e4SLinus Torvalds */ 2339dd78466SBjorn Helgaas if ((rdp < 0x280 || rdp > 0x380) 2349dd78466SBjorn Helgaas && request_region(rdp, 1, "ISAPnP")) { 2351da177e4SLinus Torvalds isapnp_rdp = rdp; 2361da177e4SLinus Torvalds old_rdp = rdp; 2371da177e4SLinus Torvalds return 0; 2381da177e4SLinus Torvalds } 2391da177e4SLinus Torvalds rdp += RDP_STEP; 2401da177e4SLinus Torvalds } 2411da177e4SLinus Torvalds return -1; 2421da177e4SLinus Torvalds } 2431da177e4SLinus Torvalds 2441da177e4SLinus Torvalds /* Set read port address */ 2451da177e4SLinus Torvalds static inline void isapnp_set_rdp(void) 2461da177e4SLinus Torvalds { 2471da177e4SLinus Torvalds isapnp_write_byte(0x00, isapnp_rdp >> 2); 2481da177e4SLinus Torvalds udelay(100); 2491da177e4SLinus Torvalds } 2501da177e4SLinus Torvalds 2511da177e4SLinus Torvalds /* 2521da177e4SLinus Torvalds * Perform an isolation. The port selection code now tries to avoid 2531da177e4SLinus Torvalds * "dangerous to read" ports. 2541da177e4SLinus Torvalds */ 2551da177e4SLinus Torvalds 2561da177e4SLinus Torvalds static int __init isapnp_isolate_rdp_select(void) 2571da177e4SLinus Torvalds { 2581da177e4SLinus Torvalds isapnp_wait(); 2591da177e4SLinus Torvalds isapnp_key(); 2601da177e4SLinus Torvalds 2611da177e4SLinus Torvalds /* Control: reset CSN and conditionally everything else too */ 2621da177e4SLinus Torvalds isapnp_write_byte(0x02, isapnp_reset ? 0x05 : 0x04); 2631da177e4SLinus Torvalds mdelay(2); 2641da177e4SLinus Torvalds 2651da177e4SLinus Torvalds isapnp_wait(); 2661da177e4SLinus Torvalds isapnp_key(); 2671da177e4SLinus Torvalds isapnp_wake(0x00); 2681da177e4SLinus Torvalds 2691da177e4SLinus Torvalds if (isapnp_next_rdp() < 0) { 2701da177e4SLinus Torvalds isapnp_wait(); 2711da177e4SLinus Torvalds return -1; 2721da177e4SLinus Torvalds } 2731da177e4SLinus Torvalds 2741da177e4SLinus Torvalds isapnp_set_rdp(); 2751da177e4SLinus Torvalds udelay(1000); 2761da177e4SLinus Torvalds write_address(0x01); 2771da177e4SLinus Torvalds udelay(1000); 2781da177e4SLinus Torvalds return 0; 2791da177e4SLinus Torvalds } 2801da177e4SLinus Torvalds 2811da177e4SLinus Torvalds /* 2821da177e4SLinus Torvalds * Isolate (assign uniqued CSN) to all ISA PnP devices. 2831da177e4SLinus Torvalds */ 2841da177e4SLinus Torvalds 2851da177e4SLinus Torvalds static int __init isapnp_isolate(void) 2861da177e4SLinus Torvalds { 2871da177e4SLinus Torvalds unsigned char checksum = 0x6a; 2881da177e4SLinus Torvalds unsigned char chksum = 0x00; 2891da177e4SLinus Torvalds unsigned char bit = 0x00; 2901da177e4SLinus Torvalds int data; 2911da177e4SLinus Torvalds int csn = 0; 2921da177e4SLinus Torvalds int i; 2931da177e4SLinus Torvalds int iteration = 1; 2941da177e4SLinus Torvalds 2951da177e4SLinus Torvalds isapnp_rdp = 0x213; 2961da177e4SLinus Torvalds if (isapnp_isolate_rdp_select() < 0) 2971da177e4SLinus Torvalds return -1; 2981da177e4SLinus Torvalds 2991da177e4SLinus Torvalds while (1) { 3001da177e4SLinus Torvalds for (i = 1; i <= 64; i++) { 3011da177e4SLinus Torvalds data = read_data() << 8; 3021da177e4SLinus Torvalds udelay(250); 3031da177e4SLinus Torvalds data = data | read_data(); 3041da177e4SLinus Torvalds udelay(250); 3051da177e4SLinus Torvalds if (data == 0x55aa) 3061da177e4SLinus Torvalds bit = 0x01; 3079dd78466SBjorn Helgaas checksum = 3089dd78466SBjorn Helgaas ((((checksum ^ (checksum >> 1)) & 0x01) ^ bit) << 7) 3099dd78466SBjorn Helgaas | (checksum >> 1); 3101da177e4SLinus Torvalds bit = 0x00; 3111da177e4SLinus Torvalds } 3121da177e4SLinus Torvalds for (i = 65; i <= 72; i++) { 3131da177e4SLinus Torvalds data = read_data() << 8; 3141da177e4SLinus Torvalds udelay(250); 3151da177e4SLinus Torvalds data = data | read_data(); 3161da177e4SLinus Torvalds udelay(250); 3171da177e4SLinus Torvalds if (data == 0x55aa) 3181da177e4SLinus Torvalds chksum |= (1 << (i - 65)); 3191da177e4SLinus Torvalds } 3201da177e4SLinus Torvalds if (checksum != 0x00 && checksum == chksum) { 3211da177e4SLinus Torvalds csn++; 3221da177e4SLinus Torvalds 3231da177e4SLinus Torvalds isapnp_write_byte(0x06, csn); 3241da177e4SLinus Torvalds udelay(250); 3251da177e4SLinus Torvalds iteration++; 3261da177e4SLinus Torvalds isapnp_wake(0x00); 3271da177e4SLinus Torvalds isapnp_set_rdp(); 3281da177e4SLinus Torvalds udelay(1000); 3291da177e4SLinus Torvalds write_address(0x01); 3301da177e4SLinus Torvalds udelay(1000); 3311da177e4SLinus Torvalds goto __next; 3321da177e4SLinus Torvalds } 3331da177e4SLinus Torvalds if (iteration == 1) { 3341da177e4SLinus Torvalds isapnp_rdp += RDP_STEP; 3351da177e4SLinus Torvalds if (isapnp_isolate_rdp_select() < 0) 3361da177e4SLinus Torvalds return -1; 3371da177e4SLinus Torvalds } else if (iteration > 1) { 3381da177e4SLinus Torvalds break; 3391da177e4SLinus Torvalds } 3401da177e4SLinus Torvalds __next: 3411da177e4SLinus Torvalds if (csn == 255) 3421da177e4SLinus Torvalds break; 3431da177e4SLinus Torvalds checksum = 0x6a; 3441da177e4SLinus Torvalds chksum = 0x00; 3451da177e4SLinus Torvalds bit = 0x00; 3461da177e4SLinus Torvalds } 3471da177e4SLinus Torvalds isapnp_wait(); 3481da177e4SLinus Torvalds isapnp_csn_count = csn; 3491da177e4SLinus Torvalds return csn; 3501da177e4SLinus Torvalds } 3511da177e4SLinus Torvalds 3521da177e4SLinus Torvalds /* 3531da177e4SLinus Torvalds * Read one tag from stream. 3541da177e4SLinus Torvalds */ 3551da177e4SLinus Torvalds 3561da177e4SLinus Torvalds static int __init isapnp_read_tag(unsigned char *type, unsigned short *size) 3571da177e4SLinus Torvalds { 3581da177e4SLinus Torvalds unsigned char tag, tmp[2]; 3591da177e4SLinus Torvalds 3601da177e4SLinus Torvalds isapnp_peek(&tag, 1); 3611da177e4SLinus Torvalds if (tag == 0) /* invalid tag */ 3621da177e4SLinus Torvalds return -1; 3631da177e4SLinus Torvalds if (tag & 0x80) { /* large item */ 3641da177e4SLinus Torvalds *type = tag; 3651da177e4SLinus Torvalds isapnp_peek(tmp, 2); 3661da177e4SLinus Torvalds *size = (tmp[1] << 8) | tmp[0]; 3671da177e4SLinus Torvalds } else { 3681da177e4SLinus Torvalds *type = (tag >> 3) & 0x0f; 3691da177e4SLinus Torvalds *size = tag & 0x07; 3701da177e4SLinus Torvalds } 3711da177e4SLinus Torvalds #if 0 3729dd78466SBjorn Helgaas printk(KERN_DEBUG "tag = 0x%x, type = 0x%x, size = %i\n", tag, *type, 3739dd78466SBjorn Helgaas *size); 3741da177e4SLinus Torvalds #endif 3751da177e4SLinus Torvalds if (*type == 0xff && *size == 0xffff) /* probably invalid data */ 3761da177e4SLinus Torvalds return -1; 3771da177e4SLinus Torvalds return 0; 3781da177e4SLinus Torvalds } 3791da177e4SLinus Torvalds 3801da177e4SLinus Torvalds /* 3811da177e4SLinus Torvalds * Skip specified number of bytes from stream. 3821da177e4SLinus Torvalds */ 3831da177e4SLinus Torvalds 3841da177e4SLinus Torvalds static void __init isapnp_skip_bytes(int count) 3851da177e4SLinus Torvalds { 3861da177e4SLinus Torvalds isapnp_peek(NULL, count); 3871da177e4SLinus Torvalds } 3881da177e4SLinus Torvalds 3891da177e4SLinus Torvalds /* 3901da177e4SLinus Torvalds * Parse EISA id. 3911da177e4SLinus Torvalds */ 3921da177e4SLinus Torvalds 3939dd78466SBjorn Helgaas static void isapnp_parse_id(struct pnp_dev *dev, unsigned short vendor, 3949dd78466SBjorn Helgaas unsigned short device) 3951da177e4SLinus Torvalds { 3961da177e4SLinus Torvalds struct pnp_id *id; 3971da177e4SLinus Torvalds if (!dev) 3981da177e4SLinus Torvalds return; 399cd861280SRobert P. J. Day id = kzalloc(sizeof(struct pnp_id), GFP_KERNEL); 4001da177e4SLinus Torvalds if (!id) 4011da177e4SLinus Torvalds return; 4021da177e4SLinus Torvalds sprintf(id->id, "%c%c%c%x%x%x%x", 4031da177e4SLinus Torvalds 'A' + ((vendor >> 2) & 0x3f) - 1, 4041da177e4SLinus Torvalds 'A' + (((vendor & 3) << 3) | ((vendor >> 13) & 7)) - 1, 4051da177e4SLinus Torvalds 'A' + ((vendor >> 8) & 0x1f) - 1, 4061da177e4SLinus Torvalds (device >> 4) & 0x0f, 4079dd78466SBjorn Helgaas device & 0x0f, (device >> 12) & 0x0f, (device >> 8) & 0x0f); 4081da177e4SLinus Torvalds pnp_add_id(id, dev); 4091da177e4SLinus Torvalds } 4101da177e4SLinus Torvalds 4111da177e4SLinus Torvalds /* 4121da177e4SLinus Torvalds * Parse logical device tag. 4131da177e4SLinus Torvalds */ 4141da177e4SLinus Torvalds 4159dd78466SBjorn Helgaas static struct pnp_dev *__init isapnp_parse_device(struct pnp_card *card, 4169dd78466SBjorn Helgaas int size, int number) 4171da177e4SLinus Torvalds { 4181da177e4SLinus Torvalds unsigned char tmp[6]; 4191da177e4SLinus Torvalds struct pnp_dev *dev; 4201da177e4SLinus Torvalds 4211da177e4SLinus Torvalds isapnp_peek(tmp, size); 422cd861280SRobert P. J. Day dev = kzalloc(sizeof(struct pnp_dev), GFP_KERNEL); 4231da177e4SLinus Torvalds if (!dev) 4241da177e4SLinus Torvalds return NULL; 4251da177e4SLinus Torvalds dev->number = number; 4261da177e4SLinus Torvalds isapnp_parse_id(dev, (tmp[1] << 8) | tmp[0], (tmp[3] << 8) | tmp[2]); 4271da177e4SLinus Torvalds dev->regs = tmp[4]; 4281da177e4SLinus Torvalds dev->card = card; 4291da177e4SLinus Torvalds if (size > 5) 4301da177e4SLinus Torvalds dev->regs |= tmp[5] << 8; 4311da177e4SLinus Torvalds dev->protocol = &isapnp_protocol; 4321da177e4SLinus Torvalds dev->capabilities |= PNP_CONFIGURABLE; 4331da177e4SLinus Torvalds dev->capabilities |= PNP_READ; 4341da177e4SLinus Torvalds dev->capabilities |= PNP_WRITE; 4351da177e4SLinus Torvalds dev->capabilities |= PNP_DISABLE; 4361da177e4SLinus Torvalds pnp_init_resource_table(&dev->res); 4371da177e4SLinus Torvalds return dev; 4381da177e4SLinus Torvalds } 4391da177e4SLinus Torvalds 4401da177e4SLinus Torvalds /* 4411da177e4SLinus Torvalds * Add IRQ resource to resources list. 4421da177e4SLinus Torvalds */ 4431da177e4SLinus Torvalds 4441da177e4SLinus Torvalds static void __init isapnp_parse_irq_resource(struct pnp_option *option, 4451da177e4SLinus Torvalds int size) 4461da177e4SLinus Torvalds { 4471da177e4SLinus Torvalds unsigned char tmp[3]; 4481da177e4SLinus Torvalds struct pnp_irq *irq; 4491da177e4SLinus Torvalds unsigned long bits; 4501da177e4SLinus Torvalds 4511da177e4SLinus Torvalds isapnp_peek(tmp, size); 452cd861280SRobert P. J. Day irq = kzalloc(sizeof(struct pnp_irq), GFP_KERNEL); 4531da177e4SLinus Torvalds if (!irq) 4541da177e4SLinus Torvalds return; 4551da177e4SLinus Torvalds bits = (tmp[1] << 8) | tmp[0]; 4561da177e4SLinus Torvalds bitmap_copy(irq->map, &bits, 16); 4571da177e4SLinus Torvalds if (size > 2) 4581da177e4SLinus Torvalds irq->flags = tmp[2]; 4591da177e4SLinus Torvalds else 4601da177e4SLinus Torvalds irq->flags = IORESOURCE_IRQ_HIGHEDGE; 4611da177e4SLinus Torvalds pnp_register_irq_resource(option, irq); 4621da177e4SLinus Torvalds return; 4631da177e4SLinus Torvalds } 4641da177e4SLinus Torvalds 4651da177e4SLinus Torvalds /* 4661da177e4SLinus Torvalds * Add DMA resource to resources list. 4671da177e4SLinus Torvalds */ 4681da177e4SLinus Torvalds 4691da177e4SLinus Torvalds static void __init isapnp_parse_dma_resource(struct pnp_option *option, 4701da177e4SLinus Torvalds int size) 4711da177e4SLinus Torvalds { 4721da177e4SLinus Torvalds unsigned char tmp[2]; 4731da177e4SLinus Torvalds struct pnp_dma *dma; 4741da177e4SLinus Torvalds 4751da177e4SLinus Torvalds isapnp_peek(tmp, size); 476cd861280SRobert P. J. Day dma = kzalloc(sizeof(struct pnp_dma), GFP_KERNEL); 4771da177e4SLinus Torvalds if (!dma) 4781da177e4SLinus Torvalds return; 4791da177e4SLinus Torvalds dma->map = tmp[0]; 4801da177e4SLinus Torvalds dma->flags = tmp[1]; 4811da177e4SLinus Torvalds pnp_register_dma_resource(option, dma); 4821da177e4SLinus Torvalds return; 4831da177e4SLinus Torvalds } 4841da177e4SLinus Torvalds 4851da177e4SLinus Torvalds /* 4861da177e4SLinus Torvalds * Add port resource to resources list. 4871da177e4SLinus Torvalds */ 4881da177e4SLinus Torvalds 4891da177e4SLinus Torvalds static void __init isapnp_parse_port_resource(struct pnp_option *option, 4901da177e4SLinus Torvalds int size) 4911da177e4SLinus Torvalds { 4921da177e4SLinus Torvalds unsigned char tmp[7]; 4931da177e4SLinus Torvalds struct pnp_port *port; 4941da177e4SLinus Torvalds 4951da177e4SLinus Torvalds isapnp_peek(tmp, size); 496cd861280SRobert P. J. Day port = kzalloc(sizeof(struct pnp_port), GFP_KERNEL); 4971da177e4SLinus Torvalds if (!port) 4981da177e4SLinus Torvalds return; 4991da177e4SLinus Torvalds port->min = (tmp[2] << 8) | tmp[1]; 5001da177e4SLinus Torvalds port->max = (tmp[4] << 8) | tmp[3]; 5011da177e4SLinus Torvalds port->align = tmp[5]; 5021da177e4SLinus Torvalds port->size = tmp[6]; 5031da177e4SLinus Torvalds port->flags = tmp[0] ? PNP_PORT_FLAG_16BITADDR : 0; 5041da177e4SLinus Torvalds pnp_register_port_resource(option, port); 5051da177e4SLinus Torvalds return; 5061da177e4SLinus Torvalds } 5071da177e4SLinus Torvalds 5081da177e4SLinus Torvalds /* 5091da177e4SLinus Torvalds * Add fixed port resource to resources list. 5101da177e4SLinus Torvalds */ 5111da177e4SLinus Torvalds 5121da177e4SLinus Torvalds static void __init isapnp_parse_fixed_port_resource(struct pnp_option *option, 5131da177e4SLinus Torvalds int size) 5141da177e4SLinus Torvalds { 5151da177e4SLinus Torvalds unsigned char tmp[3]; 5161da177e4SLinus Torvalds struct pnp_port *port; 5171da177e4SLinus Torvalds 5181da177e4SLinus Torvalds isapnp_peek(tmp, size); 519cd861280SRobert P. J. Day port = kzalloc(sizeof(struct pnp_port), GFP_KERNEL); 5201da177e4SLinus Torvalds if (!port) 5211da177e4SLinus Torvalds return; 5221da177e4SLinus Torvalds port->min = port->max = (tmp[1] << 8) | tmp[0]; 5231da177e4SLinus Torvalds port->size = tmp[2]; 5241da177e4SLinus Torvalds port->align = 0; 5251da177e4SLinus Torvalds port->flags = PNP_PORT_FLAG_FIXED; 5261da177e4SLinus Torvalds pnp_register_port_resource(option, port); 5271da177e4SLinus Torvalds return; 5281da177e4SLinus Torvalds } 5291da177e4SLinus Torvalds 5301da177e4SLinus Torvalds /* 5311da177e4SLinus Torvalds * Add memory resource to resources list. 5321da177e4SLinus Torvalds */ 5331da177e4SLinus Torvalds 5341da177e4SLinus Torvalds static void __init isapnp_parse_mem_resource(struct pnp_option *option, 5351da177e4SLinus Torvalds int size) 5361da177e4SLinus Torvalds { 5371da177e4SLinus Torvalds unsigned char tmp[9]; 5381da177e4SLinus Torvalds struct pnp_mem *mem; 5391da177e4SLinus Torvalds 5401da177e4SLinus Torvalds isapnp_peek(tmp, size); 541cd861280SRobert P. J. Day mem = kzalloc(sizeof(struct pnp_mem), GFP_KERNEL); 5421da177e4SLinus Torvalds if (!mem) 5431da177e4SLinus Torvalds return; 5441da177e4SLinus Torvalds mem->min = ((tmp[2] << 8) | tmp[1]) << 8; 5451da177e4SLinus Torvalds mem->max = ((tmp[4] << 8) | tmp[3]) << 8; 5461da177e4SLinus Torvalds mem->align = (tmp[6] << 8) | tmp[5]; 5471da177e4SLinus Torvalds mem->size = ((tmp[8] << 8) | tmp[7]) << 8; 5481da177e4SLinus Torvalds mem->flags = tmp[0]; 5491da177e4SLinus Torvalds pnp_register_mem_resource(option, mem); 5501da177e4SLinus Torvalds return; 5511da177e4SLinus Torvalds } 5521da177e4SLinus Torvalds 5531da177e4SLinus Torvalds /* 5541da177e4SLinus Torvalds * Add 32-bit memory resource to resources list. 5551da177e4SLinus Torvalds */ 5561da177e4SLinus Torvalds 5571da177e4SLinus Torvalds static void __init isapnp_parse_mem32_resource(struct pnp_option *option, 5581da177e4SLinus Torvalds int size) 5591da177e4SLinus Torvalds { 5601da177e4SLinus Torvalds unsigned char tmp[17]; 5611da177e4SLinus Torvalds struct pnp_mem *mem; 5621da177e4SLinus Torvalds 5631da177e4SLinus Torvalds isapnp_peek(tmp, size); 564cd861280SRobert P. J. Day mem = kzalloc(sizeof(struct pnp_mem), GFP_KERNEL); 5651da177e4SLinus Torvalds if (!mem) 5661da177e4SLinus Torvalds return; 5671da177e4SLinus Torvalds mem->min = (tmp[4] << 24) | (tmp[3] << 16) | (tmp[2] << 8) | tmp[1]; 5681da177e4SLinus Torvalds mem->max = (tmp[8] << 24) | (tmp[7] << 16) | (tmp[6] << 8) | tmp[5]; 5699dd78466SBjorn Helgaas mem->align = 5709dd78466SBjorn Helgaas (tmp[12] << 24) | (tmp[11] << 16) | (tmp[10] << 8) | tmp[9]; 5719dd78466SBjorn Helgaas mem->size = 5729dd78466SBjorn Helgaas (tmp[16] << 24) | (tmp[15] << 16) | (tmp[14] << 8) | tmp[13]; 5731da177e4SLinus Torvalds mem->flags = tmp[0]; 5741da177e4SLinus Torvalds pnp_register_mem_resource(option, mem); 5751da177e4SLinus Torvalds } 5761da177e4SLinus Torvalds 5771da177e4SLinus Torvalds /* 5781da177e4SLinus Torvalds * Add 32-bit fixed memory resource to resources list. 5791da177e4SLinus Torvalds */ 5801da177e4SLinus Torvalds 5811da177e4SLinus Torvalds static void __init isapnp_parse_fixed_mem32_resource(struct pnp_option *option, 5821da177e4SLinus Torvalds int size) 5831da177e4SLinus Torvalds { 5841da177e4SLinus Torvalds unsigned char tmp[9]; 5851da177e4SLinus Torvalds struct pnp_mem *mem; 5861da177e4SLinus Torvalds 5871da177e4SLinus Torvalds isapnp_peek(tmp, size); 588cd861280SRobert P. J. Day mem = kzalloc(sizeof(struct pnp_mem), GFP_KERNEL); 5891da177e4SLinus Torvalds if (!mem) 5901da177e4SLinus Torvalds return; 5919dd78466SBjorn Helgaas mem->min = mem->max = 5929dd78466SBjorn Helgaas (tmp[4] << 24) | (tmp[3] << 16) | (tmp[2] << 8) | tmp[1]; 5931da177e4SLinus Torvalds mem->size = (tmp[8] << 24) | (tmp[7] << 16) | (tmp[6] << 8) | tmp[5]; 5941da177e4SLinus Torvalds mem->align = 0; 5951da177e4SLinus Torvalds mem->flags = tmp[0]; 5961da177e4SLinus Torvalds pnp_register_mem_resource(option, mem); 5971da177e4SLinus Torvalds } 5981da177e4SLinus Torvalds 5991da177e4SLinus Torvalds /* 6001da177e4SLinus Torvalds * Parse card name for ISA PnP device. 6011da177e4SLinus Torvalds */ 6021da177e4SLinus Torvalds 6031da177e4SLinus Torvalds static void __init 6041da177e4SLinus Torvalds isapnp_parse_name(char *name, unsigned int name_max, unsigned short *size) 6051da177e4SLinus Torvalds { 6061da177e4SLinus Torvalds if (name[0] == '\0') { 6079dd78466SBjorn Helgaas unsigned short size1 = 6089dd78466SBjorn Helgaas *size >= name_max ? (name_max - 1) : *size; 6091da177e4SLinus Torvalds isapnp_peek(name, size1); 6101da177e4SLinus Torvalds name[size1] = '\0'; 6111da177e4SLinus Torvalds *size -= size1; 6121da177e4SLinus Torvalds 6131da177e4SLinus Torvalds /* clean whitespace from end of string */ 6141da177e4SLinus Torvalds while (size1 > 0 && name[--size1] == ' ') 6151da177e4SLinus Torvalds name[size1] = '\0'; 6161da177e4SLinus Torvalds } 6171da177e4SLinus Torvalds } 6181da177e4SLinus Torvalds 6191da177e4SLinus Torvalds /* 6201da177e4SLinus Torvalds * Parse resource map for logical device. 6211da177e4SLinus Torvalds */ 6221da177e4SLinus Torvalds 6231da177e4SLinus Torvalds static int __init isapnp_create_device(struct pnp_card *card, 6241da177e4SLinus Torvalds unsigned short size) 6251da177e4SLinus Torvalds { 6261da177e4SLinus Torvalds int number = 0, skip = 0, priority = 0, compat = 0; 6271da177e4SLinus Torvalds unsigned char type, tmp[17]; 6281da177e4SLinus Torvalds struct pnp_option *option; 6291da177e4SLinus Torvalds struct pnp_dev *dev; 6301da177e4SLinus Torvalds if ((dev = isapnp_parse_device(card, size, number++)) == NULL) 6311da177e4SLinus Torvalds return 1; 6321da177e4SLinus Torvalds option = pnp_register_independent_option(dev); 6331da177e4SLinus Torvalds if (!option) { 6341da177e4SLinus Torvalds kfree(dev); 6351da177e4SLinus Torvalds return 1; 6361da177e4SLinus Torvalds } 6371da177e4SLinus Torvalds pnp_add_card_device(card, dev); 6381da177e4SLinus Torvalds 6391da177e4SLinus Torvalds while (1) { 6401da177e4SLinus Torvalds if (isapnp_read_tag(&type, &size) < 0) 6411da177e4SLinus Torvalds return 1; 6421da177e4SLinus Torvalds if (skip && type != _STAG_LOGDEVID && type != _STAG_END) 6431da177e4SLinus Torvalds goto __skip; 6441da177e4SLinus Torvalds switch (type) { 6451da177e4SLinus Torvalds case _STAG_LOGDEVID: 6461da177e4SLinus Torvalds if (size >= 5 && size <= 6) { 6479dd78466SBjorn Helgaas if ((dev = 6489dd78466SBjorn Helgaas isapnp_parse_device(card, size, 6499dd78466SBjorn Helgaas number++)) == NULL) 6501da177e4SLinus Torvalds return 1; 6511da177e4SLinus Torvalds size = 0; 6521da177e4SLinus Torvalds skip = 0; 6531da177e4SLinus Torvalds option = pnp_register_independent_option(dev); 654656bde57SJesper Juhl if (!option) { 655656bde57SJesper Juhl kfree(dev); 6561da177e4SLinus Torvalds return 1; 657656bde57SJesper Juhl } 6581da177e4SLinus Torvalds pnp_add_card_device(card, dev); 6591da177e4SLinus Torvalds } else { 6601da177e4SLinus Torvalds skip = 1; 6611da177e4SLinus Torvalds } 6621da177e4SLinus Torvalds priority = 0; 6631da177e4SLinus Torvalds compat = 0; 6641da177e4SLinus Torvalds break; 6651da177e4SLinus Torvalds case _STAG_COMPATDEVID: 6661da177e4SLinus Torvalds if (size == 4 && compat < DEVICE_COUNT_COMPATIBLE) { 6671da177e4SLinus Torvalds isapnp_peek(tmp, 4); 6689dd78466SBjorn Helgaas isapnp_parse_id(dev, (tmp[1] << 8) | tmp[0], 6699dd78466SBjorn Helgaas (tmp[3] << 8) | tmp[2]); 6701da177e4SLinus Torvalds compat++; 6711da177e4SLinus Torvalds size = 0; 6721da177e4SLinus Torvalds } 6731da177e4SLinus Torvalds break; 6741da177e4SLinus Torvalds case _STAG_IRQ: 6751da177e4SLinus Torvalds if (size < 2 || size > 3) 6761da177e4SLinus Torvalds goto __skip; 6771da177e4SLinus Torvalds isapnp_parse_irq_resource(option, size); 6781da177e4SLinus Torvalds size = 0; 6791da177e4SLinus Torvalds break; 6801da177e4SLinus Torvalds case _STAG_DMA: 6811da177e4SLinus Torvalds if (size != 2) 6821da177e4SLinus Torvalds goto __skip; 6831da177e4SLinus Torvalds isapnp_parse_dma_resource(option, size); 6841da177e4SLinus Torvalds size = 0; 6851da177e4SLinus Torvalds break; 6861da177e4SLinus Torvalds case _STAG_STARTDEP: 6871da177e4SLinus Torvalds if (size > 1) 6881da177e4SLinus Torvalds goto __skip; 6891da177e4SLinus Torvalds priority = 0x100 | PNP_RES_PRIORITY_ACCEPTABLE; 6901da177e4SLinus Torvalds if (size > 0) { 6911da177e4SLinus Torvalds isapnp_peek(tmp, size); 6921da177e4SLinus Torvalds priority = 0x100 | tmp[0]; 6931da177e4SLinus Torvalds size = 0; 6941da177e4SLinus Torvalds } 6951da177e4SLinus Torvalds option = pnp_register_dependent_option(dev, priority); 6961da177e4SLinus Torvalds if (!option) 6971da177e4SLinus Torvalds return 1; 6981da177e4SLinus Torvalds break; 6991da177e4SLinus Torvalds case _STAG_ENDDEP: 7001da177e4SLinus Torvalds if (size != 0) 7011da177e4SLinus Torvalds goto __skip; 7021da177e4SLinus Torvalds priority = 0; 7031da177e4SLinus Torvalds break; 7041da177e4SLinus Torvalds case _STAG_IOPORT: 7051da177e4SLinus Torvalds if (size != 7) 7061da177e4SLinus Torvalds goto __skip; 7071da177e4SLinus Torvalds isapnp_parse_port_resource(option, size); 7081da177e4SLinus Torvalds size = 0; 7091da177e4SLinus Torvalds break; 7101da177e4SLinus Torvalds case _STAG_FIXEDIO: 7111da177e4SLinus Torvalds if (size != 3) 7121da177e4SLinus Torvalds goto __skip; 7131da177e4SLinus Torvalds isapnp_parse_fixed_port_resource(option, size); 7141da177e4SLinus Torvalds size = 0; 7151da177e4SLinus Torvalds break; 7161da177e4SLinus Torvalds case _STAG_VENDOR: 7171da177e4SLinus Torvalds break; 7181da177e4SLinus Torvalds case _LTAG_MEMRANGE: 7191da177e4SLinus Torvalds if (size != 9) 7201da177e4SLinus Torvalds goto __skip; 7211da177e4SLinus Torvalds isapnp_parse_mem_resource(option, size); 7221da177e4SLinus Torvalds size = 0; 7231da177e4SLinus Torvalds break; 7241da177e4SLinus Torvalds case _LTAG_ANSISTR: 7251da177e4SLinus Torvalds isapnp_parse_name(dev->name, sizeof(dev->name), &size); 7261da177e4SLinus Torvalds break; 7271da177e4SLinus Torvalds case _LTAG_UNICODESTR: 7281da177e4SLinus Torvalds /* silently ignore */ 7291da177e4SLinus Torvalds /* who use unicode for hardware identification? */ 7301da177e4SLinus Torvalds break; 7311da177e4SLinus Torvalds case _LTAG_VENDOR: 7321da177e4SLinus Torvalds break; 7331da177e4SLinus Torvalds case _LTAG_MEM32RANGE: 7341da177e4SLinus Torvalds if (size != 17) 7351da177e4SLinus Torvalds goto __skip; 7361da177e4SLinus Torvalds isapnp_parse_mem32_resource(option, size); 7371da177e4SLinus Torvalds size = 0; 7381da177e4SLinus Torvalds break; 7391da177e4SLinus Torvalds case _LTAG_FIXEDMEM32RANGE: 7401da177e4SLinus Torvalds if (size != 9) 7411da177e4SLinus Torvalds goto __skip; 7421da177e4SLinus Torvalds isapnp_parse_fixed_mem32_resource(option, size); 7431da177e4SLinus Torvalds size = 0; 7441da177e4SLinus Torvalds break; 7451da177e4SLinus Torvalds case _STAG_END: 7461da177e4SLinus Torvalds if (size > 0) 7471da177e4SLinus Torvalds isapnp_skip_bytes(size); 7481da177e4SLinus Torvalds return 1; 7491da177e4SLinus Torvalds default: 7509dd78466SBjorn Helgaas printk(KERN_ERR 7519dd78466SBjorn Helgaas "isapnp: unexpected or unknown tag type 0x%x for logical device %i (device %i), ignored\n", 7529dd78466SBjorn Helgaas type, dev->number, card->number); 7531da177e4SLinus Torvalds } 7541da177e4SLinus Torvalds __skip: 7551da177e4SLinus Torvalds if (size > 0) 7561da177e4SLinus Torvalds isapnp_skip_bytes(size); 7571da177e4SLinus Torvalds } 7581da177e4SLinus Torvalds return 0; 7591da177e4SLinus Torvalds } 7601da177e4SLinus Torvalds 7611da177e4SLinus Torvalds /* 7621da177e4SLinus Torvalds * Parse resource map for ISA PnP card. 7631da177e4SLinus Torvalds */ 7641da177e4SLinus Torvalds 7651da177e4SLinus Torvalds static void __init isapnp_parse_resource_map(struct pnp_card *card) 7661da177e4SLinus Torvalds { 7671da177e4SLinus Torvalds unsigned char type, tmp[17]; 7681da177e4SLinus Torvalds unsigned short size; 7691da177e4SLinus Torvalds 7701da177e4SLinus Torvalds while (1) { 7711da177e4SLinus Torvalds if (isapnp_read_tag(&type, &size) < 0) 7721da177e4SLinus Torvalds return; 7731da177e4SLinus Torvalds switch (type) { 7741da177e4SLinus Torvalds case _STAG_PNPVERNO: 7751da177e4SLinus Torvalds if (size != 2) 7761da177e4SLinus Torvalds goto __skip; 7771da177e4SLinus Torvalds isapnp_peek(tmp, 2); 7781da177e4SLinus Torvalds card->pnpver = tmp[0]; 7791da177e4SLinus Torvalds card->productver = tmp[1]; 7801da177e4SLinus Torvalds size = 0; 7811da177e4SLinus Torvalds break; 7821da177e4SLinus Torvalds case _STAG_LOGDEVID: 7831da177e4SLinus Torvalds if (size >= 5 && size <= 6) { 7841da177e4SLinus Torvalds if (isapnp_create_device(card, size) == 1) 7851da177e4SLinus Torvalds return; 7861da177e4SLinus Torvalds size = 0; 7871da177e4SLinus Torvalds } 7881da177e4SLinus Torvalds break; 7891da177e4SLinus Torvalds case _STAG_VENDOR: 7901da177e4SLinus Torvalds break; 7911da177e4SLinus Torvalds case _LTAG_ANSISTR: 7929dd78466SBjorn Helgaas isapnp_parse_name(card->name, sizeof(card->name), 7939dd78466SBjorn Helgaas &size); 7941da177e4SLinus Torvalds break; 7951da177e4SLinus Torvalds case _LTAG_UNICODESTR: 7961da177e4SLinus Torvalds /* silently ignore */ 7971da177e4SLinus Torvalds /* who use unicode for hardware identification? */ 7981da177e4SLinus Torvalds break; 7991da177e4SLinus Torvalds case _LTAG_VENDOR: 8001da177e4SLinus Torvalds break; 8011da177e4SLinus Torvalds case _STAG_END: 8021da177e4SLinus Torvalds if (size > 0) 8031da177e4SLinus Torvalds isapnp_skip_bytes(size); 8041da177e4SLinus Torvalds return; 8051da177e4SLinus Torvalds default: 8069dd78466SBjorn Helgaas printk(KERN_ERR 8079dd78466SBjorn Helgaas "isapnp: unexpected or unknown tag type 0x%x for device %i, ignored\n", 8089dd78466SBjorn Helgaas type, card->number); 8091da177e4SLinus Torvalds } 8101da177e4SLinus Torvalds __skip: 8111da177e4SLinus Torvalds if (size > 0) 8121da177e4SLinus Torvalds isapnp_skip_bytes(size); 8131da177e4SLinus Torvalds } 8141da177e4SLinus Torvalds } 8151da177e4SLinus Torvalds 8161da177e4SLinus Torvalds /* 8171da177e4SLinus Torvalds * Compute ISA PnP checksum for first eight bytes. 8181da177e4SLinus Torvalds */ 8191da177e4SLinus Torvalds 8201da177e4SLinus Torvalds static unsigned char __init isapnp_checksum(unsigned char *data) 8211da177e4SLinus Torvalds { 8221da177e4SLinus Torvalds int i, j; 8231da177e4SLinus Torvalds unsigned char checksum = 0x6a, bit, b; 8241da177e4SLinus Torvalds 8251da177e4SLinus Torvalds for (i = 0; i < 8; i++) { 8261da177e4SLinus Torvalds b = data[i]; 8271da177e4SLinus Torvalds for (j = 0; j < 8; j++) { 8281da177e4SLinus Torvalds bit = 0; 8291da177e4SLinus Torvalds if (b & (1 << j)) 8301da177e4SLinus Torvalds bit = 1; 8319dd78466SBjorn Helgaas checksum = 8329dd78466SBjorn Helgaas ((((checksum ^ (checksum >> 1)) & 0x01) ^ bit) << 7) 8339dd78466SBjorn Helgaas | (checksum >> 1); 8341da177e4SLinus Torvalds } 8351da177e4SLinus Torvalds } 8361da177e4SLinus Torvalds return checksum; 8371da177e4SLinus Torvalds } 8381da177e4SLinus Torvalds 8391da177e4SLinus Torvalds /* 8401da177e4SLinus Torvalds * Parse EISA id for ISA PnP card. 8411da177e4SLinus Torvalds */ 8421da177e4SLinus Torvalds 8439dd78466SBjorn Helgaas static void isapnp_parse_card_id(struct pnp_card *card, unsigned short vendor, 8449dd78466SBjorn Helgaas unsigned short device) 8451da177e4SLinus Torvalds { 846cd861280SRobert P. J. Day struct pnp_id *id = kzalloc(sizeof(struct pnp_id), GFP_KERNEL); 8471da177e4SLinus Torvalds if (!id) 8481da177e4SLinus Torvalds return; 8491da177e4SLinus Torvalds sprintf(id->id, "%c%c%c%x%x%x%x", 8501da177e4SLinus Torvalds 'A' + ((vendor >> 2) & 0x3f) - 1, 8511da177e4SLinus Torvalds 'A' + (((vendor & 3) << 3) | ((vendor >> 13) & 7)) - 1, 8521da177e4SLinus Torvalds 'A' + ((vendor >> 8) & 0x1f) - 1, 8531da177e4SLinus Torvalds (device >> 4) & 0x0f, 8549dd78466SBjorn Helgaas device & 0x0f, (device >> 12) & 0x0f, (device >> 8) & 0x0f); 8551da177e4SLinus Torvalds pnp_add_card_id(id, card); 8561da177e4SLinus Torvalds } 8571da177e4SLinus Torvalds 8581da177e4SLinus Torvalds /* 8591da177e4SLinus Torvalds * Build device list for all present ISA PnP devices. 8601da177e4SLinus Torvalds */ 8611da177e4SLinus Torvalds 8621da177e4SLinus Torvalds static int __init isapnp_build_device_list(void) 8631da177e4SLinus Torvalds { 8641da177e4SLinus Torvalds int csn; 8651da177e4SLinus Torvalds unsigned char header[9], checksum; 8661da177e4SLinus Torvalds struct pnp_card *card; 8671da177e4SLinus Torvalds 8681da177e4SLinus Torvalds isapnp_wait(); 8691da177e4SLinus Torvalds isapnp_key(); 8701da177e4SLinus Torvalds for (csn = 1; csn <= isapnp_csn_count; csn++) { 8711da177e4SLinus Torvalds isapnp_wake(csn); 8721da177e4SLinus Torvalds isapnp_peek(header, 9); 8731da177e4SLinus Torvalds checksum = isapnp_checksum(header); 8741da177e4SLinus Torvalds #if 0 8759dd78466SBjorn Helgaas printk(KERN_DEBUG 8769dd78466SBjorn Helgaas "vendor: %02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x\n", 8779dd78466SBjorn Helgaas header[0], header[1], header[2], header[3], header[4], 8789dd78466SBjorn Helgaas header[5], header[6], header[7], header[8]); 8791da177e4SLinus Torvalds printk(KERN_DEBUG "checksum = 0x%x\n", checksum); 8801da177e4SLinus Torvalds #endif 8819dd78466SBjorn Helgaas if ((card = 8829dd78466SBjorn Helgaas kzalloc(sizeof(struct pnp_card), GFP_KERNEL)) == NULL) 8831da177e4SLinus Torvalds continue; 8841da177e4SLinus Torvalds 8851da177e4SLinus Torvalds card->number = csn; 8861da177e4SLinus Torvalds INIT_LIST_HEAD(&card->devices); 8879dd78466SBjorn Helgaas isapnp_parse_card_id(card, (header[1] << 8) | header[0], 8889dd78466SBjorn Helgaas (header[3] << 8) | header[2]); 8899dd78466SBjorn Helgaas card->serial = 8909dd78466SBjorn Helgaas (header[7] << 24) | (header[6] << 16) | (header[5] << 8) | 8919dd78466SBjorn Helgaas header[4]; 8921da177e4SLinus Torvalds isapnp_checksum_value = 0x00; 8931da177e4SLinus Torvalds isapnp_parse_resource_map(card); 8941da177e4SLinus Torvalds if (isapnp_checksum_value != 0x00) 8959dd78466SBjorn Helgaas printk(KERN_ERR 8969dd78466SBjorn Helgaas "isapnp: checksum for device %i is not valid (0x%x)\n", 8979dd78466SBjorn Helgaas csn, isapnp_checksum_value); 8981da177e4SLinus Torvalds card->checksum = isapnp_checksum_value; 8991da177e4SLinus Torvalds card->protocol = &isapnp_protocol; 9001da177e4SLinus Torvalds 9011da177e4SLinus Torvalds pnp_add_card(card); 9021da177e4SLinus Torvalds } 9031da177e4SLinus Torvalds isapnp_wait(); 9041da177e4SLinus Torvalds return 0; 9051da177e4SLinus Torvalds } 9061da177e4SLinus Torvalds 9071da177e4SLinus Torvalds /* 9081da177e4SLinus Torvalds * Basic configuration routines. 9091da177e4SLinus Torvalds */ 9101da177e4SLinus Torvalds 9111da177e4SLinus Torvalds int isapnp_present(void) 9121da177e4SLinus Torvalds { 9131da177e4SLinus Torvalds struct pnp_card *card; 9141da177e4SLinus Torvalds pnp_for_each_card(card) { 9151da177e4SLinus Torvalds if (card->protocol == &isapnp_protocol) 9161da177e4SLinus Torvalds return 1; 9171da177e4SLinus Torvalds } 9181da177e4SLinus Torvalds return 0; 9191da177e4SLinus Torvalds } 9201da177e4SLinus Torvalds 9211da177e4SLinus Torvalds int isapnp_cfg_begin(int csn, int logdev) 9221da177e4SLinus Torvalds { 9231da177e4SLinus Torvalds if (csn < 1 || csn > isapnp_csn_count || logdev > 10) 9241da177e4SLinus Torvalds return -EINVAL; 92514cc3e2bSIngo Molnar mutex_lock(&isapnp_cfg_mutex); 9261da177e4SLinus Torvalds isapnp_wait(); 9271da177e4SLinus Torvalds isapnp_key(); 9281da177e4SLinus Torvalds isapnp_wake(csn); 9291da177e4SLinus Torvalds #if 0 9301da177e4SLinus Torvalds /* to avoid malfunction when the isapnptools package is used */ 9311da177e4SLinus Torvalds /* we must set RDP to our value again */ 9321da177e4SLinus Torvalds /* it is possible to set RDP only in the isolation phase */ 9331da177e4SLinus Torvalds /* Jens Thoms Toerring <Jens.Toerring@physik.fu-berlin.de> */ 9341da177e4SLinus Torvalds isapnp_write_byte(0x02, 0x04); /* clear CSN of card */ 9351da177e4SLinus Torvalds mdelay(2); /* is this necessary? */ 9361da177e4SLinus Torvalds isapnp_wake(csn); /* bring card into sleep state */ 9371da177e4SLinus Torvalds isapnp_wake(0); /* bring card into isolation state */ 9381da177e4SLinus Torvalds isapnp_set_rdp(); /* reset the RDP port */ 9391da177e4SLinus Torvalds udelay(1000); /* delay 1000us */ 9401da177e4SLinus Torvalds isapnp_write_byte(0x06, csn); /* reset CSN to previous value */ 9411da177e4SLinus Torvalds udelay(250); /* is this necessary? */ 9421da177e4SLinus Torvalds #endif 9431da177e4SLinus Torvalds if (logdev >= 0) 9441da177e4SLinus Torvalds isapnp_device(logdev); 9451da177e4SLinus Torvalds return 0; 9461da177e4SLinus Torvalds } 9471da177e4SLinus Torvalds 9481da177e4SLinus Torvalds int isapnp_cfg_end(void) 9491da177e4SLinus Torvalds { 9501da177e4SLinus Torvalds isapnp_wait(); 95114cc3e2bSIngo Molnar mutex_unlock(&isapnp_cfg_mutex); 9521da177e4SLinus Torvalds return 0; 9531da177e4SLinus Torvalds } 9541da177e4SLinus Torvalds 9551da177e4SLinus Torvalds /* 9561da177e4SLinus Torvalds * Inititialization. 9571da177e4SLinus Torvalds */ 9581da177e4SLinus Torvalds 9591da177e4SLinus Torvalds EXPORT_SYMBOL(isapnp_protocol); 9601da177e4SLinus Torvalds EXPORT_SYMBOL(isapnp_present); 9611da177e4SLinus Torvalds EXPORT_SYMBOL(isapnp_cfg_begin); 9621da177e4SLinus Torvalds EXPORT_SYMBOL(isapnp_cfg_end); 963b449f63cSAdrian Bunk #if 0 9641da177e4SLinus Torvalds EXPORT_SYMBOL(isapnp_read_byte); 965b449f63cSAdrian Bunk #endif 9661da177e4SLinus Torvalds EXPORT_SYMBOL(isapnp_write_byte); 9671da177e4SLinus Torvalds 9689dd78466SBjorn Helgaas static int isapnp_read_resources(struct pnp_dev *dev, 9699dd78466SBjorn Helgaas struct pnp_resource_table *res) 9701da177e4SLinus Torvalds { 9711da177e4SLinus Torvalds int tmp, ret; 9721da177e4SLinus Torvalds 9731da177e4SLinus Torvalds dev->active = isapnp_read_byte(ISAPNP_CFG_ACTIVATE); 9741da177e4SLinus Torvalds if (dev->active) { 9751da177e4SLinus Torvalds for (tmp = 0; tmp < PNP_MAX_PORT; tmp++) { 9761da177e4SLinus Torvalds ret = isapnp_read_word(ISAPNP_CFG_PORT + (tmp << 1)); 9771da177e4SLinus Torvalds if (!ret) 9781da177e4SLinus Torvalds continue; 9791da177e4SLinus Torvalds res->port_resource[tmp].start = ret; 9801da177e4SLinus Torvalds res->port_resource[tmp].flags = IORESOURCE_IO; 9811da177e4SLinus Torvalds } 9821da177e4SLinus Torvalds for (tmp = 0; tmp < PNP_MAX_MEM; tmp++) { 9839dd78466SBjorn Helgaas ret = 9849dd78466SBjorn Helgaas isapnp_read_word(ISAPNP_CFG_MEM + (tmp << 3)) << 8; 9851da177e4SLinus Torvalds if (!ret) 9861da177e4SLinus Torvalds continue; 9871da177e4SLinus Torvalds res->mem_resource[tmp].start = ret; 9881da177e4SLinus Torvalds res->mem_resource[tmp].flags = IORESOURCE_MEM; 9891da177e4SLinus Torvalds } 9901da177e4SLinus Torvalds for (tmp = 0; tmp < PNP_MAX_IRQ; tmp++) { 9919dd78466SBjorn Helgaas ret = 9929dd78466SBjorn Helgaas (isapnp_read_word(ISAPNP_CFG_IRQ + (tmp << 1)) >> 9939dd78466SBjorn Helgaas 8); 9941da177e4SLinus Torvalds if (!ret) 9951da177e4SLinus Torvalds continue; 9969dd78466SBjorn Helgaas res->irq_resource[tmp].start = 9979dd78466SBjorn Helgaas res->irq_resource[tmp].end = ret; 9981da177e4SLinus Torvalds res->irq_resource[tmp].flags = IORESOURCE_IRQ; 9991da177e4SLinus Torvalds } 10001da177e4SLinus Torvalds for (tmp = 0; tmp < PNP_MAX_DMA; tmp++) { 10011da177e4SLinus Torvalds ret = isapnp_read_byte(ISAPNP_CFG_DMA + tmp); 10021da177e4SLinus Torvalds if (ret == 4) 10031da177e4SLinus Torvalds continue; 10049dd78466SBjorn Helgaas res->dma_resource[tmp].start = 10059dd78466SBjorn Helgaas res->dma_resource[tmp].end = ret; 10061da177e4SLinus Torvalds res->dma_resource[tmp].flags = IORESOURCE_DMA; 10071da177e4SLinus Torvalds } 10081da177e4SLinus Torvalds } 10091da177e4SLinus Torvalds return 0; 10101da177e4SLinus Torvalds } 10111da177e4SLinus Torvalds 10129dd78466SBjorn Helgaas static int isapnp_get_resources(struct pnp_dev *dev, 10139dd78466SBjorn Helgaas struct pnp_resource_table *res) 10141da177e4SLinus Torvalds { 10151da177e4SLinus Torvalds int ret; 10161da177e4SLinus Torvalds pnp_init_resource_table(res); 10171da177e4SLinus Torvalds isapnp_cfg_begin(dev->card->number, dev->number); 10181da177e4SLinus Torvalds ret = isapnp_read_resources(dev, res); 10191da177e4SLinus Torvalds isapnp_cfg_end(); 10201da177e4SLinus Torvalds return ret; 10211da177e4SLinus Torvalds } 10221da177e4SLinus Torvalds 10239dd78466SBjorn Helgaas static int isapnp_set_resources(struct pnp_dev *dev, 10249dd78466SBjorn Helgaas struct pnp_resource_table *res) 10251da177e4SLinus Torvalds { 10261da177e4SLinus Torvalds int tmp; 10271da177e4SLinus Torvalds 10281da177e4SLinus Torvalds isapnp_cfg_begin(dev->card->number, dev->number); 10291da177e4SLinus Torvalds dev->active = 1; 10309dd78466SBjorn Helgaas for (tmp = 0; 10319dd78466SBjorn Helgaas tmp < PNP_MAX_PORT 10329dd78466SBjorn Helgaas && (res->port_resource[tmp]. 10339dd78466SBjorn Helgaas flags & (IORESOURCE_IO | IORESOURCE_UNSET)) == IORESOURCE_IO; 10349dd78466SBjorn Helgaas tmp++) 10359dd78466SBjorn Helgaas isapnp_write_word(ISAPNP_CFG_PORT + (tmp << 1), 10369dd78466SBjorn Helgaas res->port_resource[tmp].start); 10379dd78466SBjorn Helgaas for (tmp = 0; 10389dd78466SBjorn Helgaas tmp < PNP_MAX_IRQ 10399dd78466SBjorn Helgaas && (res->irq_resource[tmp]. 10409dd78466SBjorn Helgaas flags & (IORESOURCE_IRQ | IORESOURCE_UNSET)) == IORESOURCE_IRQ; 10419dd78466SBjorn Helgaas tmp++) { 10421da177e4SLinus Torvalds int irq = res->irq_resource[tmp].start; 10431da177e4SLinus Torvalds if (irq == 2) 10441da177e4SLinus Torvalds irq = 9; 10451da177e4SLinus Torvalds isapnp_write_byte(ISAPNP_CFG_IRQ + (tmp << 1), irq); 10461da177e4SLinus Torvalds } 10479dd78466SBjorn Helgaas for (tmp = 0; 10489dd78466SBjorn Helgaas tmp < PNP_MAX_DMA 10499dd78466SBjorn Helgaas && (res->dma_resource[tmp]. 10509dd78466SBjorn Helgaas flags & (IORESOURCE_DMA | IORESOURCE_UNSET)) == IORESOURCE_DMA; 10519dd78466SBjorn Helgaas tmp++) 10529dd78466SBjorn Helgaas isapnp_write_byte(ISAPNP_CFG_DMA + tmp, 10539dd78466SBjorn Helgaas res->dma_resource[tmp].start); 10549dd78466SBjorn Helgaas for (tmp = 0; 10559dd78466SBjorn Helgaas tmp < PNP_MAX_MEM 10569dd78466SBjorn Helgaas && (res->mem_resource[tmp]. 10579dd78466SBjorn Helgaas flags & (IORESOURCE_MEM | IORESOURCE_UNSET)) == IORESOURCE_MEM; 10589dd78466SBjorn Helgaas tmp++) 10599dd78466SBjorn Helgaas isapnp_write_word(ISAPNP_CFG_MEM + (tmp << 3), 10609dd78466SBjorn Helgaas (res->mem_resource[tmp].start >> 8) & 0xffff); 10611da177e4SLinus Torvalds /* FIXME: We aren't handling 32bit mems properly here */ 10621da177e4SLinus Torvalds isapnp_activate(dev->number); 10631da177e4SLinus Torvalds isapnp_cfg_end(); 10641da177e4SLinus Torvalds return 0; 10651da177e4SLinus Torvalds } 10661da177e4SLinus Torvalds 10671da177e4SLinus Torvalds static int isapnp_disable_resources(struct pnp_dev *dev) 10681da177e4SLinus Torvalds { 10691da177e4SLinus Torvalds if (!dev || !dev->active) 10701da177e4SLinus Torvalds return -EINVAL; 10711da177e4SLinus Torvalds isapnp_cfg_begin(dev->card->number, dev->number); 10721da177e4SLinus Torvalds isapnp_deactivate(dev->number); 10731da177e4SLinus Torvalds dev->active = 0; 10741da177e4SLinus Torvalds isapnp_cfg_end(); 10751da177e4SLinus Torvalds return 0; 10761da177e4SLinus Torvalds } 10771da177e4SLinus Torvalds 10781da177e4SLinus Torvalds struct pnp_protocol isapnp_protocol = { 10791da177e4SLinus Torvalds .name = "ISA Plug and Play", 10801da177e4SLinus Torvalds .get = isapnp_get_resources, 10811da177e4SLinus Torvalds .set = isapnp_set_resources, 10821da177e4SLinus Torvalds .disable = isapnp_disable_resources, 10831da177e4SLinus Torvalds }; 10841da177e4SLinus Torvalds 10851da177e4SLinus Torvalds static int __init isapnp_init(void) 10861da177e4SLinus Torvalds { 10871da177e4SLinus Torvalds int cards; 10881da177e4SLinus Torvalds struct pnp_card *card; 10891da177e4SLinus Torvalds struct pnp_dev *dev; 10901da177e4SLinus Torvalds 10911da177e4SLinus Torvalds if (isapnp_disable) { 10921da177e4SLinus Torvalds isapnp_detected = 0; 10931da177e4SLinus Torvalds printk(KERN_INFO "isapnp: ISA Plug & Play support disabled\n"); 10941da177e4SLinus Torvalds return 0; 10951da177e4SLinus Torvalds } 109607bd1c4aSDavid Woodhouse #ifdef CONFIG_PPC_MERGE 109707bd1c4aSDavid Woodhouse if (check_legacy_ioport(_PIDXR) || check_legacy_ioport(_PNPWRP)) 109807bd1c4aSDavid Woodhouse return -EINVAL; 109907bd1c4aSDavid Woodhouse #endif 11001da177e4SLinus Torvalds #ifdef ISAPNP_REGION_OK 11011da177e4SLinus Torvalds if (!request_region(_PIDXR, 1, "isapnp index")) { 11029dd78466SBjorn Helgaas printk(KERN_ERR "isapnp: Index Register 0x%x already used\n", 11039dd78466SBjorn Helgaas _PIDXR); 11041da177e4SLinus Torvalds return -EBUSY; 11051da177e4SLinus Torvalds } 11061da177e4SLinus Torvalds #endif 11071da177e4SLinus Torvalds if (!request_region(_PNPWRP, 1, "isapnp write")) { 11089dd78466SBjorn Helgaas printk(KERN_ERR 11099dd78466SBjorn Helgaas "isapnp: Write Data Register 0x%x already used\n", 11109dd78466SBjorn Helgaas _PNPWRP); 11111da177e4SLinus Torvalds #ifdef ISAPNP_REGION_OK 11121da177e4SLinus Torvalds release_region(_PIDXR, 1); 11131da177e4SLinus Torvalds #endif 11141da177e4SLinus Torvalds return -EBUSY; 11151da177e4SLinus Torvalds } 11161da177e4SLinus Torvalds 11171da177e4SLinus Torvalds if (pnp_register_protocol(&isapnp_protocol) < 0) 11181da177e4SLinus Torvalds return -EBUSY; 11191da177e4SLinus Torvalds 11201da177e4SLinus Torvalds /* 11211da177e4SLinus Torvalds * Print a message. The existing ISAPnP code is hanging machines 11221da177e4SLinus Torvalds * so let the user know where. 11231da177e4SLinus Torvalds */ 11241da177e4SLinus Torvalds 11251da177e4SLinus Torvalds printk(KERN_INFO "isapnp: Scanning for PnP cards...\n"); 11261da177e4SLinus Torvalds if (isapnp_rdp >= 0x203 && isapnp_rdp <= 0x3ff) { 11271da177e4SLinus Torvalds isapnp_rdp |= 3; 11281da177e4SLinus Torvalds if (!request_region(isapnp_rdp, 1, "isapnp read")) { 11299dd78466SBjorn Helgaas printk(KERN_ERR 11309dd78466SBjorn Helgaas "isapnp: Read Data Register 0x%x already used\n", 11319dd78466SBjorn Helgaas isapnp_rdp); 11321da177e4SLinus Torvalds #ifdef ISAPNP_REGION_OK 11331da177e4SLinus Torvalds release_region(_PIDXR, 1); 11341da177e4SLinus Torvalds #endif 11351da177e4SLinus Torvalds release_region(_PNPWRP, 1); 11361da177e4SLinus Torvalds return -EBUSY; 11371da177e4SLinus Torvalds } 11381da177e4SLinus Torvalds isapnp_set_rdp(); 11391da177e4SLinus Torvalds } 11401da177e4SLinus Torvalds isapnp_detected = 1; 11411da177e4SLinus Torvalds if (isapnp_rdp < 0x203 || isapnp_rdp > 0x3ff) { 11421da177e4SLinus Torvalds cards = isapnp_isolate(); 11439dd78466SBjorn Helgaas if (cards < 0 || (isapnp_rdp < 0x203 || isapnp_rdp > 0x3ff)) { 11441da177e4SLinus Torvalds #ifdef ISAPNP_REGION_OK 11451da177e4SLinus Torvalds release_region(_PIDXR, 1); 11461da177e4SLinus Torvalds #endif 11471da177e4SLinus Torvalds release_region(_PNPWRP, 1); 11481da177e4SLinus Torvalds isapnp_detected = 0; 11499dd78466SBjorn Helgaas printk(KERN_INFO 11509dd78466SBjorn Helgaas "isapnp: No Plug & Play device found\n"); 11511da177e4SLinus Torvalds return 0; 11521da177e4SLinus Torvalds } 11531da177e4SLinus Torvalds request_region(isapnp_rdp, 1, "isapnp read"); 11541da177e4SLinus Torvalds } 11551da177e4SLinus Torvalds isapnp_build_device_list(); 11561da177e4SLinus Torvalds cards = 0; 11571da177e4SLinus Torvalds 11581da177e4SLinus Torvalds protocol_for_each_card(&isapnp_protocol, card) { 11591da177e4SLinus Torvalds cards++; 11601da177e4SLinus Torvalds if (isapnp_verbose) { 11619dd78466SBjorn Helgaas printk(KERN_INFO "isapnp: Card '%s'\n", 11629dd78466SBjorn Helgaas card->name[0] ? card->name : "Unknown"); 11631da177e4SLinus Torvalds if (isapnp_verbose < 2) 11641da177e4SLinus Torvalds continue; 11651da177e4SLinus Torvalds card_for_each_dev(card, dev) { 11669dd78466SBjorn Helgaas printk(KERN_INFO "isapnp: Device '%s'\n", 11679dd78466SBjorn Helgaas dev->name[0] ? dev->name : "Unknown"); 11681da177e4SLinus Torvalds } 11691da177e4SLinus Torvalds } 11701da177e4SLinus Torvalds } 11711da177e4SLinus Torvalds if (cards) { 11729dd78466SBjorn Helgaas printk(KERN_INFO 11739dd78466SBjorn Helgaas "isapnp: %i Plug & Play card%s detected total\n", cards, 11749dd78466SBjorn Helgaas cards > 1 ? "s" : ""); 11751da177e4SLinus Torvalds } else { 11761da177e4SLinus Torvalds printk(KERN_INFO "isapnp: No Plug & Play card found\n"); 11771da177e4SLinus Torvalds } 11781da177e4SLinus Torvalds 11791da177e4SLinus Torvalds isapnp_proc_init(); 11801da177e4SLinus Torvalds return 0; 11811da177e4SLinus Torvalds } 11821da177e4SLinus Torvalds 11831da177e4SLinus Torvalds device_initcall(isapnp_init); 11841da177e4SLinus Torvalds 11851da177e4SLinus Torvalds /* format is: noisapnp */ 11861da177e4SLinus Torvalds 11871da177e4SLinus Torvalds static int __init isapnp_setup_disable(char *str) 11881da177e4SLinus Torvalds { 11891da177e4SLinus Torvalds isapnp_disable = 1; 11901da177e4SLinus Torvalds return 1; 11911da177e4SLinus Torvalds } 11921da177e4SLinus Torvalds 11931da177e4SLinus Torvalds __setup("noisapnp", isapnp_setup_disable); 11941da177e4SLinus Torvalds 11951da177e4SLinus Torvalds /* format is: isapnp=rdp,reset,skip_pci_scan,verbose */ 11961da177e4SLinus Torvalds 11971da177e4SLinus Torvalds static int __init isapnp_setup_isapnp(char *str) 11981da177e4SLinus Torvalds { 11991da177e4SLinus Torvalds (void)((get_option(&str, &isapnp_rdp) == 2) && 12001da177e4SLinus Torvalds (get_option(&str, &isapnp_reset) == 2) && 12011da177e4SLinus Torvalds (get_option(&str, &isapnp_verbose) == 2)); 12021da177e4SLinus Torvalds return 1; 12031da177e4SLinus Torvalds } 12041da177e4SLinus Torvalds 12051da177e4SLinus Torvalds __setup("isapnp=", isapnp_setup_isapnp); 1206