1a3be63b3SDoug Rabson /*- 2a3be63b3SDoug Rabson * Copyright (c) 1999 Doug Rabson 3a3be63b3SDoug Rabson * All rights reserved. 4a3be63b3SDoug Rabson * 5a3be63b3SDoug Rabson * Redistribution and use in source and binary forms, with or without 6a3be63b3SDoug Rabson * modification, are permitted provided that the following conditions 7a3be63b3SDoug Rabson * are met: 8a3be63b3SDoug Rabson * 1. Redistributions of source code must retain the above copyright 9a3be63b3SDoug Rabson * notice, this list of conditions and the following disclaimer. 10a3be63b3SDoug Rabson * 2. Redistributions in binary form must reproduce the above copyright 11a3be63b3SDoug Rabson * notice, this list of conditions and the following disclaimer in the 12a3be63b3SDoug Rabson * documentation and/or other materials provided with the distribution. 13a3be63b3SDoug Rabson * 14a3be63b3SDoug Rabson * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15a3be63b3SDoug Rabson * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16a3be63b3SDoug Rabson * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17a3be63b3SDoug Rabson * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18a3be63b3SDoug Rabson * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19a3be63b3SDoug Rabson * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20a3be63b3SDoug Rabson * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21a3be63b3SDoug Rabson * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22a3be63b3SDoug Rabson * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23a3be63b3SDoug Rabson * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24a3be63b3SDoug Rabson * SUCH DAMAGE. 25a3be63b3SDoug Rabson * 26c3aac50fSPeter Wemm * $FreeBSD$ 27a3be63b3SDoug Rabson */ 28a3be63b3SDoug Rabson /* 29a3be63b3SDoug Rabson * Modifications for Intel architecture by Garrett A. Wollman. 30a3be63b3SDoug Rabson * Copyright 1998 Massachusetts Institute of Technology 31a3be63b3SDoug Rabson * 32a3be63b3SDoug Rabson * Permission to use, copy, modify, and distribute this software and 33a3be63b3SDoug Rabson * its documentation for any purpose and without fee is hereby 34a3be63b3SDoug Rabson * granted, provided that both the above copyright notice and this 35a3be63b3SDoug Rabson * permission notice appear in all copies, that both the above 36a3be63b3SDoug Rabson * copyright notice and this permission notice appear in all 37a3be63b3SDoug Rabson * supporting documentation, and that the name of M.I.T. not be used 38a3be63b3SDoug Rabson * in advertising or publicity pertaining to distribution of the 39a3be63b3SDoug Rabson * software without specific, written prior permission. M.I.T. makes 40a3be63b3SDoug Rabson * no representations about the suitability of this software for any 41a3be63b3SDoug Rabson * purpose. It is provided "as is" without express or implied 42a3be63b3SDoug Rabson * warranty. 43a3be63b3SDoug Rabson * 44a3be63b3SDoug Rabson * THIS SOFTWARE IS PROVIDED BY M.I.T. ``AS IS''. M.I.T. DISCLAIMS 45a3be63b3SDoug Rabson * ALL EXPRESS OR IMPLIED WARRANTIES WITH REGARD TO THIS SOFTWARE, 46a3be63b3SDoug Rabson * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF 47a3be63b3SDoug Rabson * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE. IN NO EVENT 48a3be63b3SDoug Rabson * SHALL M.I.T. BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 49a3be63b3SDoug Rabson * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 50a3be63b3SDoug Rabson * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF 51a3be63b3SDoug Rabson * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND 52a3be63b3SDoug Rabson * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 53a3be63b3SDoug Rabson * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT 54a3be63b3SDoug Rabson * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 55a3be63b3SDoug Rabson * SUCH DAMAGE. 56a3be63b3SDoug Rabson */ 57a3be63b3SDoug Rabson 58a3be63b3SDoug Rabson /* 59a3be63b3SDoug Rabson * Parts of the ISA bus implementation common to all architectures. 60a3be63b3SDoug Rabson */ 61a3be63b3SDoug Rabson 62a3be63b3SDoug Rabson #include <sys/param.h> 63a3be63b3SDoug Rabson #include <sys/systm.h> 64a3be63b3SDoug Rabson #include <sys/kernel.h> 65a3be63b3SDoug Rabson #include <sys/bus.h> 66a3be63b3SDoug Rabson #include <sys/malloc.h> 67a3be63b3SDoug Rabson #include <sys/module.h> 68a3be63b3SDoug Rabson #include <machine/bus.h> 69a3be63b3SDoug Rabson #include <sys/rman.h> 70a3be63b3SDoug Rabson 71a3be63b3SDoug Rabson #include <machine/resource.h> 72a3be63b3SDoug Rabson 73a3be63b3SDoug Rabson #include <isa/isavar.h> 74a3be63b3SDoug Rabson #include <isa/isa_common.h> 75a3be63b3SDoug Rabson #ifdef __alpha__ /* XXX workaround a stupid warning */ 76a3be63b3SDoug Rabson #include <alpha/isa/isavar.h> 77a3be63b3SDoug Rabson #endif 78a3be63b3SDoug Rabson 79a3be63b3SDoug Rabson MALLOC_DEFINE(M_ISADEV, "isadev", "ISA device"); 80a3be63b3SDoug Rabson 81a3be63b3SDoug Rabson static devclass_t isa_devclass; 82a3be63b3SDoug Rabson 83a3be63b3SDoug Rabson /* 84a3be63b3SDoug Rabson * At 'probe' time, we add all the devices which we know about to the 85a3be63b3SDoug Rabson * bus. The generic attach routine will probe and attach them if they 86a3be63b3SDoug Rabson * are alive. 87a3be63b3SDoug Rabson */ 88a3be63b3SDoug Rabson static int 89a3be63b3SDoug Rabson isa_probe(device_t dev) 90a3be63b3SDoug Rabson { 91a3be63b3SDoug Rabson device_set_desc(dev, "ISA bus"); 92a3be63b3SDoug Rabson isa_init(); /* Allow machdep code to initialise */ 93a3be63b3SDoug Rabson return bus_generic_probe(dev); 94a3be63b3SDoug Rabson } 95a3be63b3SDoug Rabson 96a3be63b3SDoug Rabson extern device_t isa_bus_device; 97a3be63b3SDoug Rabson 98a3be63b3SDoug Rabson static int 99a3be63b3SDoug Rabson isa_attach(device_t dev) 100a3be63b3SDoug Rabson { 101a3be63b3SDoug Rabson /* 1024249382dSDoug Rabson * Arrange for isa_probe_children(dev) to be called later. XXX 103a3be63b3SDoug Rabson */ 104a3be63b3SDoug Rabson isa_bus_device = dev; 105a3be63b3SDoug Rabson return 0; 106a3be63b3SDoug Rabson } 107a3be63b3SDoug Rabson 108a3be63b3SDoug Rabson /* 1094249382dSDoug Rabson * Find a working set of memory regions for a child using the ranges 1104249382dSDoug Rabson * in *config and return the regions in *result. Returns non-zero if 1114249382dSDoug Rabson * a set of ranges was found. 1124249382dSDoug Rabson */ 1134249382dSDoug Rabson static int 1144249382dSDoug Rabson isa_find_memory(device_t child, 1154249382dSDoug Rabson struct isa_config *config, 1164249382dSDoug Rabson struct isa_config *result) 1174249382dSDoug Rabson { 1184249382dSDoug Rabson device_t dev = device_get_parent(child); 1194249382dSDoug Rabson int success, i; 1204249382dSDoug Rabson struct resource *res[ISA_NMEM]; 1214249382dSDoug Rabson 1224249382dSDoug Rabson /* 1234249382dSDoug Rabson * First clear out any existing resource definitions. 1244249382dSDoug Rabson */ 1254249382dSDoug Rabson for (i = 0; i < ISA_NMEM; i++) { 1264249382dSDoug Rabson ISA_DELETE_RESOURCE(dev, child, SYS_RES_MEMORY, i); 1274249382dSDoug Rabson res[i] = NULL; 1284249382dSDoug Rabson } 1294249382dSDoug Rabson 1304249382dSDoug Rabson success = 1; 1314249382dSDoug Rabson result->ic_nmem = config->ic_nmem; 1324249382dSDoug Rabson for (i = 0; i < config->ic_nmem; i++) { 1334249382dSDoug Rabson u_int32_t start, end, size, align; 1344249382dSDoug Rabson for (start = config->ic_mem[i].ir_start, 1354249382dSDoug Rabson end = config->ic_mem[i].ir_end, 1364249382dSDoug Rabson size = config->ic_mem[i].ir_size, 1374249382dSDoug Rabson align = config->ic_mem[i].ir_align; 1384249382dSDoug Rabson start + size - 1 <= end; 1394249382dSDoug Rabson start += align) { 1404249382dSDoug Rabson ISA_SET_RESOURCE(dev, child, SYS_RES_MEMORY, i, 1414249382dSDoug Rabson start, size); 1424249382dSDoug Rabson res[i] = bus_alloc_resource(child, 1434249382dSDoug Rabson SYS_RES_MEMORY, &i, 1444249382dSDoug Rabson 0, ~0, 1, RF_ACTIVE); 1454249382dSDoug Rabson if (res[i]) { 1464249382dSDoug Rabson result->ic_mem[i].ir_start = start; 1474249382dSDoug Rabson result->ic_mem[i].ir_end = start + size - 1; 1484249382dSDoug Rabson result->ic_mem[i].ir_size = size; 1494249382dSDoug Rabson result->ic_mem[i].ir_align = align; 1504249382dSDoug Rabson break; 1514249382dSDoug Rabson } 1524249382dSDoug Rabson } 1534249382dSDoug Rabson 1544249382dSDoug Rabson /* 1554249382dSDoug Rabson * If we didn't find a place for memory range i, then 1564249382dSDoug Rabson * give up now. 1574249382dSDoug Rabson */ 1584249382dSDoug Rabson if (!res[i]) { 1594249382dSDoug Rabson success = 0; 1604249382dSDoug Rabson break; 1614249382dSDoug Rabson } 1624249382dSDoug Rabson } 1634249382dSDoug Rabson 1644249382dSDoug Rabson for (i = 0; i < ISA_NMEM; i++) { 1654249382dSDoug Rabson if (res[i]) 1664249382dSDoug Rabson bus_release_resource(child, SYS_RES_MEMORY, 1674249382dSDoug Rabson i, res[i]); 1684249382dSDoug Rabson } 1694249382dSDoug Rabson 1704249382dSDoug Rabson return success; 1714249382dSDoug Rabson } 1724249382dSDoug Rabson 1734249382dSDoug Rabson /* 1744249382dSDoug Rabson * Find a working set of port regions for a child using the ranges 1754249382dSDoug Rabson * in *config and return the regions in *result. Returns non-zero if 1764249382dSDoug Rabson * a set of ranges was found. 1774249382dSDoug Rabson */ 1784249382dSDoug Rabson static int 1794249382dSDoug Rabson isa_find_port(device_t child, 1804249382dSDoug Rabson struct isa_config *config, 1814249382dSDoug Rabson struct isa_config *result) 1824249382dSDoug Rabson { 1834249382dSDoug Rabson device_t dev = device_get_parent(child); 1844249382dSDoug Rabson int success, i; 1854249382dSDoug Rabson struct resource *res[ISA_NPORT]; 1864249382dSDoug Rabson 1874249382dSDoug Rabson /* 1884249382dSDoug Rabson * First clear out any existing resource definitions. 1894249382dSDoug Rabson */ 1904249382dSDoug Rabson for (i = 0; i < ISA_NPORT; i++) { 1914249382dSDoug Rabson ISA_DELETE_RESOURCE(dev, child, SYS_RES_IOPORT, i); 1924249382dSDoug Rabson res[i] = NULL; 1934249382dSDoug Rabson } 1944249382dSDoug Rabson 1954249382dSDoug Rabson success = 1; 1964249382dSDoug Rabson result->ic_nport = config->ic_nport; 1974249382dSDoug Rabson for (i = 0; i < config->ic_nport; i++) { 1984249382dSDoug Rabson u_int32_t start, end, size, align; 1994249382dSDoug Rabson for (start = config->ic_port[i].ir_start, 2004249382dSDoug Rabson end = config->ic_port[i].ir_end, 2014249382dSDoug Rabson size = config->ic_port[i].ir_size, 2024249382dSDoug Rabson align = config->ic_port[i].ir_align; 2034249382dSDoug Rabson start + size - 1 <= end; 2044249382dSDoug Rabson start += align) { 2054249382dSDoug Rabson ISA_SET_RESOURCE(dev, child, SYS_RES_IOPORT, i, 2064249382dSDoug Rabson start, size); 2074249382dSDoug Rabson res[i] = bus_alloc_resource(child, 2084249382dSDoug Rabson SYS_RES_IOPORT, &i, 2094249382dSDoug Rabson 0, ~0, 1, RF_ACTIVE); 2104249382dSDoug Rabson if (res[i]) { 2114249382dSDoug Rabson result->ic_port[i].ir_start = start; 2124249382dSDoug Rabson result->ic_port[i].ir_end = start + size - 1; 2134249382dSDoug Rabson result->ic_port[i].ir_size = size; 2144249382dSDoug Rabson result->ic_port[i].ir_align = align; 2154249382dSDoug Rabson break; 2164249382dSDoug Rabson } 2174249382dSDoug Rabson } 2184249382dSDoug Rabson 2194249382dSDoug Rabson /* 2204249382dSDoug Rabson * If we didn't find a place for port range i, then 2214249382dSDoug Rabson * give up now. 2224249382dSDoug Rabson */ 2234249382dSDoug Rabson if (!res[i]) { 2244249382dSDoug Rabson success = 0; 2254249382dSDoug Rabson break; 2264249382dSDoug Rabson } 2274249382dSDoug Rabson } 2284249382dSDoug Rabson 2294249382dSDoug Rabson for (i = 0; i < ISA_NPORT; i++) { 2304249382dSDoug Rabson if (res[i]) 2314249382dSDoug Rabson bus_release_resource(child, SYS_RES_IOPORT, 2324249382dSDoug Rabson i, res[i]); 2334249382dSDoug Rabson } 2344249382dSDoug Rabson 2354249382dSDoug Rabson return success; 2364249382dSDoug Rabson } 2374249382dSDoug Rabson 2384249382dSDoug Rabson /* 2394249382dSDoug Rabson * Return the index of the first bit in the mask (or -1 if mask is empty. 2404249382dSDoug Rabson */ 2414249382dSDoug Rabson static int 2424249382dSDoug Rabson find_first_bit(u_int32_t mask) 2434249382dSDoug Rabson { 2444249382dSDoug Rabson return ffs(mask) - 1; 2454249382dSDoug Rabson } 2464249382dSDoug Rabson 2474249382dSDoug Rabson /* 2484249382dSDoug Rabson * Return the index of the next bit in the mask, or -1 if there are no more. 2494249382dSDoug Rabson */ 2504249382dSDoug Rabson static int 2514249382dSDoug Rabson find_next_bit(u_int32_t mask, int bit) 2524249382dSDoug Rabson { 2534249382dSDoug Rabson bit++; 2544249382dSDoug Rabson while (bit < 32 && !(mask & (1 << bit))) 2554249382dSDoug Rabson bit++; 2564249382dSDoug Rabson if (bit != 32) 2574249382dSDoug Rabson return bit; 2584249382dSDoug Rabson return -1; 2594249382dSDoug Rabson } 2604249382dSDoug Rabson 2614249382dSDoug Rabson /* 2624249382dSDoug Rabson * Find a working set of irqs for a child using the masks in *config 2634249382dSDoug Rabson * and return the regions in *result. Returns non-zero if a set of 2644249382dSDoug Rabson * irqs was found. 2654249382dSDoug Rabson */ 2664249382dSDoug Rabson static int 2674249382dSDoug Rabson isa_find_irq(device_t child, 2684249382dSDoug Rabson struct isa_config *config, 2694249382dSDoug Rabson struct isa_config *result) 2704249382dSDoug Rabson { 2714249382dSDoug Rabson device_t dev = device_get_parent(child); 2724249382dSDoug Rabson int success, i; 2734249382dSDoug Rabson struct resource *res[ISA_NIRQ]; 2744249382dSDoug Rabson 2754249382dSDoug Rabson /* 2764249382dSDoug Rabson * First clear out any existing resource definitions. 2774249382dSDoug Rabson */ 2784249382dSDoug Rabson for (i = 0; i < ISA_NIRQ; i++) { 2794249382dSDoug Rabson ISA_DELETE_RESOURCE(dev, child, SYS_RES_IRQ, i); 2804249382dSDoug Rabson res[i] = NULL; 2814249382dSDoug Rabson } 2824249382dSDoug Rabson 2834249382dSDoug Rabson success = 1; 2844249382dSDoug Rabson result->ic_nirq = config->ic_nirq; 2854249382dSDoug Rabson for (i = 0; i < config->ic_nirq; i++) { 2864249382dSDoug Rabson u_int32_t mask = config->ic_irqmask[i]; 2874249382dSDoug Rabson int irq; 2884249382dSDoug Rabson for (irq = find_first_bit(mask); 2894249382dSDoug Rabson irq != -1; 2904249382dSDoug Rabson irq = find_next_bit(mask, irq)) { 2914249382dSDoug Rabson ISA_SET_RESOURCE(dev, child, SYS_RES_IRQ, i, 2924249382dSDoug Rabson irq, 1); 2934249382dSDoug Rabson res[i] = bus_alloc_resource(child, 2944249382dSDoug Rabson SYS_RES_IRQ, &i, 2954249382dSDoug Rabson 0, ~0, 1, RF_ACTIVE); 2964249382dSDoug Rabson if (res[i]) { 2974249382dSDoug Rabson result->ic_irqmask[i] = (1 << irq); 2984249382dSDoug Rabson break; 2994249382dSDoug Rabson } 3004249382dSDoug Rabson } 3014249382dSDoug Rabson 3024249382dSDoug Rabson /* 3034249382dSDoug Rabson * If we didn't find a place for irq range i, then 3044249382dSDoug Rabson * give up now. 3054249382dSDoug Rabson */ 3064249382dSDoug Rabson if (!res[i]) { 3074249382dSDoug Rabson success = 0; 3084249382dSDoug Rabson break; 3094249382dSDoug Rabson } 3104249382dSDoug Rabson } 3114249382dSDoug Rabson 3124249382dSDoug Rabson for (i = 0; i < ISA_NIRQ; i++) { 3134249382dSDoug Rabson if (res[i]) 3144249382dSDoug Rabson bus_release_resource(child, SYS_RES_IRQ, 3154249382dSDoug Rabson i, res[i]); 3164249382dSDoug Rabson } 3174249382dSDoug Rabson 3184249382dSDoug Rabson return success; 3194249382dSDoug Rabson } 3204249382dSDoug Rabson 3214249382dSDoug Rabson /* 3224249382dSDoug Rabson * Find a working set of drqs for a child using the masks in *config 3234249382dSDoug Rabson * and return the regions in *result. Returns non-zero if a set of 3244249382dSDoug Rabson * drqs was found. 3254249382dSDoug Rabson */ 3264249382dSDoug Rabson static int 3274249382dSDoug Rabson isa_find_drq(device_t child, 3284249382dSDoug Rabson struct isa_config *config, 3294249382dSDoug Rabson struct isa_config *result) 3304249382dSDoug Rabson { 3314249382dSDoug Rabson device_t dev = device_get_parent(child); 3324249382dSDoug Rabson int success, i; 3334249382dSDoug Rabson struct resource *res[ISA_NDRQ]; 3344249382dSDoug Rabson 3354249382dSDoug Rabson /* 3364249382dSDoug Rabson * First clear out any existing resource definitions. 3374249382dSDoug Rabson */ 3384249382dSDoug Rabson for (i = 0; i < ISA_NDRQ; i++) { 3394249382dSDoug Rabson ISA_DELETE_RESOURCE(dev, child, SYS_RES_DRQ, i); 3404249382dSDoug Rabson res[i] = NULL; 3414249382dSDoug Rabson } 3424249382dSDoug Rabson 3434249382dSDoug Rabson success = 1; 3444249382dSDoug Rabson result->ic_ndrq = config->ic_ndrq; 3454249382dSDoug Rabson for (i = 0; i < config->ic_ndrq; i++) { 3464249382dSDoug Rabson u_int32_t mask = config->ic_drqmask[i]; 3474249382dSDoug Rabson int drq; 3484249382dSDoug Rabson for (drq = find_first_bit(mask); 3494249382dSDoug Rabson drq != -1; 3504249382dSDoug Rabson drq = find_next_bit(mask, drq)) { 3514249382dSDoug Rabson ISA_SET_RESOURCE(dev, child, SYS_RES_DRQ, i, 3524249382dSDoug Rabson drq, 1); 3534249382dSDoug Rabson res[i] = bus_alloc_resource(child, 3544249382dSDoug Rabson SYS_RES_DRQ, &i, 3554249382dSDoug Rabson 0, ~0, 1, RF_ACTIVE); 3564249382dSDoug Rabson if (res[i]) { 3574249382dSDoug Rabson result->ic_drqmask[i] = (1 << drq); 3584249382dSDoug Rabson break; 3594249382dSDoug Rabson } 3604249382dSDoug Rabson } 3614249382dSDoug Rabson 3624249382dSDoug Rabson /* 3634249382dSDoug Rabson * If we didn't find a place for drq range i, then 3644249382dSDoug Rabson * give up now. 3654249382dSDoug Rabson */ 3664249382dSDoug Rabson if (!res[i]) { 3674249382dSDoug Rabson success = 0; 3684249382dSDoug Rabson break; 3694249382dSDoug Rabson } 3704249382dSDoug Rabson } 3714249382dSDoug Rabson 3724249382dSDoug Rabson for (i = 0; i < ISA_NDRQ; i++) { 3734249382dSDoug Rabson if (res[i]) 3744249382dSDoug Rabson bus_release_resource(child, SYS_RES_DRQ, 3754249382dSDoug Rabson i, res[i]); 3764249382dSDoug Rabson } 3774249382dSDoug Rabson 3784249382dSDoug Rabson return success; 3794249382dSDoug Rabson } 3804249382dSDoug Rabson 3814249382dSDoug Rabson /* 3824249382dSDoug Rabson * Attempt to find a working set of resources for a device. Return 3834249382dSDoug Rabson * non-zero if a working configuration is found. 3844249382dSDoug Rabson */ 3854249382dSDoug Rabson static int 3864249382dSDoug Rabson isa_assign_resources(device_t child) 3874249382dSDoug Rabson { 3884249382dSDoug Rabson struct isa_device *idev = DEVTOISA(child); 3894249382dSDoug Rabson struct isa_config_entry *ice; 3904249382dSDoug Rabson struct isa_config config; 3914249382dSDoug Rabson 3924249382dSDoug Rabson bzero(&config, sizeof config); 3934249382dSDoug Rabson TAILQ_FOREACH(ice, &idev->id_configs, ice_link) { 3944249382dSDoug Rabson if (!isa_find_memory(child, &ice->ice_config, &config)) 3954249382dSDoug Rabson continue; 3964249382dSDoug Rabson if (!isa_find_port(child, &ice->ice_config, &config)) 3974249382dSDoug Rabson continue; 3984249382dSDoug Rabson if (!isa_find_irq(child, &ice->ice_config, &config)) 3994249382dSDoug Rabson continue; 4004249382dSDoug Rabson if (!isa_find_drq(child, &ice->ice_config, &config)) 4014249382dSDoug Rabson continue; 4024249382dSDoug Rabson 4034249382dSDoug Rabson /* 4044249382dSDoug Rabson * A working configuration was found enable the device 4054249382dSDoug Rabson * with this configuration. 4064249382dSDoug Rabson */ 4074249382dSDoug Rabson if (idev->id_config_cb) { 4084249382dSDoug Rabson idev->id_config_cb(idev->id_config_arg, 4094249382dSDoug Rabson &config, 1); 4104249382dSDoug Rabson return 1; 4114249382dSDoug Rabson } 4124249382dSDoug Rabson } 4134249382dSDoug Rabson 4144249382dSDoug Rabson /* 4154249382dSDoug Rabson * Disable the device. 4164249382dSDoug Rabson */ 4174249382dSDoug Rabson bzero(&config, sizeof config); 4184249382dSDoug Rabson if (idev->id_config_cb) 4194249382dSDoug Rabson idev->id_config_cb(idev->id_config_arg, &config, 0); 4204249382dSDoug Rabson device_disable(child); 4214249382dSDoug Rabson 4224249382dSDoug Rabson return 0; 4234249382dSDoug Rabson } 4244249382dSDoug Rabson 4254249382dSDoug Rabson /* 4264249382dSDoug Rabson * Called after other devices have initialised to probe for isa devices. 4274249382dSDoug Rabson */ 4284249382dSDoug Rabson void 4294249382dSDoug Rabson isa_probe_children(device_t dev) 4304249382dSDoug Rabson { 4314249382dSDoug Rabson device_t *children; 4324249382dSDoug Rabson int nchildren, i; 4334249382dSDoug Rabson 4344249382dSDoug Rabson if (device_get_children(dev, &children, &nchildren)) 4354249382dSDoug Rabson return; 4364249382dSDoug Rabson 4374249382dSDoug Rabson /* 438a2e6dbb3SDoug Rabson * First disable all pnp devices so that they don't get 439a2e6dbb3SDoug Rabson * matched by legacy probes. 440a2e6dbb3SDoug Rabson */ 441a2e6dbb3SDoug Rabson for (i = 0; i < nchildren; i++) { 442a2e6dbb3SDoug Rabson device_t child = children[i]; 443a2e6dbb3SDoug Rabson struct isa_device *idev = DEVTOISA(child); 444a2e6dbb3SDoug Rabson struct isa_config config; 445a2e6dbb3SDoug Rabson 446a2e6dbb3SDoug Rabson bzero(&config, sizeof config); 447a2e6dbb3SDoug Rabson if (idev->id_config_cb) 448a2e6dbb3SDoug Rabson idev->id_config_cb(idev->id_config_arg, &config, 0); 449a2e6dbb3SDoug Rabson } 450a2e6dbb3SDoug Rabson 451a2e6dbb3SDoug Rabson /* 452a2e6dbb3SDoug Rabson * Next probe all non-pnp devices so that they claim their 4534249382dSDoug Rabson * resources first. 4544249382dSDoug Rabson */ 4554249382dSDoug Rabson for (i = 0; i < nchildren; i++) { 4564249382dSDoug Rabson device_t child = children[i]; 4574249382dSDoug Rabson struct isa_device *idev = DEVTOISA(child); 4584249382dSDoug Rabson 4594249382dSDoug Rabson if (TAILQ_FIRST(&idev->id_configs)) 4604249382dSDoug Rabson continue; 4614249382dSDoug Rabson 4624249382dSDoug Rabson device_probe_and_attach(child); 4634249382dSDoug Rabson } 4644249382dSDoug Rabson 4654249382dSDoug Rabson /* 466a2e6dbb3SDoug Rabson * Finally assign resource to pnp devices and probe them. 4674249382dSDoug Rabson */ 4684249382dSDoug Rabson for (i = 0; i < nchildren; i++) { 4694249382dSDoug Rabson device_t child = children[i]; 4704249382dSDoug Rabson struct isa_device* idev = DEVTOISA(child); 4714249382dSDoug Rabson 4724249382dSDoug Rabson if (!TAILQ_FIRST(&idev->id_configs)) 4734249382dSDoug Rabson continue; 4744249382dSDoug Rabson 4754249382dSDoug Rabson if (isa_assign_resources(child)) { 4764249382dSDoug Rabson struct resource_list_entry *rle; 4774249382dSDoug Rabson 4784249382dSDoug Rabson device_probe_and_attach(child); 4794249382dSDoug Rabson 4804249382dSDoug Rabson /* 4814249382dSDoug Rabson * Claim any unallocated resources to keep other 4824249382dSDoug Rabson * devices from using them. 4834249382dSDoug Rabson */ 4844249382dSDoug Rabson SLIST_FOREACH(rle, &idev->id_resources, link) { 4854249382dSDoug Rabson if (!rle->res) { 4864249382dSDoug Rabson int rid = rle->rid; 4874249382dSDoug Rabson resource_list_alloc(dev, child, 4884249382dSDoug Rabson rle->type, 4894249382dSDoug Rabson &rid, 4904249382dSDoug Rabson 0, ~0, 1, 4914249382dSDoug Rabson RF_ACTIVE); 4924249382dSDoug Rabson } 4934249382dSDoug Rabson } 4944249382dSDoug Rabson } 4954249382dSDoug Rabson } 4964249382dSDoug Rabson 4974249382dSDoug Rabson free(children, M_TEMP); 4984249382dSDoug Rabson } 4994249382dSDoug Rabson 5004249382dSDoug Rabson /* 501a3be63b3SDoug Rabson * Add a new child with default ivars. 502a3be63b3SDoug Rabson */ 503a3be63b3SDoug Rabson static device_t 504bea6af4dSDoug Rabson isa_add_child(device_t dev, int order, const char *name, int unit) 505a3be63b3SDoug Rabson { 506a3be63b3SDoug Rabson struct isa_device *idev; 507a3be63b3SDoug Rabson 508a3be63b3SDoug Rabson idev = malloc(sizeof(struct isa_device), M_ISADEV, M_NOWAIT); 509a3be63b3SDoug Rabson if (!idev) 510a3be63b3SDoug Rabson return 0; 511a3be63b3SDoug Rabson bzero(idev, sizeof *idev); 512a3be63b3SDoug Rabson 513a3be63b3SDoug Rabson resource_list_init(&idev->id_resources); 5144249382dSDoug Rabson TAILQ_INIT(&idev->id_configs); 515a3be63b3SDoug Rabson 516bea6af4dSDoug Rabson return device_add_child_ordered(dev, order, name, unit, idev); 517a3be63b3SDoug Rabson } 518a3be63b3SDoug Rabson 519a3be63b3SDoug Rabson static void 520a3be63b3SDoug Rabson isa_print_resources(struct resource_list *rl, const char *name, int type, 521a3be63b3SDoug Rabson const char *format) 522a3be63b3SDoug Rabson { 5234249382dSDoug Rabson struct resource_list_entry *rle; 5244249382dSDoug Rabson int printed; 5254249382dSDoug Rabson int i; 526a3be63b3SDoug Rabson 5274249382dSDoug Rabson printed = 0; 5284249382dSDoug Rabson for (i = 0; i < 16; i++) { 5294249382dSDoug Rabson rle = resource_list_find(rl, type, i); 5304249382dSDoug Rabson if (rle) { 5314249382dSDoug Rabson if (printed == 0) 532a3be63b3SDoug Rabson printf(" %s ", name); 5334249382dSDoug Rabson else if (printed > 0) 534a3be63b3SDoug Rabson printf(","); 5354249382dSDoug Rabson printed++; 5364249382dSDoug Rabson printf(format, rle->start); 5374249382dSDoug Rabson if (rle->count > 1) { 538a3be63b3SDoug Rabson printf("-"); 5394249382dSDoug Rabson printf(format, rle->start + rle->count - 1); 540a3be63b3SDoug Rabson } 5414249382dSDoug Rabson } else if (i > 3) { 5424249382dSDoug Rabson /* check the first few regardless */ 5434249382dSDoug Rabson break; 544a3be63b3SDoug Rabson } 545a3be63b3SDoug Rabson } 546a3be63b3SDoug Rabson } 547a3be63b3SDoug Rabson 54815317dd8SMatthew N. Dodd static int 549a3be63b3SDoug Rabson isa_print_child(device_t bus, device_t dev) 550a3be63b3SDoug Rabson { 551a3be63b3SDoug Rabson struct isa_device *idev = DEVTOISA(dev); 552a3be63b3SDoug Rabson struct resource_list *rl = &idev->id_resources; 55315317dd8SMatthew N. Dodd int retval = 0; 55415317dd8SMatthew N. Dodd 55515317dd8SMatthew N. Dodd retval += bus_print_child_header(bus, dev); 556a3be63b3SDoug Rabson 557062acdb7SDoug Rabson if (SLIST_FIRST(rl) || device_get_flags(dev)) 55815317dd8SMatthew N. Dodd retval += printf(" at"); 559a3be63b3SDoug Rabson 560f4e3b1e7SMatthew N. Dodd isa_print_resources(rl, "port", SYS_RES_IOPORT, "%#lx"); 561f4e3b1e7SMatthew N. Dodd isa_print_resources(rl, "iomem", SYS_RES_MEMORY, "%#lx"); 562f4e3b1e7SMatthew N. Dodd isa_print_resources(rl, "irq", SYS_RES_IRQ, "%ld"); 563f4e3b1e7SMatthew N. Dodd isa_print_resources(rl, "drq", SYS_RES_DRQ, "%ld"); 564062acdb7SDoug Rabson if (device_get_flags(dev)) 565062acdb7SDoug Rabson retval += printf(" flags %#x", device_get_flags(dev)); 566a3be63b3SDoug Rabson 56715317dd8SMatthew N. Dodd retval += bus_print_child_footer(bus, dev); 56815317dd8SMatthew N. Dodd 56915317dd8SMatthew N. Dodd return (retval); 570a3be63b3SDoug Rabson } 571a3be63b3SDoug Rabson 572a3be63b3SDoug Rabson static int 573a3be63b3SDoug Rabson isa_read_ivar(device_t bus, device_t dev, int index, uintptr_t * result) 574a3be63b3SDoug Rabson { 575a3be63b3SDoug Rabson struct isa_device* idev = DEVTOISA(dev); 576a3be63b3SDoug Rabson struct resource_list *rl = &idev->id_resources; 577a3be63b3SDoug Rabson struct resource_list_entry *rle; 578a3be63b3SDoug Rabson 579a3be63b3SDoug Rabson switch (index) { 580a3be63b3SDoug Rabson case ISA_IVAR_PORT_0: 581a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IOPORT, 0); 582a3be63b3SDoug Rabson if (rle) 583a3be63b3SDoug Rabson *result = rle->start; 584a3be63b3SDoug Rabson else 585a3be63b3SDoug Rabson *result = -1; 586a3be63b3SDoug Rabson break; 587a3be63b3SDoug Rabson 588a3be63b3SDoug Rabson case ISA_IVAR_PORT_1: 589a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IOPORT, 1); 590a3be63b3SDoug Rabson if (rle) 591a3be63b3SDoug Rabson *result = rle->start; 592a3be63b3SDoug Rabson else 593a3be63b3SDoug Rabson *result = -1; 594a3be63b3SDoug Rabson break; 595a3be63b3SDoug Rabson 596a3be63b3SDoug Rabson case ISA_IVAR_PORTSIZE_0: 597a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IOPORT, 0); 598a3be63b3SDoug Rabson if (rle) 599a3be63b3SDoug Rabson *result = rle->count; 600a3be63b3SDoug Rabson else 601a3be63b3SDoug Rabson *result = 0; 602a3be63b3SDoug Rabson break; 603a3be63b3SDoug Rabson 604a3be63b3SDoug Rabson case ISA_IVAR_PORTSIZE_1: 605a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IOPORT, 1); 606a3be63b3SDoug Rabson if (rle) 607a3be63b3SDoug Rabson *result = rle->count; 608a3be63b3SDoug Rabson else 609a3be63b3SDoug Rabson *result = 0; 610a3be63b3SDoug Rabson break; 611a3be63b3SDoug Rabson 612a3be63b3SDoug Rabson case ISA_IVAR_MADDR_0: 613a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_MEMORY, 0); 614a3be63b3SDoug Rabson if (rle) 615a3be63b3SDoug Rabson *result = rle->start; 616a3be63b3SDoug Rabson else 617a3be63b3SDoug Rabson *result = -1; 618a3be63b3SDoug Rabson break; 619a3be63b3SDoug Rabson 620a3be63b3SDoug Rabson case ISA_IVAR_MADDR_1: 621a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_MEMORY, 1); 622a3be63b3SDoug Rabson if (rle) 623a3be63b3SDoug Rabson *result = rle->start; 624a3be63b3SDoug Rabson else 625a3be63b3SDoug Rabson *result = -1; 626a3be63b3SDoug Rabson break; 627a3be63b3SDoug Rabson 628a3be63b3SDoug Rabson case ISA_IVAR_MSIZE_0: 629a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_MEMORY, 0); 630a3be63b3SDoug Rabson if (rle) 631a3be63b3SDoug Rabson *result = rle->count; 632a3be63b3SDoug Rabson else 633a3be63b3SDoug Rabson *result = 0; 634a3be63b3SDoug Rabson break; 635a3be63b3SDoug Rabson 636a3be63b3SDoug Rabson case ISA_IVAR_MSIZE_1: 637a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_MEMORY, 1); 638a3be63b3SDoug Rabson if (rle) 639a3be63b3SDoug Rabson *result = rle->count; 640a3be63b3SDoug Rabson else 641a3be63b3SDoug Rabson *result = 0; 642a3be63b3SDoug Rabson break; 643a3be63b3SDoug Rabson 644a3be63b3SDoug Rabson case ISA_IVAR_IRQ_0: 645a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IRQ, 0); 646a3be63b3SDoug Rabson if (rle) 647a3be63b3SDoug Rabson *result = rle->start; 648a3be63b3SDoug Rabson else 649a3be63b3SDoug Rabson *result = -1; 650a3be63b3SDoug Rabson break; 651a3be63b3SDoug Rabson 652a3be63b3SDoug Rabson case ISA_IVAR_IRQ_1: 653a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IRQ, 1); 654a3be63b3SDoug Rabson if (rle) 655a3be63b3SDoug Rabson *result = rle->start; 656a3be63b3SDoug Rabson else 657a3be63b3SDoug Rabson *result = -1; 658a3be63b3SDoug Rabson break; 659a3be63b3SDoug Rabson 660a3be63b3SDoug Rabson case ISA_IVAR_DRQ_0: 661a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_DRQ, 0); 662a3be63b3SDoug Rabson if (rle) 663a3be63b3SDoug Rabson *result = rle->start; 664a3be63b3SDoug Rabson else 665a3be63b3SDoug Rabson *result = -1; 666a3be63b3SDoug Rabson break; 667a3be63b3SDoug Rabson 668a3be63b3SDoug Rabson case ISA_IVAR_DRQ_1: 669a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_DRQ, 1); 670a3be63b3SDoug Rabson if (rle) 671a3be63b3SDoug Rabson *result = rle->start; 672a3be63b3SDoug Rabson else 673a3be63b3SDoug Rabson *result = -1; 674a3be63b3SDoug Rabson break; 675a3be63b3SDoug Rabson 676cfa84f46SDoug Rabson case ISA_IVAR_VENDORID: 677cfa84f46SDoug Rabson *result = idev->id_vendorid; 678cfa84f46SDoug Rabson break; 679cfa84f46SDoug Rabson 680cfa84f46SDoug Rabson case ISA_IVAR_SERIAL: 681cfa84f46SDoug Rabson *result = idev->id_serial; 682cfa84f46SDoug Rabson break; 683cfa84f46SDoug Rabson 684cfa84f46SDoug Rabson case ISA_IVAR_LOGICALID: 685cfa84f46SDoug Rabson *result = idev->id_logicalid; 686cfa84f46SDoug Rabson break; 687cfa84f46SDoug Rabson 688cfa84f46SDoug Rabson case ISA_IVAR_COMPATID: 689cfa84f46SDoug Rabson *result = idev->id_compatid; 690cfa84f46SDoug Rabson break; 691cfa84f46SDoug Rabson 692cfa84f46SDoug Rabson default: 693a3be63b3SDoug Rabson return ENOENT; 694a3be63b3SDoug Rabson } 695a3be63b3SDoug Rabson 696cfa84f46SDoug Rabson return 0; 697cfa84f46SDoug Rabson } 698cfa84f46SDoug Rabson 699a3be63b3SDoug Rabson static int 700a3be63b3SDoug Rabson isa_write_ivar(device_t bus, device_t dev, 701a3be63b3SDoug Rabson int index, uintptr_t value) 702a3be63b3SDoug Rabson { 703a3be63b3SDoug Rabson struct isa_device* idev = DEVTOISA(dev); 704a3be63b3SDoug Rabson 705a3be63b3SDoug Rabson switch (index) { 706a3be63b3SDoug Rabson case ISA_IVAR_PORT_0: 707a3be63b3SDoug Rabson case ISA_IVAR_PORT_1: 708a3be63b3SDoug Rabson case ISA_IVAR_PORTSIZE_0: 709a3be63b3SDoug Rabson case ISA_IVAR_PORTSIZE_1: 710a3be63b3SDoug Rabson case ISA_IVAR_MADDR_0: 711a3be63b3SDoug Rabson case ISA_IVAR_MADDR_1: 712a3be63b3SDoug Rabson case ISA_IVAR_MSIZE_0: 713a3be63b3SDoug Rabson case ISA_IVAR_MSIZE_1: 714a3be63b3SDoug Rabson case ISA_IVAR_IRQ_0: 715a3be63b3SDoug Rabson case ISA_IVAR_IRQ_1: 716a3be63b3SDoug Rabson case ISA_IVAR_DRQ_0: 717a3be63b3SDoug Rabson case ISA_IVAR_DRQ_1: 718a3be63b3SDoug Rabson return EINVAL; 719a3be63b3SDoug Rabson 720cfa84f46SDoug Rabson case ISA_IVAR_VENDORID: 721cfa84f46SDoug Rabson idev->id_vendorid = value; 722cfa84f46SDoug Rabson break; 723cfa84f46SDoug Rabson 724cfa84f46SDoug Rabson case ISA_IVAR_SERIAL: 725cfa84f46SDoug Rabson idev->id_serial = value; 726cfa84f46SDoug Rabson break; 727cfa84f46SDoug Rabson 728cfa84f46SDoug Rabson case ISA_IVAR_LOGICALID: 729cfa84f46SDoug Rabson idev->id_logicalid = value; 730cfa84f46SDoug Rabson break; 731cfa84f46SDoug Rabson 732cfa84f46SDoug Rabson case ISA_IVAR_COMPATID: 733cfa84f46SDoug Rabson idev->id_compatid = value; 734cfa84f46SDoug Rabson break; 735cfa84f46SDoug Rabson 736a3be63b3SDoug Rabson default: 737a3be63b3SDoug Rabson return (ENOENT); 738a3be63b3SDoug Rabson } 739cfa84f46SDoug Rabson 740a3be63b3SDoug Rabson return (0); 741a3be63b3SDoug Rabson } 742a3be63b3SDoug Rabson 7434249382dSDoug Rabson /* 7444249382dSDoug Rabson * Free any resources which the driver missed or which we were holding for 7454249382dSDoug Rabson * it (see isa_probe_children). 7464249382dSDoug Rabson */ 7474249382dSDoug Rabson static void 7484249382dSDoug Rabson isa_child_detached(device_t dev, device_t child) 7494249382dSDoug Rabson { 7504249382dSDoug Rabson struct isa_device* idev = DEVTOISA(child); 7514249382dSDoug Rabson struct resource_list_entry *rle; 7524249382dSDoug Rabson 7534249382dSDoug Rabson SLIST_FOREACH(rle, &idev->id_resources, link) { 7544249382dSDoug Rabson if (rle->res) 7554249382dSDoug Rabson resource_list_release(dev, child, 7564249382dSDoug Rabson rle->type, 7574249382dSDoug Rabson rle->rid, 7584249382dSDoug Rabson rle->res); 7594249382dSDoug Rabson } 7604249382dSDoug Rabson } 7614249382dSDoug Rabson 762a3be63b3SDoug Rabson static int 763a3be63b3SDoug Rabson isa_set_resource(device_t dev, device_t child, int type, int rid, 764a3be63b3SDoug Rabson u_long start, u_long count) 765a3be63b3SDoug Rabson { 766a3be63b3SDoug Rabson struct isa_device* idev = DEVTOISA(child); 767a3be63b3SDoug Rabson struct resource_list *rl = &idev->id_resources; 768a3be63b3SDoug Rabson 769a3be63b3SDoug Rabson if (type != SYS_RES_IOPORT && type != SYS_RES_MEMORY 770a3be63b3SDoug Rabson && type != SYS_RES_IRQ && type != SYS_RES_DRQ) 771a3be63b3SDoug Rabson return EINVAL; 7724249382dSDoug Rabson if (rid < 0) 7734249382dSDoug Rabson return EINVAL; 7744249382dSDoug Rabson if (type == SYS_RES_IOPORT && rid >= ISA_NPORT) 7754249382dSDoug Rabson return EINVAL; 7764249382dSDoug Rabson if (type == SYS_RES_MEMORY && rid >= ISA_NMEM) 7774249382dSDoug Rabson return EINVAL; 7784249382dSDoug Rabson if (type == SYS_RES_IRQ && rid >= ISA_NIRQ) 7794249382dSDoug Rabson return EINVAL; 7804249382dSDoug Rabson if (type == SYS_RES_DRQ && rid >= ISA_NDRQ) 781a3be63b3SDoug Rabson return EINVAL; 782a3be63b3SDoug Rabson 783a3be63b3SDoug Rabson resource_list_add(rl, type, rid, start, start + count - 1, count); 784a3be63b3SDoug Rabson 785a3be63b3SDoug Rabson return 0; 786a3be63b3SDoug Rabson } 787a3be63b3SDoug Rabson 788a3be63b3SDoug Rabson static int 789a3be63b3SDoug Rabson isa_get_resource(device_t dev, device_t child, int type, int rid, 790a3be63b3SDoug Rabson u_long *startp, u_long *countp) 791a3be63b3SDoug Rabson { 792a3be63b3SDoug Rabson struct isa_device* idev = DEVTOISA(child); 793a3be63b3SDoug Rabson struct resource_list *rl = &idev->id_resources; 794a3be63b3SDoug Rabson struct resource_list_entry *rle; 795a3be63b3SDoug Rabson 796a3be63b3SDoug Rabson rle = resource_list_find(rl, type, rid); 797a3be63b3SDoug Rabson if (!rle) 798a3be63b3SDoug Rabson return ENOENT; 799a3be63b3SDoug Rabson 800a3be63b3SDoug Rabson *startp = rle->start; 801a3be63b3SDoug Rabson *countp = rle->count; 802a3be63b3SDoug Rabson 803a3be63b3SDoug Rabson return 0; 804a3be63b3SDoug Rabson } 805a3be63b3SDoug Rabson 806cfa84f46SDoug Rabson static void 807cfa84f46SDoug Rabson isa_delete_resource(device_t dev, device_t child, int type, int rid) 808cfa84f46SDoug Rabson { 809cfa84f46SDoug Rabson struct isa_device* idev = DEVTOISA(child); 810cfa84f46SDoug Rabson struct resource_list *rl = &idev->id_resources; 811cfa84f46SDoug Rabson resource_list_delete(rl, type, rid); 812cfa84f46SDoug Rabson } 813cfa84f46SDoug Rabson 8144249382dSDoug Rabson static int 8154249382dSDoug Rabson isa_add_config(device_t dev, device_t child, 8164249382dSDoug Rabson int priority, struct isa_config *config) 8174249382dSDoug Rabson { 8184249382dSDoug Rabson struct isa_device* idev = DEVTOISA(child); 8194249382dSDoug Rabson struct isa_config_entry *newice, *ice; 8204249382dSDoug Rabson 8214249382dSDoug Rabson newice = malloc(sizeof *ice, M_DEVBUF, M_NOWAIT); 8224249382dSDoug Rabson if (!newice) 8234249382dSDoug Rabson return ENOMEM; 8244249382dSDoug Rabson 8254249382dSDoug Rabson newice->ice_priority = priority; 8264249382dSDoug Rabson newice->ice_config = *config; 8274249382dSDoug Rabson 8284249382dSDoug Rabson TAILQ_FOREACH(ice, &idev->id_configs, ice_link) { 8294249382dSDoug Rabson if (ice->ice_priority > priority) 8304249382dSDoug Rabson break; 8314249382dSDoug Rabson } 8324249382dSDoug Rabson if (ice) 8334249382dSDoug Rabson TAILQ_INSERT_BEFORE(ice, newice, ice_link); 8344249382dSDoug Rabson else 8354249382dSDoug Rabson TAILQ_INSERT_TAIL(&idev->id_configs, newice, ice_link); 8364249382dSDoug Rabson 8374249382dSDoug Rabson return 0; 8384249382dSDoug Rabson } 8394249382dSDoug Rabson 8404249382dSDoug Rabson static void 8414249382dSDoug Rabson isa_set_config_callback(device_t dev, device_t child, 8424249382dSDoug Rabson isa_config_cb *fn, void *arg) 8434249382dSDoug Rabson { 8444249382dSDoug Rabson struct isa_device* idev = DEVTOISA(child); 8454249382dSDoug Rabson 8464249382dSDoug Rabson idev->id_config_cb = fn; 8474249382dSDoug Rabson idev->id_config_arg = arg; 8484249382dSDoug Rabson } 8494249382dSDoug Rabson 8504249382dSDoug Rabson static int 8514249382dSDoug Rabson isa_pnp_probe(device_t dev, device_t child, struct isa_pnp_id *ids) 8524249382dSDoug Rabson { 8534249382dSDoug Rabson struct isa_device* idev = DEVTOISA(child); 8544249382dSDoug Rabson 8554249382dSDoug Rabson if (!idev->id_vendorid) 8564249382dSDoug Rabson return ENOENT; 8574249382dSDoug Rabson 8584249382dSDoug Rabson while (ids->ip_id) { 8594249382dSDoug Rabson /* 8604249382dSDoug Rabson * Really ought to support >1 compat id per device. 8614249382dSDoug Rabson */ 8624249382dSDoug Rabson if (idev->id_logicalid == ids->ip_id 8634249382dSDoug Rabson || idev->id_compatid == ids->ip_id) { 8642aadbbb6SDoug Rabson if (ids->ip_desc) 8654249382dSDoug Rabson device_set_desc(child, ids->ip_desc); 8664249382dSDoug Rabson return 0; 8674249382dSDoug Rabson } 8684249382dSDoug Rabson ids++; 8694249382dSDoug Rabson } 8704249382dSDoug Rabson 8714249382dSDoug Rabson return ENXIO; 8724249382dSDoug Rabson } 8734249382dSDoug Rabson 874a3be63b3SDoug Rabson static device_method_t isa_methods[] = { 875a3be63b3SDoug Rabson /* Device interface */ 876a3be63b3SDoug Rabson DEVMETHOD(device_probe, isa_probe), 877a3be63b3SDoug Rabson DEVMETHOD(device_attach, isa_attach), 878a3be63b3SDoug Rabson DEVMETHOD(device_detach, bus_generic_detach), 879a3be63b3SDoug Rabson DEVMETHOD(device_shutdown, bus_generic_shutdown), 880a3be63b3SDoug Rabson DEVMETHOD(device_suspend, bus_generic_suspend), 881a3be63b3SDoug Rabson DEVMETHOD(device_resume, bus_generic_resume), 882a3be63b3SDoug Rabson 883a3be63b3SDoug Rabson /* Bus interface */ 884a3be63b3SDoug Rabson DEVMETHOD(bus_add_child, isa_add_child), 885a3be63b3SDoug Rabson DEVMETHOD(bus_print_child, isa_print_child), 886a3be63b3SDoug Rabson DEVMETHOD(bus_read_ivar, isa_read_ivar), 887a3be63b3SDoug Rabson DEVMETHOD(bus_write_ivar, isa_write_ivar), 8884249382dSDoug Rabson DEVMETHOD(bus_child_detached, isa_child_detached), 889a3be63b3SDoug Rabson DEVMETHOD(bus_alloc_resource, isa_alloc_resource), 890a3be63b3SDoug Rabson DEVMETHOD(bus_release_resource, isa_release_resource), 891a3be63b3SDoug Rabson DEVMETHOD(bus_activate_resource, bus_generic_activate_resource), 892a3be63b3SDoug Rabson DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource), 893a3be63b3SDoug Rabson DEVMETHOD(bus_setup_intr, isa_setup_intr), 894a3be63b3SDoug Rabson DEVMETHOD(bus_teardown_intr, isa_teardown_intr), 895a3be63b3SDoug Rabson 896a3be63b3SDoug Rabson /* ISA interface */ 897a3be63b3SDoug Rabson DEVMETHOD(isa_set_resource, isa_set_resource), 898a3be63b3SDoug Rabson DEVMETHOD(isa_get_resource, isa_get_resource), 899cfa84f46SDoug Rabson DEVMETHOD(isa_delete_resource, isa_delete_resource), 9004249382dSDoug Rabson DEVMETHOD(isa_add_config, isa_add_config), 9014249382dSDoug Rabson DEVMETHOD(isa_set_config_callback, isa_set_config_callback), 9024249382dSDoug Rabson DEVMETHOD(isa_pnp_probe, isa_pnp_probe), 903a3be63b3SDoug Rabson 904a3be63b3SDoug Rabson { 0, 0 } 905a3be63b3SDoug Rabson }; 906a3be63b3SDoug Rabson 907a3be63b3SDoug Rabson static driver_t isa_driver = { 908a3be63b3SDoug Rabson "isa", 909a3be63b3SDoug Rabson isa_methods, 910a3be63b3SDoug Rabson 1, /* no softc */ 911a3be63b3SDoug Rabson }; 912a3be63b3SDoug Rabson 913a3be63b3SDoug Rabson /* 914a3be63b3SDoug Rabson * ISA can be attached to a PCI-ISA bridge or directly to the nexus. 915a3be63b3SDoug Rabson */ 916a3be63b3SDoug Rabson DRIVER_MODULE(isa, isab, isa_driver, isa_devclass, 0, 0); 917a3be63b3SDoug Rabson #ifdef __i386__ 918a3be63b3SDoug Rabson DRIVER_MODULE(isa, nexus, isa_driver, isa_devclass, 0, 0); 919a3be63b3SDoug Rabson #endif 9204249382dSDoug Rabson 9214249382dSDoug Rabson /* 9224249382dSDoug Rabson * A fallback driver for reporting un-matched pnp devices. 9234249382dSDoug Rabson */ 9244249382dSDoug Rabson 9254249382dSDoug Rabson static int 9264249382dSDoug Rabson unknown_probe(device_t dev) 9274249382dSDoug Rabson { 9284249382dSDoug Rabson /* 9294249382dSDoug Rabson * Only match pnp devices. 9304249382dSDoug Rabson */ 9314249382dSDoug Rabson if (isa_get_vendorid(dev) != 0) 9324249382dSDoug Rabson return -100; 9334249382dSDoug Rabson return ENXIO; 9344249382dSDoug Rabson } 9354249382dSDoug Rabson 9364249382dSDoug Rabson static int 9374249382dSDoug Rabson unknown_attach(device_t dev) 9384249382dSDoug Rabson { 9394249382dSDoug Rabson return 0; 9404249382dSDoug Rabson } 9414249382dSDoug Rabson 9424249382dSDoug Rabson static int 9434249382dSDoug Rabson unknown_detach(device_t dev) 9444249382dSDoug Rabson { 9454249382dSDoug Rabson return 0; 9464249382dSDoug Rabson } 9474249382dSDoug Rabson 9484249382dSDoug Rabson static device_method_t unknown_methods[] = { 9494249382dSDoug Rabson /* Device interface */ 9504249382dSDoug Rabson DEVMETHOD(device_probe, unknown_probe), 9514249382dSDoug Rabson DEVMETHOD(device_attach, unknown_attach), 9524249382dSDoug Rabson DEVMETHOD(device_detach, unknown_detach), 9534249382dSDoug Rabson 9544249382dSDoug Rabson { 0, 0 } 9554249382dSDoug Rabson }; 9564249382dSDoug Rabson 9574249382dSDoug Rabson static driver_t unknown_driver = { 9584249382dSDoug Rabson "unknown", 9594249382dSDoug Rabson unknown_methods, 9604249382dSDoug Rabson 1, /* no softc */ 9614249382dSDoug Rabson }; 9624249382dSDoug Rabson 9634249382dSDoug Rabson static devclass_t unknown_devclass; 9644249382dSDoug Rabson 9654249382dSDoug Rabson DRIVER_MODULE(unknown, isa, unknown_driver, unknown_devclass, 0, 0); 966