11da177e4SLinus Torvalds /* 21da177e4SLinus Torvalds * ISA Plug & Play support 3c1017a4cSJaroslav Kysela * Copyright (c) by Jaroslav Kysela <perex@perex.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 37e4dca0feSPaul Gortmaker #include <linux/moduleparam.h> 381da177e4SLinus Torvalds #include <linux/kernel.h> 391da177e4SLinus Torvalds #include <linux/errno.h> 401da177e4SLinus Torvalds #include <linux/delay.h> 411da177e4SLinus Torvalds #include <linux/init.h> 421da177e4SLinus Torvalds #include <linux/isapnp.h> 4314cc3e2bSIngo Molnar #include <linux/mutex.h> 441da177e4SLinus Torvalds #include <asm/io.h> 451da177e4SLinus Torvalds 46772defc6SBjorn Helgaas #include "../base.h" 47772defc6SBjorn Helgaas 481da177e4SLinus Torvalds #if 0 491da177e4SLinus Torvalds #define ISAPNP_REGION_OK 501da177e4SLinus Torvalds #endif 511da177e4SLinus Torvalds 521da177e4SLinus Torvalds int isapnp_disable; /* Disable ISA PnP */ 531da177e4SLinus Torvalds static int isapnp_rdp; /* Read Data Port */ 541da177e4SLinus Torvalds static int isapnp_reset = 1; /* reset all PnP cards (deactivate) */ 551da177e4SLinus Torvalds static int isapnp_verbose = 1; /* verbose mode */ 561da177e4SLinus Torvalds 571da177e4SLinus Torvalds module_param(isapnp_disable, int, 0); 581da177e4SLinus Torvalds MODULE_PARM_DESC(isapnp_disable, "ISA Plug & Play disable"); 591da177e4SLinus Torvalds module_param(isapnp_rdp, int, 0); 601da177e4SLinus Torvalds MODULE_PARM_DESC(isapnp_rdp, "ISA Plug & Play read data port"); 611da177e4SLinus Torvalds module_param(isapnp_reset, int, 0); 621da177e4SLinus Torvalds MODULE_PARM_DESC(isapnp_reset, "ISA Plug & Play reset all cards"); 631da177e4SLinus Torvalds module_param(isapnp_verbose, int, 0); 641da177e4SLinus Torvalds MODULE_PARM_DESC(isapnp_verbose, "ISA Plug & Play verbose mode"); 651da177e4SLinus Torvalds 661da177e4SLinus Torvalds #define _PIDXR 0x279 671da177e4SLinus Torvalds #define _PNPWRP 0xa79 681da177e4SLinus Torvalds 691da177e4SLinus Torvalds /* short tags */ 701da177e4SLinus Torvalds #define _STAG_PNPVERNO 0x01 711da177e4SLinus Torvalds #define _STAG_LOGDEVID 0x02 721da177e4SLinus Torvalds #define _STAG_COMPATDEVID 0x03 731da177e4SLinus Torvalds #define _STAG_IRQ 0x04 741da177e4SLinus Torvalds #define _STAG_DMA 0x05 751da177e4SLinus Torvalds #define _STAG_STARTDEP 0x06 761da177e4SLinus Torvalds #define _STAG_ENDDEP 0x07 771da177e4SLinus Torvalds #define _STAG_IOPORT 0x08 781da177e4SLinus Torvalds #define _STAG_FIXEDIO 0x09 791da177e4SLinus Torvalds #define _STAG_VENDOR 0x0e 801da177e4SLinus Torvalds #define _STAG_END 0x0f 811da177e4SLinus Torvalds /* long tags */ 821da177e4SLinus Torvalds #define _LTAG_MEMRANGE 0x81 831da177e4SLinus Torvalds #define _LTAG_ANSISTR 0x82 841da177e4SLinus Torvalds #define _LTAG_UNICODESTR 0x83 851da177e4SLinus Torvalds #define _LTAG_VENDOR 0x84 861da177e4SLinus Torvalds #define _LTAG_MEM32RANGE 0x85 871da177e4SLinus Torvalds #define _LTAG_FIXEDMEM32RANGE 0x86 881da177e4SLinus Torvalds 89ca0e8b6fSBjorn Helgaas /* Logical device control and configuration registers */ 90ca0e8b6fSBjorn Helgaas 91ca0e8b6fSBjorn Helgaas #define ISAPNP_CFG_ACTIVATE 0x30 /* byte */ 92ca0e8b6fSBjorn Helgaas #define ISAPNP_CFG_MEM 0x40 /* 4 * dword */ 93ca0e8b6fSBjorn Helgaas #define ISAPNP_CFG_PORT 0x60 /* 8 * word */ 94ca0e8b6fSBjorn Helgaas #define ISAPNP_CFG_IRQ 0x70 /* 2 * word */ 95ca0e8b6fSBjorn Helgaas #define ISAPNP_CFG_DMA 0x74 /* 2 * byte */ 96ca0e8b6fSBjorn Helgaas 97245073f0SBjorn Helgaas /* 98245073f0SBjorn Helgaas * Sizes of ISAPNP logical device configuration register sets. 99245073f0SBjorn Helgaas * See PNP-ISA-v1.0a.pdf, Appendix A. 100245073f0SBjorn Helgaas */ 101245073f0SBjorn Helgaas #define ISAPNP_MAX_MEM 4 102245073f0SBjorn Helgaas #define ISAPNP_MAX_PORT 8 103245073f0SBjorn Helgaas #define ISAPNP_MAX_IRQ 2 104245073f0SBjorn Helgaas #define ISAPNP_MAX_DMA 2 105245073f0SBjorn Helgaas 1061da177e4SLinus Torvalds static unsigned char isapnp_checksum_value; 10714cc3e2bSIngo Molnar static DEFINE_MUTEX(isapnp_cfg_mutex); 1081da177e4SLinus Torvalds static int isapnp_csn_count; 1091da177e4SLinus Torvalds 1101da177e4SLinus Torvalds /* some prototypes */ 1111da177e4SLinus Torvalds 1121da177e4SLinus Torvalds static inline void write_data(unsigned char x) 1131da177e4SLinus Torvalds { 1141da177e4SLinus Torvalds outb(x, _PNPWRP); 1151da177e4SLinus Torvalds } 1161da177e4SLinus Torvalds 1171da177e4SLinus Torvalds static inline void write_address(unsigned char x) 1181da177e4SLinus Torvalds { 1191da177e4SLinus Torvalds outb(x, _PIDXR); 1201da177e4SLinus Torvalds udelay(20); 1211da177e4SLinus Torvalds } 1221da177e4SLinus Torvalds 1231da177e4SLinus Torvalds static inline unsigned char read_data(void) 1241da177e4SLinus Torvalds { 1251da177e4SLinus Torvalds unsigned char val = inb(isapnp_rdp); 1261da177e4SLinus Torvalds return val; 1271da177e4SLinus Torvalds } 1281da177e4SLinus Torvalds 1291da177e4SLinus Torvalds unsigned char isapnp_read_byte(unsigned char idx) 1301da177e4SLinus Torvalds { 1311da177e4SLinus Torvalds write_address(idx); 1321da177e4SLinus Torvalds return read_data(); 1331da177e4SLinus Torvalds } 1341da177e4SLinus Torvalds 1351da177e4SLinus Torvalds static unsigned short isapnp_read_word(unsigned char idx) 1361da177e4SLinus Torvalds { 1371da177e4SLinus Torvalds unsigned short val; 1381da177e4SLinus Torvalds 1391da177e4SLinus Torvalds val = isapnp_read_byte(idx); 1401da177e4SLinus Torvalds val = (val << 8) + isapnp_read_byte(idx + 1); 1411da177e4SLinus Torvalds return val; 1421da177e4SLinus Torvalds } 1431da177e4SLinus Torvalds 1441da177e4SLinus Torvalds void isapnp_write_byte(unsigned char idx, unsigned char val) 1451da177e4SLinus Torvalds { 1461da177e4SLinus Torvalds write_address(idx); 1471da177e4SLinus Torvalds write_data(val); 1481da177e4SLinus Torvalds } 1491da177e4SLinus Torvalds 1501da177e4SLinus Torvalds static void isapnp_write_word(unsigned char idx, unsigned short val) 1511da177e4SLinus Torvalds { 1521da177e4SLinus Torvalds isapnp_write_byte(idx, val >> 8); 1531da177e4SLinus Torvalds isapnp_write_byte(idx + 1, val); 1541da177e4SLinus Torvalds } 1551da177e4SLinus Torvalds 1561da177e4SLinus Torvalds static void isapnp_key(void) 1571da177e4SLinus Torvalds { 1581da177e4SLinus Torvalds unsigned char code = 0x6a, msb; 1591da177e4SLinus Torvalds int i; 1601da177e4SLinus Torvalds 1611da177e4SLinus Torvalds mdelay(1); 1621da177e4SLinus Torvalds write_address(0x00); 1631da177e4SLinus Torvalds write_address(0x00); 1641da177e4SLinus Torvalds 1651da177e4SLinus Torvalds write_address(code); 1661da177e4SLinus Torvalds 1671da177e4SLinus Torvalds for (i = 1; i < 32; i++) { 1681da177e4SLinus Torvalds msb = ((code & 0x01) ^ ((code & 0x02) >> 1)) << 7; 1691da177e4SLinus Torvalds code = (code >> 1) | msb; 1701da177e4SLinus Torvalds write_address(code); 1711da177e4SLinus Torvalds } 1721da177e4SLinus Torvalds } 1731da177e4SLinus Torvalds 1741da177e4SLinus Torvalds /* place all pnp cards in wait-for-key state */ 1751da177e4SLinus Torvalds static void isapnp_wait(void) 1761da177e4SLinus Torvalds { 1771da177e4SLinus Torvalds isapnp_write_byte(0x02, 0x02); 1781da177e4SLinus Torvalds } 1791da177e4SLinus Torvalds 1801da177e4SLinus Torvalds static void isapnp_wake(unsigned char csn) 1811da177e4SLinus Torvalds { 1821da177e4SLinus Torvalds isapnp_write_byte(0x03, csn); 1831da177e4SLinus Torvalds } 1841da177e4SLinus Torvalds 1851da177e4SLinus Torvalds static void isapnp_device(unsigned char logdev) 1861da177e4SLinus Torvalds { 1871da177e4SLinus Torvalds isapnp_write_byte(0x07, logdev); 1881da177e4SLinus Torvalds } 1891da177e4SLinus Torvalds 1901da177e4SLinus Torvalds static void isapnp_activate(unsigned char logdev) 1911da177e4SLinus Torvalds { 1921da177e4SLinus Torvalds isapnp_device(logdev); 1931da177e4SLinus Torvalds isapnp_write_byte(ISAPNP_CFG_ACTIVATE, 1); 1941da177e4SLinus Torvalds udelay(250); 1951da177e4SLinus Torvalds } 1961da177e4SLinus Torvalds 1971da177e4SLinus Torvalds static void isapnp_deactivate(unsigned char logdev) 1981da177e4SLinus Torvalds { 1991da177e4SLinus Torvalds isapnp_device(logdev); 2001da177e4SLinus Torvalds isapnp_write_byte(ISAPNP_CFG_ACTIVATE, 0); 2011da177e4SLinus Torvalds udelay(500); 2021da177e4SLinus Torvalds } 2031da177e4SLinus Torvalds 2041da177e4SLinus Torvalds static void __init isapnp_peek(unsigned char *data, int bytes) 2051da177e4SLinus Torvalds { 2061da177e4SLinus Torvalds int i, j; 2071da177e4SLinus Torvalds unsigned char d = 0; 2081da177e4SLinus Torvalds 2091da177e4SLinus Torvalds for (i = 1; i <= bytes; i++) { 2101da177e4SLinus Torvalds for (j = 0; j < 20; j++) { 2111da177e4SLinus Torvalds d = isapnp_read_byte(0x05); 2121da177e4SLinus Torvalds if (d & 1) 2131da177e4SLinus Torvalds break; 2141da177e4SLinus Torvalds udelay(100); 2151da177e4SLinus Torvalds } 2161da177e4SLinus Torvalds if (!(d & 1)) { 2171da177e4SLinus Torvalds if (data != NULL) 2181da177e4SLinus Torvalds *data++ = 0xff; 2191da177e4SLinus Torvalds continue; 2201da177e4SLinus Torvalds } 2211da177e4SLinus Torvalds d = isapnp_read_byte(0x04); /* PRESDI */ 2221da177e4SLinus Torvalds isapnp_checksum_value += d; 2231da177e4SLinus Torvalds if (data != NULL) 2241da177e4SLinus Torvalds *data++ = d; 2251da177e4SLinus Torvalds } 2261da177e4SLinus Torvalds } 2271da177e4SLinus Torvalds 2281da177e4SLinus Torvalds #define RDP_STEP 32 /* minimum is 4 */ 2291da177e4SLinus Torvalds 2301da177e4SLinus Torvalds static int isapnp_next_rdp(void) 2311da177e4SLinus Torvalds { 2321da177e4SLinus Torvalds int rdp = isapnp_rdp; 2331da177e4SLinus Torvalds static int old_rdp = 0; 2341da177e4SLinus Torvalds 2359dd78466SBjorn Helgaas if (old_rdp) { 2361da177e4SLinus Torvalds release_region(old_rdp, 1); 2371da177e4SLinus Torvalds old_rdp = 0; 2381da177e4SLinus Torvalds } 2391da177e4SLinus Torvalds while (rdp <= 0x3ff) { 2401da177e4SLinus Torvalds /* 2411da177e4SLinus Torvalds * We cannot use NE2000 probe spaces for ISAPnP or we 2421da177e4SLinus Torvalds * will lock up machines. 2431da177e4SLinus Torvalds */ 2449dd78466SBjorn Helgaas if ((rdp < 0x280 || rdp > 0x380) 2459dd78466SBjorn Helgaas && request_region(rdp, 1, "ISAPnP")) { 2461da177e4SLinus Torvalds isapnp_rdp = rdp; 2471da177e4SLinus Torvalds old_rdp = rdp; 2481da177e4SLinus Torvalds return 0; 2491da177e4SLinus Torvalds } 2501da177e4SLinus Torvalds rdp += RDP_STEP; 2511da177e4SLinus Torvalds } 2521da177e4SLinus Torvalds return -1; 2531da177e4SLinus Torvalds } 2541da177e4SLinus Torvalds 2551da177e4SLinus Torvalds /* Set read port address */ 2561da177e4SLinus Torvalds static inline void isapnp_set_rdp(void) 2571da177e4SLinus Torvalds { 2581da177e4SLinus Torvalds isapnp_write_byte(0x00, isapnp_rdp >> 2); 2591da177e4SLinus Torvalds udelay(100); 2601da177e4SLinus Torvalds } 2611da177e4SLinus Torvalds 2621da177e4SLinus Torvalds /* 2631da177e4SLinus Torvalds * Perform an isolation. The port selection code now tries to avoid 2641da177e4SLinus Torvalds * "dangerous to read" ports. 2651da177e4SLinus Torvalds */ 2661da177e4SLinus Torvalds static int __init isapnp_isolate_rdp_select(void) 2671da177e4SLinus Torvalds { 2681da177e4SLinus Torvalds isapnp_wait(); 2691da177e4SLinus Torvalds isapnp_key(); 2701da177e4SLinus Torvalds 2711da177e4SLinus Torvalds /* Control: reset CSN and conditionally everything else too */ 2721da177e4SLinus Torvalds isapnp_write_byte(0x02, isapnp_reset ? 0x05 : 0x04); 2731da177e4SLinus Torvalds mdelay(2); 2741da177e4SLinus Torvalds 2751da177e4SLinus Torvalds isapnp_wait(); 2761da177e4SLinus Torvalds isapnp_key(); 2771da177e4SLinus Torvalds isapnp_wake(0x00); 2781da177e4SLinus Torvalds 2791da177e4SLinus Torvalds if (isapnp_next_rdp() < 0) { 2801da177e4SLinus Torvalds isapnp_wait(); 2811da177e4SLinus Torvalds return -1; 2821da177e4SLinus Torvalds } 2831da177e4SLinus Torvalds 2841da177e4SLinus Torvalds isapnp_set_rdp(); 2851da177e4SLinus Torvalds udelay(1000); 2861da177e4SLinus Torvalds write_address(0x01); 2871da177e4SLinus Torvalds udelay(1000); 2881da177e4SLinus Torvalds return 0; 2891da177e4SLinus Torvalds } 2901da177e4SLinus Torvalds 2911da177e4SLinus Torvalds /* 2921da177e4SLinus Torvalds * Isolate (assign uniqued CSN) to all ISA PnP devices. 2931da177e4SLinus Torvalds */ 2941da177e4SLinus Torvalds static int __init isapnp_isolate(void) 2951da177e4SLinus Torvalds { 2961da177e4SLinus Torvalds unsigned char checksum = 0x6a; 2971da177e4SLinus Torvalds unsigned char chksum = 0x00; 2981da177e4SLinus Torvalds unsigned char bit = 0x00; 2991da177e4SLinus Torvalds int data; 3001da177e4SLinus Torvalds int csn = 0; 3011da177e4SLinus Torvalds int i; 3021da177e4SLinus Torvalds int iteration = 1; 3031da177e4SLinus Torvalds 3041da177e4SLinus Torvalds isapnp_rdp = 0x213; 3051da177e4SLinus Torvalds if (isapnp_isolate_rdp_select() < 0) 3061da177e4SLinus Torvalds return -1; 3071da177e4SLinus Torvalds 3081da177e4SLinus Torvalds while (1) { 3091da177e4SLinus Torvalds for (i = 1; i <= 64; i++) { 3101da177e4SLinus Torvalds data = read_data() << 8; 3111da177e4SLinus Torvalds udelay(250); 3121da177e4SLinus Torvalds data = data | read_data(); 3131da177e4SLinus Torvalds udelay(250); 3141da177e4SLinus Torvalds if (data == 0x55aa) 3151da177e4SLinus Torvalds bit = 0x01; 3169dd78466SBjorn Helgaas checksum = 3179dd78466SBjorn Helgaas ((((checksum ^ (checksum >> 1)) & 0x01) ^ bit) << 7) 3189dd78466SBjorn Helgaas | (checksum >> 1); 3191da177e4SLinus Torvalds bit = 0x00; 3201da177e4SLinus Torvalds } 3211da177e4SLinus Torvalds for (i = 65; i <= 72; i++) { 3221da177e4SLinus Torvalds data = read_data() << 8; 3231da177e4SLinus Torvalds udelay(250); 3241da177e4SLinus Torvalds data = data | read_data(); 3251da177e4SLinus Torvalds udelay(250); 3261da177e4SLinus Torvalds if (data == 0x55aa) 3271da177e4SLinus Torvalds chksum |= (1 << (i - 65)); 3281da177e4SLinus Torvalds } 3291da177e4SLinus Torvalds if (checksum != 0x00 && checksum == chksum) { 3301da177e4SLinus Torvalds csn++; 3311da177e4SLinus Torvalds 3321da177e4SLinus Torvalds isapnp_write_byte(0x06, csn); 3331da177e4SLinus Torvalds udelay(250); 3341da177e4SLinus Torvalds iteration++; 3351da177e4SLinus Torvalds isapnp_wake(0x00); 3361da177e4SLinus Torvalds isapnp_set_rdp(); 3371da177e4SLinus Torvalds udelay(1000); 3381da177e4SLinus Torvalds write_address(0x01); 3391da177e4SLinus Torvalds udelay(1000); 3401da177e4SLinus Torvalds goto __next; 3411da177e4SLinus Torvalds } 3421da177e4SLinus Torvalds if (iteration == 1) { 3431da177e4SLinus Torvalds isapnp_rdp += RDP_STEP; 3441da177e4SLinus Torvalds if (isapnp_isolate_rdp_select() < 0) 3451da177e4SLinus Torvalds return -1; 3461da177e4SLinus Torvalds } else if (iteration > 1) { 3471da177e4SLinus Torvalds break; 3481da177e4SLinus Torvalds } 3491da177e4SLinus Torvalds __next: 3501da177e4SLinus Torvalds if (csn == 255) 3511da177e4SLinus Torvalds break; 3521da177e4SLinus Torvalds checksum = 0x6a; 3531da177e4SLinus Torvalds chksum = 0x00; 3541da177e4SLinus Torvalds bit = 0x00; 3551da177e4SLinus Torvalds } 3561da177e4SLinus Torvalds isapnp_wait(); 3571da177e4SLinus Torvalds isapnp_csn_count = csn; 3581da177e4SLinus Torvalds return csn; 3591da177e4SLinus Torvalds } 3601da177e4SLinus Torvalds 3611da177e4SLinus Torvalds /* 3621da177e4SLinus Torvalds * Read one tag from stream. 3631da177e4SLinus Torvalds */ 3641da177e4SLinus Torvalds static int __init isapnp_read_tag(unsigned char *type, unsigned short *size) 3651da177e4SLinus Torvalds { 3661da177e4SLinus Torvalds unsigned char tag, tmp[2]; 3671da177e4SLinus Torvalds 3681da177e4SLinus Torvalds isapnp_peek(&tag, 1); 3691da177e4SLinus Torvalds if (tag == 0) /* invalid tag */ 3701da177e4SLinus Torvalds return -1; 3711da177e4SLinus Torvalds if (tag & 0x80) { /* large item */ 3721da177e4SLinus Torvalds *type = tag; 3731da177e4SLinus Torvalds isapnp_peek(tmp, 2); 3741da177e4SLinus Torvalds *size = (tmp[1] << 8) | tmp[0]; 3751da177e4SLinus Torvalds } else { 3761da177e4SLinus Torvalds *type = (tag >> 3) & 0x0f; 3771da177e4SLinus Torvalds *size = tag & 0x07; 3781da177e4SLinus Torvalds } 3791da177e4SLinus Torvalds if (*type == 0xff && *size == 0xffff) /* probably invalid data */ 3801da177e4SLinus Torvalds return -1; 3811da177e4SLinus Torvalds return 0; 3821da177e4SLinus Torvalds } 3831da177e4SLinus Torvalds 3841da177e4SLinus Torvalds /* 3851da177e4SLinus Torvalds * Skip specified number of bytes from stream. 3861da177e4SLinus Torvalds */ 3871da177e4SLinus Torvalds static void __init isapnp_skip_bytes(int count) 3881da177e4SLinus Torvalds { 3891da177e4SLinus Torvalds isapnp_peek(NULL, count); 3901da177e4SLinus Torvalds } 3911da177e4SLinus Torvalds 3921da177e4SLinus Torvalds /* 3931da177e4SLinus Torvalds * Parse logical device tag. 3941da177e4SLinus Torvalds */ 3959dd78466SBjorn Helgaas static struct pnp_dev *__init isapnp_parse_device(struct pnp_card *card, 3969dd78466SBjorn Helgaas int size, int number) 3971da177e4SLinus Torvalds { 3981da177e4SLinus Torvalds unsigned char tmp[6]; 3991da177e4SLinus Torvalds struct pnp_dev *dev; 40025eb8461SBjorn Helgaas u32 eisa_id; 40125eb8461SBjorn Helgaas char id[8]; 4021da177e4SLinus Torvalds 4031da177e4SLinus Torvalds isapnp_peek(tmp, size); 40425eb8461SBjorn Helgaas eisa_id = tmp[0] | tmp[1] << 8 | tmp[2] << 16 | tmp[3] << 24; 40525eb8461SBjorn Helgaas pnp_eisa_id_to_string(eisa_id, id); 406bda1e4e5SBjorn Helgaas 407bda1e4e5SBjorn Helgaas dev = pnp_alloc_dev(&isapnp_protocol, number, id); 408bda1e4e5SBjorn Helgaas if (!dev) 409bda1e4e5SBjorn Helgaas return NULL; 410bda1e4e5SBjorn Helgaas 4111da177e4SLinus Torvalds dev->card = card; 4121da177e4SLinus Torvalds dev->capabilities |= PNP_CONFIGURABLE; 4131da177e4SLinus Torvalds dev->capabilities |= PNP_READ; 4141da177e4SLinus Torvalds dev->capabilities |= PNP_WRITE; 4151da177e4SLinus Torvalds dev->capabilities |= PNP_DISABLE; 416f4490002SBjorn Helgaas pnp_init_resources(dev); 4171da177e4SLinus Torvalds return dev; 4181da177e4SLinus Torvalds } 4191da177e4SLinus Torvalds 4201da177e4SLinus Torvalds /* 4211da177e4SLinus Torvalds * Add IRQ resource to resources list. 4221da177e4SLinus Torvalds */ 423c1caf06cSBjorn Helgaas static void __init isapnp_parse_irq_resource(struct pnp_dev *dev, 4241f32ca31SBjorn Helgaas unsigned int option_flags, 4251da177e4SLinus Torvalds int size) 4261da177e4SLinus Torvalds { 4271da177e4SLinus Torvalds unsigned char tmp[3]; 4281da177e4SLinus Torvalds unsigned long bits; 429c227536bSBjorn Helgaas pnp_irq_mask_t map; 430c227536bSBjorn Helgaas unsigned char flags = IORESOURCE_IRQ_HIGHEDGE; 4311da177e4SLinus Torvalds 4321da177e4SLinus Torvalds isapnp_peek(tmp, size); 4331da177e4SLinus Torvalds bits = (tmp[1] << 8) | tmp[0]; 434c227536bSBjorn Helgaas 435c227536bSBjorn Helgaas bitmap_zero(map.bits, PNP_IRQ_NR); 436c227536bSBjorn Helgaas bitmap_copy(map.bits, &bits, 16); 437c227536bSBjorn Helgaas 4381da177e4SLinus Torvalds if (size > 2) 439c227536bSBjorn Helgaas flags = tmp[2]; 440c227536bSBjorn Helgaas 4411f32ca31SBjorn Helgaas pnp_register_irq_resource(dev, option_flags, &map, flags); 4421da177e4SLinus Torvalds } 4431da177e4SLinus Torvalds 4441da177e4SLinus Torvalds /* 4451da177e4SLinus Torvalds * Add DMA resource to resources list. 4461da177e4SLinus Torvalds */ 447c1caf06cSBjorn Helgaas static void __init isapnp_parse_dma_resource(struct pnp_dev *dev, 4481f32ca31SBjorn Helgaas unsigned int option_flags, 4491da177e4SLinus Torvalds int size) 4501da177e4SLinus Torvalds { 4511da177e4SLinus Torvalds unsigned char tmp[2]; 4521da177e4SLinus Torvalds 4531da177e4SLinus Torvalds isapnp_peek(tmp, size); 4541f32ca31SBjorn Helgaas pnp_register_dma_resource(dev, option_flags, tmp[0], tmp[1]); 4551da177e4SLinus Torvalds } 4561da177e4SLinus Torvalds 4571da177e4SLinus Torvalds /* 4581da177e4SLinus Torvalds * Add port resource to resources list. 4591da177e4SLinus Torvalds */ 460c1caf06cSBjorn Helgaas static void __init isapnp_parse_port_resource(struct pnp_dev *dev, 4611f32ca31SBjorn Helgaas unsigned int option_flags, 4621da177e4SLinus Torvalds int size) 4631da177e4SLinus Torvalds { 4641da177e4SLinus Torvalds unsigned char tmp[7]; 465c227536bSBjorn Helgaas resource_size_t min, max, align, len; 466c227536bSBjorn Helgaas unsigned char flags; 4671da177e4SLinus Torvalds 4681da177e4SLinus Torvalds isapnp_peek(tmp, size); 469c227536bSBjorn Helgaas min = (tmp[2] << 8) | tmp[1]; 470c227536bSBjorn Helgaas max = (tmp[4] << 8) | tmp[3]; 471c227536bSBjorn Helgaas align = tmp[5]; 472c227536bSBjorn Helgaas len = tmp[6]; 473c227536bSBjorn Helgaas flags = tmp[0] ? IORESOURCE_IO_16BIT_ADDR : 0; 4741f32ca31SBjorn Helgaas pnp_register_port_resource(dev, option_flags, 4751f32ca31SBjorn Helgaas min, max, align, len, flags); 4761da177e4SLinus Torvalds } 4771da177e4SLinus Torvalds 4781da177e4SLinus Torvalds /* 4791da177e4SLinus Torvalds * Add fixed port resource to resources list. 4801da177e4SLinus Torvalds */ 481c1caf06cSBjorn Helgaas static void __init isapnp_parse_fixed_port_resource(struct pnp_dev *dev, 4821f32ca31SBjorn Helgaas unsigned int option_flags, 4831da177e4SLinus Torvalds int size) 4841da177e4SLinus Torvalds { 4851da177e4SLinus Torvalds unsigned char tmp[3]; 486c227536bSBjorn Helgaas resource_size_t base, len; 4871da177e4SLinus Torvalds 4881da177e4SLinus Torvalds isapnp_peek(tmp, size); 489c227536bSBjorn Helgaas base = (tmp[1] << 8) | tmp[0]; 490c227536bSBjorn Helgaas len = tmp[2]; 4911f32ca31SBjorn Helgaas pnp_register_port_resource(dev, option_flags, base, base, 0, len, 492c227536bSBjorn Helgaas IORESOURCE_IO_FIXED); 4931da177e4SLinus Torvalds } 4941da177e4SLinus Torvalds 4951da177e4SLinus Torvalds /* 4961da177e4SLinus Torvalds * Add memory resource to resources list. 4971da177e4SLinus Torvalds */ 498c1caf06cSBjorn Helgaas static void __init isapnp_parse_mem_resource(struct pnp_dev *dev, 4991f32ca31SBjorn Helgaas unsigned int option_flags, 5001da177e4SLinus Torvalds int size) 5011da177e4SLinus Torvalds { 5021da177e4SLinus Torvalds unsigned char tmp[9]; 503c227536bSBjorn Helgaas resource_size_t min, max, align, len; 504c227536bSBjorn Helgaas unsigned char flags; 5051da177e4SLinus Torvalds 5061da177e4SLinus Torvalds isapnp_peek(tmp, size); 507c227536bSBjorn Helgaas min = ((tmp[2] << 8) | tmp[1]) << 8; 508c227536bSBjorn Helgaas max = ((tmp[4] << 8) | tmp[3]) << 8; 509c227536bSBjorn Helgaas align = (tmp[6] << 8) | tmp[5]; 510c227536bSBjorn Helgaas len = ((tmp[8] << 8) | tmp[7]) << 8; 511c227536bSBjorn Helgaas flags = tmp[0]; 5121f32ca31SBjorn Helgaas pnp_register_mem_resource(dev, option_flags, 5131f32ca31SBjorn Helgaas min, max, align, len, flags); 5141da177e4SLinus Torvalds } 5151da177e4SLinus Torvalds 5161da177e4SLinus Torvalds /* 5171da177e4SLinus Torvalds * Add 32-bit memory resource to resources list. 5181da177e4SLinus Torvalds */ 519c1caf06cSBjorn Helgaas static void __init isapnp_parse_mem32_resource(struct pnp_dev *dev, 5201f32ca31SBjorn Helgaas unsigned int option_flags, 5211da177e4SLinus Torvalds int size) 5221da177e4SLinus Torvalds { 5231da177e4SLinus Torvalds unsigned char tmp[17]; 524c227536bSBjorn Helgaas resource_size_t min, max, align, len; 525c227536bSBjorn Helgaas unsigned char flags; 5261da177e4SLinus Torvalds 5271da177e4SLinus Torvalds isapnp_peek(tmp, size); 528c227536bSBjorn Helgaas min = (tmp[4] << 24) | (tmp[3] << 16) | (tmp[2] << 8) | tmp[1]; 529c227536bSBjorn Helgaas max = (tmp[8] << 24) | (tmp[7] << 16) | (tmp[6] << 8) | tmp[5]; 530c227536bSBjorn Helgaas align = (tmp[12] << 24) | (tmp[11] << 16) | (tmp[10] << 8) | tmp[9]; 531c227536bSBjorn Helgaas len = (tmp[16] << 24) | (tmp[15] << 16) | (tmp[14] << 8) | tmp[13]; 532c227536bSBjorn Helgaas flags = tmp[0]; 5331f32ca31SBjorn Helgaas pnp_register_mem_resource(dev, option_flags, 5341f32ca31SBjorn Helgaas min, max, align, len, flags); 5351da177e4SLinus Torvalds } 5361da177e4SLinus Torvalds 5371da177e4SLinus Torvalds /* 5381da177e4SLinus Torvalds * Add 32-bit fixed memory resource to resources list. 5391da177e4SLinus Torvalds */ 540c1caf06cSBjorn Helgaas static void __init isapnp_parse_fixed_mem32_resource(struct pnp_dev *dev, 5411f32ca31SBjorn Helgaas unsigned int option_flags, 5421da177e4SLinus Torvalds int size) 5431da177e4SLinus Torvalds { 5441da177e4SLinus Torvalds unsigned char tmp[9]; 545c227536bSBjorn Helgaas resource_size_t base, len; 546c227536bSBjorn Helgaas unsigned char flags; 5471da177e4SLinus Torvalds 5481da177e4SLinus Torvalds isapnp_peek(tmp, size); 549c227536bSBjorn Helgaas base = (tmp[4] << 24) | (tmp[3] << 16) | (tmp[2] << 8) | tmp[1]; 550c227536bSBjorn Helgaas len = (tmp[8] << 24) | (tmp[7] << 16) | (tmp[6] << 8) | tmp[5]; 551c227536bSBjorn Helgaas flags = tmp[0]; 5521f32ca31SBjorn Helgaas pnp_register_mem_resource(dev, option_flags, base, base, 0, len, flags); 5531da177e4SLinus Torvalds } 5541da177e4SLinus Torvalds 5551da177e4SLinus Torvalds /* 5561da177e4SLinus Torvalds * Parse card name for ISA PnP device. 5571da177e4SLinus Torvalds */ 5581da177e4SLinus Torvalds static void __init 5591da177e4SLinus Torvalds isapnp_parse_name(char *name, unsigned int name_max, unsigned short *size) 5601da177e4SLinus Torvalds { 5611da177e4SLinus Torvalds if (name[0] == '\0') { 5629dd78466SBjorn Helgaas unsigned short size1 = 5639dd78466SBjorn Helgaas *size >= name_max ? (name_max - 1) : *size; 5641da177e4SLinus Torvalds isapnp_peek(name, size1); 5651da177e4SLinus Torvalds name[size1] = '\0'; 5661da177e4SLinus Torvalds *size -= size1; 5671da177e4SLinus Torvalds 5681da177e4SLinus Torvalds /* clean whitespace from end of string */ 5691da177e4SLinus Torvalds while (size1 > 0 && name[--size1] == ' ') 5701da177e4SLinus Torvalds name[size1] = '\0'; 5711da177e4SLinus Torvalds } 5721da177e4SLinus Torvalds } 5731da177e4SLinus Torvalds 5741da177e4SLinus Torvalds /* 5751da177e4SLinus Torvalds * Parse resource map for logical device. 5761da177e4SLinus Torvalds */ 5771da177e4SLinus Torvalds static int __init isapnp_create_device(struct pnp_card *card, 5781da177e4SLinus Torvalds unsigned short size) 5791da177e4SLinus Torvalds { 580e2a1a6f1SBjorn Helgaas int number = 0, skip = 0, priority, compat = 0; 5811da177e4SLinus Torvalds unsigned char type, tmp[17]; 5821f32ca31SBjorn Helgaas unsigned int option_flags; 5831da177e4SLinus Torvalds struct pnp_dev *dev; 58425eb8461SBjorn Helgaas u32 eisa_id; 58525eb8461SBjorn Helgaas char id[8]; 58607d4e9afSBjorn Helgaas 5871da177e4SLinus Torvalds if ((dev = isapnp_parse_device(card, size, number++)) == NULL) 5881da177e4SLinus Torvalds return 1; 5891f32ca31SBjorn Helgaas option_flags = 0; 5901da177e4SLinus Torvalds pnp_add_card_device(card, dev); 5911da177e4SLinus Torvalds 5921da177e4SLinus Torvalds while (1) { 5931da177e4SLinus Torvalds if (isapnp_read_tag(&type, &size) < 0) 5941da177e4SLinus Torvalds return 1; 5951da177e4SLinus Torvalds if (skip && type != _STAG_LOGDEVID && type != _STAG_END) 5961da177e4SLinus Torvalds goto __skip; 5971da177e4SLinus Torvalds switch (type) { 5981da177e4SLinus Torvalds case _STAG_LOGDEVID: 5991da177e4SLinus Torvalds if (size >= 5 && size <= 6) { 6009dd78466SBjorn Helgaas if ((dev = 6019dd78466SBjorn Helgaas isapnp_parse_device(card, size, 6029dd78466SBjorn Helgaas number++)) == NULL) 6031da177e4SLinus Torvalds return 1; 6041da177e4SLinus Torvalds size = 0; 6051da177e4SLinus Torvalds skip = 0; 6061f32ca31SBjorn Helgaas option_flags = 0; 6071da177e4SLinus Torvalds pnp_add_card_device(card, dev); 6081da177e4SLinus Torvalds } else { 6091da177e4SLinus Torvalds skip = 1; 6101da177e4SLinus Torvalds } 6111da177e4SLinus Torvalds compat = 0; 6121da177e4SLinus Torvalds break; 6131da177e4SLinus Torvalds case _STAG_COMPATDEVID: 6141da177e4SLinus Torvalds if (size == 4 && compat < DEVICE_COUNT_COMPATIBLE) { 6151da177e4SLinus Torvalds isapnp_peek(tmp, 4); 61625eb8461SBjorn Helgaas eisa_id = tmp[0] | tmp[1] << 8 | 61725eb8461SBjorn Helgaas tmp[2] << 16 | tmp[3] << 24; 61825eb8461SBjorn Helgaas pnp_eisa_id_to_string(eisa_id, id); 61925eb8461SBjorn Helgaas pnp_add_id(dev, id); 6201da177e4SLinus Torvalds compat++; 6211da177e4SLinus Torvalds size = 0; 6221da177e4SLinus Torvalds } 6231da177e4SLinus Torvalds break; 6241da177e4SLinus Torvalds case _STAG_IRQ: 6251da177e4SLinus Torvalds if (size < 2 || size > 3) 6261da177e4SLinus Torvalds goto __skip; 6271f32ca31SBjorn Helgaas isapnp_parse_irq_resource(dev, option_flags, size); 6281da177e4SLinus Torvalds size = 0; 6291da177e4SLinus Torvalds break; 6301da177e4SLinus Torvalds case _STAG_DMA: 6311da177e4SLinus Torvalds if (size != 2) 6321da177e4SLinus Torvalds goto __skip; 6331f32ca31SBjorn Helgaas isapnp_parse_dma_resource(dev, option_flags, size); 6341da177e4SLinus Torvalds size = 0; 6351da177e4SLinus Torvalds break; 6361da177e4SLinus Torvalds case _STAG_STARTDEP: 6371da177e4SLinus Torvalds if (size > 1) 6381da177e4SLinus Torvalds goto __skip; 639e2a1a6f1SBjorn Helgaas priority = PNP_RES_PRIORITY_ACCEPTABLE; 6401da177e4SLinus Torvalds if (size > 0) { 6411da177e4SLinus Torvalds isapnp_peek(tmp, size); 642e2a1a6f1SBjorn Helgaas priority = tmp[0]; 6431da177e4SLinus Torvalds size = 0; 6441da177e4SLinus Torvalds } 6451f32ca31SBjorn Helgaas option_flags = pnp_new_dependent_set(dev, priority); 6461da177e4SLinus Torvalds break; 6471da177e4SLinus Torvalds case _STAG_ENDDEP: 6481da177e4SLinus Torvalds if (size != 0) 6491da177e4SLinus Torvalds goto __skip; 6501f32ca31SBjorn Helgaas option_flags = 0; 6511da177e4SLinus Torvalds break; 6521da177e4SLinus Torvalds case _STAG_IOPORT: 6531da177e4SLinus Torvalds if (size != 7) 6541da177e4SLinus Torvalds goto __skip; 6551f32ca31SBjorn Helgaas isapnp_parse_port_resource(dev, option_flags, size); 6561da177e4SLinus Torvalds size = 0; 6571da177e4SLinus Torvalds break; 6581da177e4SLinus Torvalds case _STAG_FIXEDIO: 6591da177e4SLinus Torvalds if (size != 3) 6601da177e4SLinus Torvalds goto __skip; 6611f32ca31SBjorn Helgaas isapnp_parse_fixed_port_resource(dev, option_flags, 6621f32ca31SBjorn Helgaas size); 6631da177e4SLinus Torvalds size = 0; 6641da177e4SLinus Torvalds break; 6651da177e4SLinus Torvalds case _STAG_VENDOR: 6661da177e4SLinus Torvalds break; 6671da177e4SLinus Torvalds case _LTAG_MEMRANGE: 6681da177e4SLinus Torvalds if (size != 9) 6691da177e4SLinus Torvalds goto __skip; 6701f32ca31SBjorn Helgaas isapnp_parse_mem_resource(dev, option_flags, size); 6711da177e4SLinus Torvalds size = 0; 6721da177e4SLinus Torvalds break; 6731da177e4SLinus Torvalds case _LTAG_ANSISTR: 6741da177e4SLinus Torvalds isapnp_parse_name(dev->name, sizeof(dev->name), &size); 6751da177e4SLinus Torvalds break; 6761da177e4SLinus Torvalds case _LTAG_UNICODESTR: 6771da177e4SLinus Torvalds /* silently ignore */ 6781da177e4SLinus Torvalds /* who use unicode for hardware identification? */ 6791da177e4SLinus Torvalds break; 6801da177e4SLinus Torvalds case _LTAG_VENDOR: 6811da177e4SLinus Torvalds break; 6821da177e4SLinus Torvalds case _LTAG_MEM32RANGE: 6831da177e4SLinus Torvalds if (size != 17) 6841da177e4SLinus Torvalds goto __skip; 6851f32ca31SBjorn Helgaas isapnp_parse_mem32_resource(dev, option_flags, size); 6861da177e4SLinus Torvalds size = 0; 6871da177e4SLinus Torvalds break; 6881da177e4SLinus Torvalds case _LTAG_FIXEDMEM32RANGE: 6891da177e4SLinus Torvalds if (size != 9) 6901da177e4SLinus Torvalds goto __skip; 6911f32ca31SBjorn Helgaas isapnp_parse_fixed_mem32_resource(dev, option_flags, 6921f32ca31SBjorn Helgaas size); 6931da177e4SLinus Torvalds size = 0; 6941da177e4SLinus Torvalds break; 6951da177e4SLinus Torvalds case _STAG_END: 6961da177e4SLinus Torvalds if (size > 0) 6971da177e4SLinus Torvalds isapnp_skip_bytes(size); 6981da177e4SLinus Torvalds return 1; 6991da177e4SLinus Torvalds default: 700af11cb2dSBjorn Helgaas dev_err(&dev->dev, "unknown tag %#x (card %i), " 701af11cb2dSBjorn Helgaas "ignored\n", type, card->number); 7021da177e4SLinus Torvalds } 7031da177e4SLinus Torvalds __skip: 7041da177e4SLinus Torvalds if (size > 0) 7051da177e4SLinus Torvalds isapnp_skip_bytes(size); 7061da177e4SLinus Torvalds } 7071da177e4SLinus Torvalds return 0; 7081da177e4SLinus Torvalds } 7091da177e4SLinus Torvalds 7101da177e4SLinus Torvalds /* 7111da177e4SLinus Torvalds * Parse resource map for ISA PnP card. 7121da177e4SLinus Torvalds */ 7131da177e4SLinus Torvalds static void __init isapnp_parse_resource_map(struct pnp_card *card) 7141da177e4SLinus Torvalds { 7151da177e4SLinus Torvalds unsigned char type, tmp[17]; 7161da177e4SLinus Torvalds unsigned short size; 7171da177e4SLinus Torvalds 7181da177e4SLinus Torvalds while (1) { 7191da177e4SLinus Torvalds if (isapnp_read_tag(&type, &size) < 0) 7201da177e4SLinus Torvalds return; 7211da177e4SLinus Torvalds switch (type) { 7221da177e4SLinus Torvalds case _STAG_PNPVERNO: 7231da177e4SLinus Torvalds if (size != 2) 7241da177e4SLinus Torvalds goto __skip; 7251da177e4SLinus Torvalds isapnp_peek(tmp, 2); 7261da177e4SLinus Torvalds card->pnpver = tmp[0]; 7271da177e4SLinus Torvalds card->productver = tmp[1]; 7281da177e4SLinus Torvalds size = 0; 7291da177e4SLinus Torvalds break; 7301da177e4SLinus Torvalds case _STAG_LOGDEVID: 7311da177e4SLinus Torvalds if (size >= 5 && size <= 6) { 7321da177e4SLinus Torvalds if (isapnp_create_device(card, size) == 1) 7331da177e4SLinus Torvalds return; 7341da177e4SLinus Torvalds size = 0; 7351da177e4SLinus Torvalds } 7361da177e4SLinus Torvalds break; 7371da177e4SLinus Torvalds case _STAG_VENDOR: 7381da177e4SLinus Torvalds break; 7391da177e4SLinus Torvalds case _LTAG_ANSISTR: 7409dd78466SBjorn Helgaas isapnp_parse_name(card->name, sizeof(card->name), 7419dd78466SBjorn Helgaas &size); 7421da177e4SLinus Torvalds break; 7431da177e4SLinus Torvalds case _LTAG_UNICODESTR: 7441da177e4SLinus Torvalds /* silently ignore */ 7451da177e4SLinus Torvalds /* who use unicode for hardware identification? */ 7461da177e4SLinus Torvalds break; 7471da177e4SLinus Torvalds case _LTAG_VENDOR: 7481da177e4SLinus Torvalds break; 7491da177e4SLinus Torvalds case _STAG_END: 7501da177e4SLinus Torvalds if (size > 0) 7511da177e4SLinus Torvalds isapnp_skip_bytes(size); 7521da177e4SLinus Torvalds return; 7531da177e4SLinus Torvalds default: 754af11cb2dSBjorn Helgaas dev_err(&card->dev, "unknown tag %#x, ignored\n", 755af11cb2dSBjorn Helgaas type); 7561da177e4SLinus Torvalds } 7571da177e4SLinus Torvalds __skip: 7581da177e4SLinus Torvalds if (size > 0) 7591da177e4SLinus Torvalds isapnp_skip_bytes(size); 7601da177e4SLinus Torvalds } 7611da177e4SLinus Torvalds } 7621da177e4SLinus Torvalds 7631da177e4SLinus Torvalds /* 7641da177e4SLinus Torvalds * Compute ISA PnP checksum for first eight bytes. 7651da177e4SLinus Torvalds */ 7661da177e4SLinus Torvalds static unsigned char __init isapnp_checksum(unsigned char *data) 7671da177e4SLinus Torvalds { 7681da177e4SLinus Torvalds int i, j; 7691da177e4SLinus Torvalds unsigned char checksum = 0x6a, bit, b; 7701da177e4SLinus Torvalds 7711da177e4SLinus Torvalds for (i = 0; i < 8; i++) { 7721da177e4SLinus Torvalds b = data[i]; 7731da177e4SLinus Torvalds for (j = 0; j < 8; j++) { 7741da177e4SLinus Torvalds bit = 0; 7751da177e4SLinus Torvalds if (b & (1 << j)) 7761da177e4SLinus Torvalds bit = 1; 7779dd78466SBjorn Helgaas checksum = 7789dd78466SBjorn Helgaas ((((checksum ^ (checksum >> 1)) & 0x01) ^ bit) << 7) 7799dd78466SBjorn Helgaas | (checksum >> 1); 7801da177e4SLinus Torvalds } 7811da177e4SLinus Torvalds } 7821da177e4SLinus Torvalds return checksum; 7831da177e4SLinus Torvalds } 7841da177e4SLinus Torvalds 7851da177e4SLinus Torvalds /* 7861da177e4SLinus Torvalds * Build device list for all present ISA PnP devices. 7871da177e4SLinus Torvalds */ 7881da177e4SLinus Torvalds static int __init isapnp_build_device_list(void) 7891da177e4SLinus Torvalds { 7901da177e4SLinus Torvalds int csn; 7911da177e4SLinus Torvalds unsigned char header[9], checksum; 7921da177e4SLinus Torvalds struct pnp_card *card; 793068076d5SBjorn Helgaas u32 eisa_id; 794068076d5SBjorn Helgaas char id[8]; 7951da177e4SLinus Torvalds 7961da177e4SLinus Torvalds isapnp_wait(); 7971da177e4SLinus Torvalds isapnp_key(); 7981da177e4SLinus Torvalds for (csn = 1; csn <= isapnp_csn_count; csn++) { 7991da177e4SLinus Torvalds isapnp_wake(csn); 8001da177e4SLinus Torvalds isapnp_peek(header, 9); 8011da177e4SLinus Torvalds checksum = isapnp_checksum(header); 802068076d5SBjorn Helgaas eisa_id = header[0] | header[1] << 8 | 803068076d5SBjorn Helgaas header[2] << 16 | header[3] << 24; 804068076d5SBjorn Helgaas pnp_eisa_id_to_string(eisa_id, id); 8056bf2aab2SBjorn Helgaas card = pnp_alloc_card(&isapnp_protocol, csn, id); 8066bf2aab2SBjorn Helgaas if (!card) 8076bf2aab2SBjorn Helgaas continue; 8086bf2aab2SBjorn Helgaas 8096bf2aab2SBjorn Helgaas INIT_LIST_HEAD(&card->devices); 8109dd78466SBjorn Helgaas card->serial = 8119dd78466SBjorn Helgaas (header[7] << 24) | (header[6] << 16) | (header[5] << 8) | 8129dd78466SBjorn Helgaas header[4]; 8131da177e4SLinus Torvalds isapnp_checksum_value = 0x00; 8141da177e4SLinus Torvalds isapnp_parse_resource_map(card); 8151da177e4SLinus Torvalds if (isapnp_checksum_value != 0x00) 816af11cb2dSBjorn Helgaas dev_err(&card->dev, "invalid checksum %#x\n", 817af11cb2dSBjorn Helgaas isapnp_checksum_value); 8181da177e4SLinus Torvalds card->checksum = isapnp_checksum_value; 8191da177e4SLinus Torvalds 8201da177e4SLinus Torvalds pnp_add_card(card); 8211da177e4SLinus Torvalds } 8221da177e4SLinus Torvalds isapnp_wait(); 8231da177e4SLinus Torvalds return 0; 8241da177e4SLinus Torvalds } 8251da177e4SLinus Torvalds 8261da177e4SLinus Torvalds /* 8271da177e4SLinus Torvalds * Basic configuration routines. 8281da177e4SLinus Torvalds */ 8291da177e4SLinus Torvalds 8301da177e4SLinus Torvalds int isapnp_present(void) 8311da177e4SLinus Torvalds { 8321da177e4SLinus Torvalds struct pnp_card *card; 83307d4e9afSBjorn Helgaas 8341da177e4SLinus Torvalds pnp_for_each_card(card) { 8351da177e4SLinus Torvalds if (card->protocol == &isapnp_protocol) 8361da177e4SLinus Torvalds return 1; 8371da177e4SLinus Torvalds } 8381da177e4SLinus Torvalds return 0; 8391da177e4SLinus Torvalds } 8401da177e4SLinus Torvalds 8411da177e4SLinus Torvalds int isapnp_cfg_begin(int csn, int logdev) 8421da177e4SLinus Torvalds { 8431da177e4SLinus Torvalds if (csn < 1 || csn > isapnp_csn_count || logdev > 10) 8441da177e4SLinus Torvalds return -EINVAL; 84514cc3e2bSIngo Molnar mutex_lock(&isapnp_cfg_mutex); 8461da177e4SLinus Torvalds isapnp_wait(); 8471da177e4SLinus Torvalds isapnp_key(); 8481da177e4SLinus Torvalds isapnp_wake(csn); 8491da177e4SLinus Torvalds #if 0 8501da177e4SLinus Torvalds /* to avoid malfunction when the isapnptools package is used */ 8511da177e4SLinus Torvalds /* we must set RDP to our value again */ 8521da177e4SLinus Torvalds /* it is possible to set RDP only in the isolation phase */ 8531da177e4SLinus Torvalds /* Jens Thoms Toerring <Jens.Toerring@physik.fu-berlin.de> */ 8541da177e4SLinus Torvalds isapnp_write_byte(0x02, 0x04); /* clear CSN of card */ 8551da177e4SLinus Torvalds mdelay(2); /* is this necessary? */ 8561da177e4SLinus Torvalds isapnp_wake(csn); /* bring card into sleep state */ 8571da177e4SLinus Torvalds isapnp_wake(0); /* bring card into isolation state */ 8581da177e4SLinus Torvalds isapnp_set_rdp(); /* reset the RDP port */ 8591da177e4SLinus Torvalds udelay(1000); /* delay 1000us */ 8601da177e4SLinus Torvalds isapnp_write_byte(0x06, csn); /* reset CSN to previous value */ 8611da177e4SLinus Torvalds udelay(250); /* is this necessary? */ 8621da177e4SLinus Torvalds #endif 8631da177e4SLinus Torvalds if (logdev >= 0) 8641da177e4SLinus Torvalds isapnp_device(logdev); 8651da177e4SLinus Torvalds return 0; 8661da177e4SLinus Torvalds } 8671da177e4SLinus Torvalds 8681da177e4SLinus Torvalds int isapnp_cfg_end(void) 8691da177e4SLinus Torvalds { 8701da177e4SLinus Torvalds isapnp_wait(); 87114cc3e2bSIngo Molnar mutex_unlock(&isapnp_cfg_mutex); 8721da177e4SLinus Torvalds return 0; 8731da177e4SLinus Torvalds } 8741da177e4SLinus Torvalds 8751da177e4SLinus Torvalds /* 87607d4e9afSBjorn Helgaas * Initialization. 8771da177e4SLinus Torvalds */ 8781da177e4SLinus Torvalds 8791da177e4SLinus Torvalds EXPORT_SYMBOL(isapnp_protocol); 8801da177e4SLinus Torvalds EXPORT_SYMBOL(isapnp_present); 8811da177e4SLinus Torvalds EXPORT_SYMBOL(isapnp_cfg_begin); 8821da177e4SLinus Torvalds EXPORT_SYMBOL(isapnp_cfg_end); 8831da177e4SLinus Torvalds EXPORT_SYMBOL(isapnp_write_byte); 8841da177e4SLinus Torvalds 88559284cb4SBjorn Helgaas static int isapnp_get_resources(struct pnp_dev *dev) 8861da177e4SLinus Torvalds { 88701115e7dSBjorn Helgaas int i, ret; 8881e0aa9adSBjorn Helgaas 8892f53432cSBjorn Helgaas pnp_dbg(&dev->dev, "get resources\n"); 890f4490002SBjorn Helgaas pnp_init_resources(dev); 8911da177e4SLinus Torvalds isapnp_cfg_begin(dev->card->number, dev->number); 89201115e7dSBjorn Helgaas dev->active = isapnp_read_byte(ISAPNP_CFG_ACTIVATE); 89301115e7dSBjorn Helgaas if (!dev->active) 89401115e7dSBjorn Helgaas goto __end; 89501115e7dSBjorn Helgaas 89601115e7dSBjorn Helgaas for (i = 0; i < ISAPNP_MAX_PORT; i++) { 89701115e7dSBjorn Helgaas ret = isapnp_read_word(ISAPNP_CFG_PORT + (i << 1)); 89887e4acf3SBjorn Helgaas pnp_add_io_resource(dev, ret, ret, 89987e4acf3SBjorn Helgaas ret == 0 ? IORESOURCE_DISABLED : 0); 90001115e7dSBjorn Helgaas } 90101115e7dSBjorn Helgaas for (i = 0; i < ISAPNP_MAX_MEM; i++) { 90201115e7dSBjorn Helgaas ret = isapnp_read_word(ISAPNP_CFG_MEM + (i << 3)) << 8; 90387e4acf3SBjorn Helgaas pnp_add_mem_resource(dev, ret, ret, 90487e4acf3SBjorn Helgaas ret == 0 ? IORESOURCE_DISABLED : 0); 90501115e7dSBjorn Helgaas } 90601115e7dSBjorn Helgaas for (i = 0; i < ISAPNP_MAX_IRQ; i++) { 90701115e7dSBjorn Helgaas ret = isapnp_read_word(ISAPNP_CFG_IRQ + (i << 1)) >> 8; 90887e4acf3SBjorn Helgaas pnp_add_irq_resource(dev, ret, 90987e4acf3SBjorn Helgaas ret == 0 ? IORESOURCE_DISABLED : 0); 91001115e7dSBjorn Helgaas } 91101115e7dSBjorn Helgaas for (i = 0; i < ISAPNP_MAX_DMA; i++) { 91201115e7dSBjorn Helgaas ret = isapnp_read_byte(ISAPNP_CFG_DMA + i); 91387e4acf3SBjorn Helgaas pnp_add_dma_resource(dev, ret, 91487e4acf3SBjorn Helgaas ret == 4 ? IORESOURCE_DISABLED : 0); 91501115e7dSBjorn Helgaas } 91601115e7dSBjorn Helgaas 91701115e7dSBjorn Helgaas __end: 9181da177e4SLinus Torvalds isapnp_cfg_end(); 91901115e7dSBjorn Helgaas return 0; 9201da177e4SLinus Torvalds } 9211da177e4SLinus Torvalds 92259284cb4SBjorn Helgaas static int isapnp_set_resources(struct pnp_dev *dev) 9231da177e4SLinus Torvalds { 92406cb58a6SBjorn Helgaas struct resource *res; 92587e4acf3SBjorn Helgaas int tmp; 9261da177e4SLinus Torvalds 9272f53432cSBjorn Helgaas pnp_dbg(&dev->dev, "set resources\n"); 9281da177e4SLinus Torvalds isapnp_cfg_begin(dev->card->number, dev->number); 9291da177e4SLinus Torvalds dev->active = 1; 93006cb58a6SBjorn Helgaas for (tmp = 0; tmp < ISAPNP_MAX_PORT; tmp++) { 93187e4acf3SBjorn Helgaas res = pnp_get_resource(dev, IORESOURCE_IO, tmp); 932aee3ad81SBjorn Helgaas if (pnp_resource_enabled(res)) { 9332f53432cSBjorn Helgaas pnp_dbg(&dev->dev, " set io %d to %#llx\n", 93487e4acf3SBjorn Helgaas tmp, (unsigned long long) res->start); 93587e4acf3SBjorn Helgaas isapnp_write_word(ISAPNP_CFG_PORT + (tmp << 1), 93606cb58a6SBjorn Helgaas res->start); 93772dcc883SBjorn Helgaas } 93806cb58a6SBjorn Helgaas } 93906cb58a6SBjorn Helgaas for (tmp = 0; tmp < ISAPNP_MAX_IRQ; tmp++) { 94087e4acf3SBjorn Helgaas res = pnp_get_resource(dev, IORESOURCE_IRQ, tmp); 941aee3ad81SBjorn Helgaas if (pnp_resource_enabled(res)) { 94206cb58a6SBjorn Helgaas int irq = res->start; 9431da177e4SLinus Torvalds if (irq == 2) 9441da177e4SLinus Torvalds irq = 9; 9452f53432cSBjorn Helgaas pnp_dbg(&dev->dev, " set irq %d to %d\n", tmp, irq); 94687e4acf3SBjorn Helgaas isapnp_write_byte(ISAPNP_CFG_IRQ + (tmp << 1), irq); 9471da177e4SLinus Torvalds } 94872dcc883SBjorn Helgaas } 94906cb58a6SBjorn Helgaas for (tmp = 0; tmp < ISAPNP_MAX_DMA; tmp++) { 95087e4acf3SBjorn Helgaas res = pnp_get_resource(dev, IORESOURCE_DMA, tmp); 951aee3ad81SBjorn Helgaas if (pnp_resource_enabled(res)) { 9522f53432cSBjorn Helgaas pnp_dbg(&dev->dev, " set dma %d to %lld\n", 95387e4acf3SBjorn Helgaas tmp, (unsigned long long) res->start); 95487e4acf3SBjorn Helgaas isapnp_write_byte(ISAPNP_CFG_DMA + tmp, res->start); 95506cb58a6SBjorn Helgaas } 95606cb58a6SBjorn Helgaas } 95706cb58a6SBjorn Helgaas for (tmp = 0; tmp < ISAPNP_MAX_MEM; tmp++) { 95887e4acf3SBjorn Helgaas res = pnp_get_resource(dev, IORESOURCE_MEM, tmp); 959aee3ad81SBjorn Helgaas if (pnp_resource_enabled(res)) { 9602f53432cSBjorn Helgaas pnp_dbg(&dev->dev, " set mem %d to %#llx\n", 96187e4acf3SBjorn Helgaas tmp, (unsigned long long) res->start); 96287e4acf3SBjorn Helgaas isapnp_write_word(ISAPNP_CFG_MEM + (tmp << 3), 96306cb58a6SBjorn Helgaas (res->start >> 8) & 0xffff); 96406cb58a6SBjorn Helgaas } 96572dcc883SBjorn Helgaas } 9661da177e4SLinus Torvalds /* FIXME: We aren't handling 32bit mems properly here */ 9671da177e4SLinus Torvalds isapnp_activate(dev->number); 9681da177e4SLinus Torvalds isapnp_cfg_end(); 9691da177e4SLinus Torvalds return 0; 9701da177e4SLinus Torvalds } 9711da177e4SLinus Torvalds 9721da177e4SLinus Torvalds static int isapnp_disable_resources(struct pnp_dev *dev) 9731da177e4SLinus Torvalds { 974b1734913SBjorn Helgaas if (!dev->active) 9751da177e4SLinus Torvalds return -EINVAL; 9761da177e4SLinus Torvalds isapnp_cfg_begin(dev->card->number, dev->number); 9771da177e4SLinus Torvalds isapnp_deactivate(dev->number); 9781da177e4SLinus Torvalds dev->active = 0; 9791da177e4SLinus Torvalds isapnp_cfg_end(); 9801da177e4SLinus Torvalds return 0; 9811da177e4SLinus Torvalds } 9821da177e4SLinus Torvalds 9831da177e4SLinus Torvalds struct pnp_protocol isapnp_protocol = { 9841da177e4SLinus Torvalds .name = "ISA Plug and Play", 9851da177e4SLinus Torvalds .get = isapnp_get_resources, 9861da177e4SLinus Torvalds .set = isapnp_set_resources, 9871da177e4SLinus Torvalds .disable = isapnp_disable_resources, 9881da177e4SLinus Torvalds }; 9891da177e4SLinus Torvalds 9901da177e4SLinus Torvalds static int __init isapnp_init(void) 9911da177e4SLinus Torvalds { 9921da177e4SLinus Torvalds int cards; 9931da177e4SLinus Torvalds struct pnp_card *card; 9941da177e4SLinus Torvalds struct pnp_dev *dev; 9951da177e4SLinus Torvalds 9961da177e4SLinus Torvalds if (isapnp_disable) { 9971da177e4SLinus Torvalds printk(KERN_INFO "isapnp: ISA Plug & Play support disabled\n"); 9981da177e4SLinus Torvalds return 0; 9991da177e4SLinus Torvalds } 100068e1ee62SKumar Gala #ifdef CONFIG_PPC 100107bd1c4aSDavid Woodhouse if (check_legacy_ioport(_PIDXR) || check_legacy_ioport(_PNPWRP)) 100207bd1c4aSDavid Woodhouse return -EINVAL; 100307bd1c4aSDavid Woodhouse #endif 10041da177e4SLinus Torvalds #ifdef ISAPNP_REGION_OK 10051da177e4SLinus Torvalds if (!request_region(_PIDXR, 1, "isapnp index")) { 10069dd78466SBjorn Helgaas printk(KERN_ERR "isapnp: Index Register 0x%x already used\n", 10079dd78466SBjorn Helgaas _PIDXR); 10081da177e4SLinus Torvalds return -EBUSY; 10091da177e4SLinus Torvalds } 10101da177e4SLinus Torvalds #endif 10111da177e4SLinus Torvalds if (!request_region(_PNPWRP, 1, "isapnp write")) { 10129dd78466SBjorn Helgaas printk(KERN_ERR 10139dd78466SBjorn Helgaas "isapnp: Write Data Register 0x%x already used\n", 10149dd78466SBjorn Helgaas _PNPWRP); 10151da177e4SLinus Torvalds #ifdef ISAPNP_REGION_OK 10161da177e4SLinus Torvalds release_region(_PIDXR, 1); 10171da177e4SLinus Torvalds #endif 10181da177e4SLinus Torvalds return -EBUSY; 10191da177e4SLinus Torvalds } 10201da177e4SLinus Torvalds 10211da177e4SLinus Torvalds if (pnp_register_protocol(&isapnp_protocol) < 0) 10221da177e4SLinus Torvalds return -EBUSY; 10231da177e4SLinus Torvalds 10241da177e4SLinus Torvalds /* 10251da177e4SLinus Torvalds * Print a message. The existing ISAPnP code is hanging machines 10261da177e4SLinus Torvalds * so let the user know where. 10271da177e4SLinus Torvalds */ 10281da177e4SLinus Torvalds 10291da177e4SLinus Torvalds printk(KERN_INFO "isapnp: Scanning for PnP cards...\n"); 10301da177e4SLinus Torvalds if (isapnp_rdp >= 0x203 && isapnp_rdp <= 0x3ff) { 10311da177e4SLinus Torvalds isapnp_rdp |= 3; 10321da177e4SLinus Torvalds if (!request_region(isapnp_rdp, 1, "isapnp read")) { 10339dd78466SBjorn Helgaas printk(KERN_ERR 10349dd78466SBjorn Helgaas "isapnp: Read Data Register 0x%x already used\n", 10359dd78466SBjorn Helgaas isapnp_rdp); 10361da177e4SLinus Torvalds #ifdef ISAPNP_REGION_OK 10371da177e4SLinus Torvalds release_region(_PIDXR, 1); 10381da177e4SLinus Torvalds #endif 10391da177e4SLinus Torvalds release_region(_PNPWRP, 1); 10401da177e4SLinus Torvalds return -EBUSY; 10411da177e4SLinus Torvalds } 10421da177e4SLinus Torvalds isapnp_set_rdp(); 10431da177e4SLinus Torvalds } 10441da177e4SLinus Torvalds if (isapnp_rdp < 0x203 || isapnp_rdp > 0x3ff) { 10451da177e4SLinus Torvalds cards = isapnp_isolate(); 10469dd78466SBjorn Helgaas if (cards < 0 || (isapnp_rdp < 0x203 || isapnp_rdp > 0x3ff)) { 10471da177e4SLinus Torvalds #ifdef ISAPNP_REGION_OK 10481da177e4SLinus Torvalds release_region(_PIDXR, 1); 10491da177e4SLinus Torvalds #endif 10501da177e4SLinus Torvalds release_region(_PNPWRP, 1); 10519dd78466SBjorn Helgaas printk(KERN_INFO 10529dd78466SBjorn Helgaas "isapnp: No Plug & Play device found\n"); 10531da177e4SLinus Torvalds return 0; 10541da177e4SLinus Torvalds } 10551da177e4SLinus Torvalds request_region(isapnp_rdp, 1, "isapnp read"); 10561da177e4SLinus Torvalds } 10571da177e4SLinus Torvalds isapnp_build_device_list(); 10581da177e4SLinus Torvalds cards = 0; 10591da177e4SLinus Torvalds 10601da177e4SLinus Torvalds protocol_for_each_card(&isapnp_protocol, card) { 10611da177e4SLinus Torvalds cards++; 10621da177e4SLinus Torvalds if (isapnp_verbose) { 1063af11cb2dSBjorn Helgaas dev_info(&card->dev, "card '%s'\n", 1064af11cb2dSBjorn Helgaas card->name[0] ? card->name : "unknown"); 10651da177e4SLinus Torvalds if (isapnp_verbose < 2) 10661da177e4SLinus Torvalds continue; 10671da177e4SLinus Torvalds card_for_each_dev(card, dev) { 1068af11cb2dSBjorn Helgaas dev_info(&card->dev, "device '%s'\n", 1069af11cb2dSBjorn Helgaas dev->name[0] ? dev->name : "unknown"); 10701da177e4SLinus Torvalds } 10711da177e4SLinus Torvalds } 10721da177e4SLinus Torvalds } 10731e0aa9adSBjorn Helgaas if (cards) 10749dd78466SBjorn Helgaas printk(KERN_INFO 10759dd78466SBjorn Helgaas "isapnp: %i Plug & Play card%s detected total\n", cards, 10769dd78466SBjorn Helgaas cards > 1 ? "s" : ""); 10771e0aa9adSBjorn Helgaas else 10781da177e4SLinus Torvalds printk(KERN_INFO "isapnp: No Plug & Play card found\n"); 10791da177e4SLinus Torvalds 10801da177e4SLinus Torvalds isapnp_proc_init(); 10811da177e4SLinus Torvalds return 0; 10821da177e4SLinus Torvalds } 10831da177e4SLinus Torvalds 10841da177e4SLinus Torvalds device_initcall(isapnp_init); 10851da177e4SLinus Torvalds 10861da177e4SLinus Torvalds /* format is: noisapnp */ 10871da177e4SLinus Torvalds 10881da177e4SLinus Torvalds static int __init isapnp_setup_disable(char *str) 10891da177e4SLinus Torvalds { 10901da177e4SLinus Torvalds isapnp_disable = 1; 10911da177e4SLinus Torvalds return 1; 10921da177e4SLinus Torvalds } 10931da177e4SLinus Torvalds 10941da177e4SLinus Torvalds __setup("noisapnp", isapnp_setup_disable); 10951da177e4SLinus Torvalds 10961da177e4SLinus Torvalds /* format is: isapnp=rdp,reset,skip_pci_scan,verbose */ 10971da177e4SLinus Torvalds 10981da177e4SLinus Torvalds static int __init isapnp_setup_isapnp(char *str) 10991da177e4SLinus Torvalds { 11001da177e4SLinus Torvalds (void)((get_option(&str, &isapnp_rdp) == 2) && 11011da177e4SLinus Torvalds (get_option(&str, &isapnp_reset) == 2) && 11021da177e4SLinus Torvalds (get_option(&str, &isapnp_verbose) == 2)); 11031da177e4SLinus Torvalds return 1; 11041da177e4SLinus Torvalds } 11051da177e4SLinus Torvalds 11061da177e4SLinus Torvalds __setup("isapnp=", isapnp_setup_isapnp); 1107