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 int success, i; 1194249382dSDoug Rabson struct resource *res[ISA_NMEM]; 1204249382dSDoug Rabson 1214249382dSDoug Rabson /* 1224249382dSDoug Rabson * First clear out any existing resource definitions. 1234249382dSDoug Rabson */ 1244249382dSDoug Rabson for (i = 0; i < ISA_NMEM; i++) { 12525afb89bSDoug Rabson bus_delete_resource(child, SYS_RES_MEMORY, i); 1264249382dSDoug Rabson res[i] = NULL; 1274249382dSDoug Rabson } 1284249382dSDoug Rabson 1294249382dSDoug Rabson success = 1; 1304249382dSDoug Rabson result->ic_nmem = config->ic_nmem; 1314249382dSDoug Rabson for (i = 0; i < config->ic_nmem; i++) { 1324249382dSDoug Rabson u_int32_t start, end, size, align; 1334249382dSDoug Rabson for (start = config->ic_mem[i].ir_start, 1344249382dSDoug Rabson end = config->ic_mem[i].ir_end, 1354249382dSDoug Rabson size = config->ic_mem[i].ir_size, 1364249382dSDoug Rabson align = config->ic_mem[i].ir_align; 1374249382dSDoug Rabson start + size - 1 <= end; 1384249382dSDoug Rabson start += align) { 13925afb89bSDoug Rabson bus_set_resource(child, SYS_RES_MEMORY, i, 1404249382dSDoug Rabson start, size); 1414249382dSDoug Rabson res[i] = bus_alloc_resource(child, 1424249382dSDoug Rabson SYS_RES_MEMORY, &i, 1434249382dSDoug Rabson 0, ~0, 1, RF_ACTIVE); 1444249382dSDoug Rabson if (res[i]) { 1454249382dSDoug Rabson result->ic_mem[i].ir_start = start; 1464249382dSDoug Rabson result->ic_mem[i].ir_end = start + size - 1; 1474249382dSDoug Rabson result->ic_mem[i].ir_size = size; 1484249382dSDoug Rabson result->ic_mem[i].ir_align = align; 1494249382dSDoug Rabson break; 1504249382dSDoug Rabson } 1514249382dSDoug Rabson } 1524249382dSDoug Rabson 1534249382dSDoug Rabson /* 1544249382dSDoug Rabson * If we didn't find a place for memory range i, then 1554249382dSDoug Rabson * give up now. 1564249382dSDoug Rabson */ 1574249382dSDoug Rabson if (!res[i]) { 1584249382dSDoug Rabson success = 0; 1594249382dSDoug Rabson break; 1604249382dSDoug Rabson } 1614249382dSDoug Rabson } 1624249382dSDoug Rabson 1634249382dSDoug Rabson for (i = 0; i < ISA_NMEM; i++) { 1644249382dSDoug Rabson if (res[i]) 1654249382dSDoug Rabson bus_release_resource(child, SYS_RES_MEMORY, 1664249382dSDoug Rabson i, res[i]); 1674249382dSDoug Rabson } 1684249382dSDoug Rabson 1694249382dSDoug Rabson return success; 1704249382dSDoug Rabson } 1714249382dSDoug Rabson 1724249382dSDoug Rabson /* 1734249382dSDoug Rabson * Find a working set of port regions for a child using the ranges 1744249382dSDoug Rabson * in *config and return the regions in *result. Returns non-zero if 1754249382dSDoug Rabson * a set of ranges was found. 1764249382dSDoug Rabson */ 1774249382dSDoug Rabson static int 1784249382dSDoug Rabson isa_find_port(device_t child, 1794249382dSDoug Rabson struct isa_config *config, 1804249382dSDoug Rabson struct isa_config *result) 1814249382dSDoug Rabson { 1824249382dSDoug Rabson int success, i; 1834249382dSDoug Rabson struct resource *res[ISA_NPORT]; 1844249382dSDoug Rabson 1854249382dSDoug Rabson /* 1864249382dSDoug Rabson * First clear out any existing resource definitions. 1874249382dSDoug Rabson */ 1884249382dSDoug Rabson for (i = 0; i < ISA_NPORT; i++) { 18925afb89bSDoug Rabson bus_delete_resource(child, SYS_RES_IOPORT, i); 1904249382dSDoug Rabson res[i] = NULL; 1914249382dSDoug Rabson } 1924249382dSDoug Rabson 1934249382dSDoug Rabson success = 1; 1944249382dSDoug Rabson result->ic_nport = config->ic_nport; 1954249382dSDoug Rabson for (i = 0; i < config->ic_nport; i++) { 1964249382dSDoug Rabson u_int32_t start, end, size, align; 1974249382dSDoug Rabson for (start = config->ic_port[i].ir_start, 1984249382dSDoug Rabson end = config->ic_port[i].ir_end, 1994249382dSDoug Rabson size = config->ic_port[i].ir_size, 2004249382dSDoug Rabson align = config->ic_port[i].ir_align; 2014249382dSDoug Rabson start + size - 1 <= end; 2024249382dSDoug Rabson start += align) { 20325afb89bSDoug Rabson bus_set_resource(child, SYS_RES_IOPORT, i, 2044249382dSDoug Rabson start, size); 2054249382dSDoug Rabson res[i] = bus_alloc_resource(child, 2064249382dSDoug Rabson SYS_RES_IOPORT, &i, 2074249382dSDoug Rabson 0, ~0, 1, RF_ACTIVE); 2084249382dSDoug Rabson if (res[i]) { 2094249382dSDoug Rabson result->ic_port[i].ir_start = start; 2104249382dSDoug Rabson result->ic_port[i].ir_end = start + size - 1; 2114249382dSDoug Rabson result->ic_port[i].ir_size = size; 2124249382dSDoug Rabson result->ic_port[i].ir_align = align; 2134249382dSDoug Rabson break; 2144249382dSDoug Rabson } 2154249382dSDoug Rabson } 2164249382dSDoug Rabson 2174249382dSDoug Rabson /* 2184249382dSDoug Rabson * If we didn't find a place for port range i, then 2194249382dSDoug Rabson * give up now. 2204249382dSDoug Rabson */ 2214249382dSDoug Rabson if (!res[i]) { 2224249382dSDoug Rabson success = 0; 2234249382dSDoug Rabson break; 2244249382dSDoug Rabson } 2254249382dSDoug Rabson } 2264249382dSDoug Rabson 2274249382dSDoug Rabson for (i = 0; i < ISA_NPORT; i++) { 2284249382dSDoug Rabson if (res[i]) 2294249382dSDoug Rabson bus_release_resource(child, SYS_RES_IOPORT, 2304249382dSDoug Rabson i, res[i]); 2314249382dSDoug Rabson } 2324249382dSDoug Rabson 2334249382dSDoug Rabson return success; 2344249382dSDoug Rabson } 2354249382dSDoug Rabson 2364249382dSDoug Rabson /* 2374249382dSDoug Rabson * Return the index of the first bit in the mask (or -1 if mask is empty. 2384249382dSDoug Rabson */ 2394249382dSDoug Rabson static int 2404249382dSDoug Rabson find_first_bit(u_int32_t mask) 2414249382dSDoug Rabson { 2424249382dSDoug Rabson return ffs(mask) - 1; 2434249382dSDoug Rabson } 2444249382dSDoug Rabson 2454249382dSDoug Rabson /* 2464249382dSDoug Rabson * Return the index of the next bit in the mask, or -1 if there are no more. 2474249382dSDoug Rabson */ 2484249382dSDoug Rabson static int 2494249382dSDoug Rabson find_next_bit(u_int32_t mask, int bit) 2504249382dSDoug Rabson { 2514249382dSDoug Rabson bit++; 2524249382dSDoug Rabson while (bit < 32 && !(mask & (1 << bit))) 2534249382dSDoug Rabson bit++; 2544249382dSDoug Rabson if (bit != 32) 2554249382dSDoug Rabson return bit; 2564249382dSDoug Rabson return -1; 2574249382dSDoug Rabson } 2584249382dSDoug Rabson 2594249382dSDoug Rabson /* 2604249382dSDoug Rabson * Find a working set of irqs for a child using the masks in *config 2614249382dSDoug Rabson * and return the regions in *result. Returns non-zero if a set of 2624249382dSDoug Rabson * irqs was found. 2634249382dSDoug Rabson */ 2644249382dSDoug Rabson static int 2654249382dSDoug Rabson isa_find_irq(device_t child, 2664249382dSDoug Rabson struct isa_config *config, 2674249382dSDoug Rabson struct isa_config *result) 2684249382dSDoug Rabson { 2694249382dSDoug Rabson int success, i; 2704249382dSDoug Rabson struct resource *res[ISA_NIRQ]; 2714249382dSDoug Rabson 2724249382dSDoug Rabson /* 2734249382dSDoug Rabson * First clear out any existing resource definitions. 2744249382dSDoug Rabson */ 2754249382dSDoug Rabson for (i = 0; i < ISA_NIRQ; i++) { 27625afb89bSDoug Rabson bus_delete_resource(child, SYS_RES_IRQ, i); 2774249382dSDoug Rabson res[i] = NULL; 2784249382dSDoug Rabson } 2794249382dSDoug Rabson 2804249382dSDoug Rabson success = 1; 2814249382dSDoug Rabson result->ic_nirq = config->ic_nirq; 2824249382dSDoug Rabson for (i = 0; i < config->ic_nirq; i++) { 2834249382dSDoug Rabson u_int32_t mask = config->ic_irqmask[i]; 2844249382dSDoug Rabson int irq; 2854249382dSDoug Rabson for (irq = find_first_bit(mask); 2864249382dSDoug Rabson irq != -1; 2874249382dSDoug Rabson irq = find_next_bit(mask, irq)) { 28825afb89bSDoug Rabson bus_set_resource(child, SYS_RES_IRQ, i, 2894249382dSDoug Rabson irq, 1); 2904249382dSDoug Rabson res[i] = bus_alloc_resource(child, 2914249382dSDoug Rabson SYS_RES_IRQ, &i, 2924249382dSDoug Rabson 0, ~0, 1, RF_ACTIVE); 2934249382dSDoug Rabson if (res[i]) { 2944249382dSDoug Rabson result->ic_irqmask[i] = (1 << irq); 2954249382dSDoug Rabson break; 2964249382dSDoug Rabson } 2974249382dSDoug Rabson } 2984249382dSDoug Rabson 2994249382dSDoug Rabson /* 3004249382dSDoug Rabson * If we didn't find a place for irq range i, then 3014249382dSDoug Rabson * give up now. 3024249382dSDoug Rabson */ 3034249382dSDoug Rabson if (!res[i]) { 3044249382dSDoug Rabson success = 0; 3054249382dSDoug Rabson break; 3064249382dSDoug Rabson } 3074249382dSDoug Rabson } 3084249382dSDoug Rabson 3094249382dSDoug Rabson for (i = 0; i < ISA_NIRQ; i++) { 3104249382dSDoug Rabson if (res[i]) 3114249382dSDoug Rabson bus_release_resource(child, SYS_RES_IRQ, 3124249382dSDoug Rabson i, res[i]); 3134249382dSDoug Rabson } 3144249382dSDoug Rabson 3154249382dSDoug Rabson return success; 3164249382dSDoug Rabson } 3174249382dSDoug Rabson 3184249382dSDoug Rabson /* 3194249382dSDoug Rabson * Find a working set of drqs for a child using the masks in *config 3204249382dSDoug Rabson * and return the regions in *result. Returns non-zero if a set of 3214249382dSDoug Rabson * drqs was found. 3224249382dSDoug Rabson */ 3234249382dSDoug Rabson static int 3244249382dSDoug Rabson isa_find_drq(device_t child, 3254249382dSDoug Rabson struct isa_config *config, 3264249382dSDoug Rabson struct isa_config *result) 3274249382dSDoug Rabson { 3284249382dSDoug Rabson int success, i; 3294249382dSDoug Rabson struct resource *res[ISA_NDRQ]; 3304249382dSDoug Rabson 3314249382dSDoug Rabson /* 3324249382dSDoug Rabson * First clear out any existing resource definitions. 3334249382dSDoug Rabson */ 3344249382dSDoug Rabson for (i = 0; i < ISA_NDRQ; i++) { 33525afb89bSDoug Rabson bus_delete_resource(child, SYS_RES_DRQ, i); 3364249382dSDoug Rabson res[i] = NULL; 3374249382dSDoug Rabson } 3384249382dSDoug Rabson 3394249382dSDoug Rabson success = 1; 3404249382dSDoug Rabson result->ic_ndrq = config->ic_ndrq; 3414249382dSDoug Rabson for (i = 0; i < config->ic_ndrq; i++) { 3424249382dSDoug Rabson u_int32_t mask = config->ic_drqmask[i]; 3434249382dSDoug Rabson int drq; 3444249382dSDoug Rabson for (drq = find_first_bit(mask); 3454249382dSDoug Rabson drq != -1; 3464249382dSDoug Rabson drq = find_next_bit(mask, drq)) { 34725afb89bSDoug Rabson bus_set_resource(child, SYS_RES_DRQ, i, 3484249382dSDoug Rabson drq, 1); 3494249382dSDoug Rabson res[i] = bus_alloc_resource(child, 3504249382dSDoug Rabson SYS_RES_DRQ, &i, 3514249382dSDoug Rabson 0, ~0, 1, RF_ACTIVE); 3524249382dSDoug Rabson if (res[i]) { 3534249382dSDoug Rabson result->ic_drqmask[i] = (1 << drq); 3544249382dSDoug Rabson break; 3554249382dSDoug Rabson } 3564249382dSDoug Rabson } 3574249382dSDoug Rabson 3584249382dSDoug Rabson /* 3594249382dSDoug Rabson * If we didn't find a place for drq range i, then 3604249382dSDoug Rabson * give up now. 3614249382dSDoug Rabson */ 3624249382dSDoug Rabson if (!res[i]) { 3634249382dSDoug Rabson success = 0; 3644249382dSDoug Rabson break; 3654249382dSDoug Rabson } 3664249382dSDoug Rabson } 3674249382dSDoug Rabson 3684249382dSDoug Rabson for (i = 0; i < ISA_NDRQ; i++) { 3694249382dSDoug Rabson if (res[i]) 3704249382dSDoug Rabson bus_release_resource(child, SYS_RES_DRQ, 3714249382dSDoug Rabson i, res[i]); 3724249382dSDoug Rabson } 3734249382dSDoug Rabson 3744249382dSDoug Rabson return success; 3754249382dSDoug Rabson } 3764249382dSDoug Rabson 3774249382dSDoug Rabson /* 3784249382dSDoug Rabson * Attempt to find a working set of resources for a device. Return 3794249382dSDoug Rabson * non-zero if a working configuration is found. 3804249382dSDoug Rabson */ 3814249382dSDoug Rabson static int 3824249382dSDoug Rabson isa_assign_resources(device_t child) 3834249382dSDoug Rabson { 3844249382dSDoug Rabson struct isa_device *idev = DEVTOISA(child); 3854249382dSDoug Rabson struct isa_config_entry *ice; 3864249382dSDoug Rabson struct isa_config config; 3874249382dSDoug Rabson 3884249382dSDoug Rabson bzero(&config, sizeof config); 3894249382dSDoug Rabson TAILQ_FOREACH(ice, &idev->id_configs, ice_link) { 3904249382dSDoug Rabson if (!isa_find_memory(child, &ice->ice_config, &config)) 3914249382dSDoug Rabson continue; 3924249382dSDoug Rabson if (!isa_find_port(child, &ice->ice_config, &config)) 3934249382dSDoug Rabson continue; 3944249382dSDoug Rabson if (!isa_find_irq(child, &ice->ice_config, &config)) 3954249382dSDoug Rabson continue; 3964249382dSDoug Rabson if (!isa_find_drq(child, &ice->ice_config, &config)) 3974249382dSDoug Rabson continue; 3984249382dSDoug Rabson 3994249382dSDoug Rabson /* 4004249382dSDoug Rabson * A working configuration was found enable the device 4014249382dSDoug Rabson * with this configuration. 4024249382dSDoug Rabson */ 4034249382dSDoug Rabson if (idev->id_config_cb) { 4044249382dSDoug Rabson idev->id_config_cb(idev->id_config_arg, 4054249382dSDoug Rabson &config, 1); 4064249382dSDoug Rabson return 1; 4074249382dSDoug Rabson } 4084249382dSDoug Rabson } 4094249382dSDoug Rabson 4104249382dSDoug Rabson /* 4114249382dSDoug Rabson * Disable the device. 4124249382dSDoug Rabson */ 41325afb89bSDoug Rabson if (device_get_desc(child)) 41425afb89bSDoug Rabson device_printf(child, "<%s> can't assign resources\n", 41525afb89bSDoug Rabson device_get_desc(child)); 41625afb89bSDoug Rabson else 41725afb89bSDoug Rabson device_printf(child, "can't assign resources\n"); 4184249382dSDoug Rabson bzero(&config, sizeof config); 4194249382dSDoug Rabson if (idev->id_config_cb) 4204249382dSDoug Rabson idev->id_config_cb(idev->id_config_arg, &config, 0); 4214249382dSDoug Rabson device_disable(child); 4224249382dSDoug Rabson 4234249382dSDoug Rabson return 0; 4244249382dSDoug Rabson } 4254249382dSDoug Rabson 4264249382dSDoug Rabson /* 4274249382dSDoug Rabson * Called after other devices have initialised to probe for isa devices. 4284249382dSDoug Rabson */ 4294249382dSDoug Rabson void 4304249382dSDoug Rabson isa_probe_children(device_t dev) 4314249382dSDoug Rabson { 4324249382dSDoug Rabson device_t *children; 4334249382dSDoug Rabson int nchildren, i; 4344249382dSDoug Rabson 4354249382dSDoug Rabson if (device_get_children(dev, &children, &nchildren)) 4364249382dSDoug Rabson return; 4374249382dSDoug Rabson 4384249382dSDoug Rabson /* 439a2e6dbb3SDoug Rabson * First disable all pnp devices so that they don't get 440a2e6dbb3SDoug Rabson * matched by legacy probes. 441a2e6dbb3SDoug Rabson */ 442a2e6dbb3SDoug Rabson for (i = 0; i < nchildren; i++) { 443a2e6dbb3SDoug Rabson device_t child = children[i]; 444a2e6dbb3SDoug Rabson struct isa_device *idev = DEVTOISA(child); 445a2e6dbb3SDoug Rabson struct isa_config config; 446a2e6dbb3SDoug Rabson 447a2e6dbb3SDoug Rabson bzero(&config, sizeof config); 448a2e6dbb3SDoug Rabson if (idev->id_config_cb) 449a2e6dbb3SDoug Rabson idev->id_config_cb(idev->id_config_arg, &config, 0); 450a2e6dbb3SDoug Rabson } 451a2e6dbb3SDoug Rabson 452a2e6dbb3SDoug Rabson /* 453a2e6dbb3SDoug Rabson * Next probe all non-pnp devices so that they claim their 4544249382dSDoug Rabson * resources first. 4554249382dSDoug Rabson */ 4564249382dSDoug Rabson for (i = 0; i < nchildren; i++) { 4574249382dSDoug Rabson device_t child = children[i]; 4584249382dSDoug Rabson struct isa_device *idev = DEVTOISA(child); 4594249382dSDoug Rabson 4604249382dSDoug Rabson if (TAILQ_FIRST(&idev->id_configs)) 4614249382dSDoug Rabson continue; 4624249382dSDoug Rabson 4634249382dSDoug Rabson device_probe_and_attach(child); 4644249382dSDoug Rabson } 4654249382dSDoug Rabson 4664249382dSDoug Rabson /* 467a2e6dbb3SDoug Rabson * Finally assign resource to pnp devices and probe them. 4684249382dSDoug Rabson */ 4694249382dSDoug Rabson for (i = 0; i < nchildren; i++) { 4704249382dSDoug Rabson device_t child = children[i]; 4714249382dSDoug Rabson struct isa_device* idev = DEVTOISA(child); 4724249382dSDoug Rabson 4734249382dSDoug Rabson if (!TAILQ_FIRST(&idev->id_configs)) 4744249382dSDoug Rabson continue; 4754249382dSDoug Rabson 4764249382dSDoug Rabson if (isa_assign_resources(child)) { 47725afb89bSDoug Rabson struct resource_list *rl = &idev->id_resources; 4784249382dSDoug Rabson struct resource_list_entry *rle; 4794249382dSDoug Rabson 4804249382dSDoug Rabson device_probe_and_attach(child); 4814249382dSDoug Rabson 4824249382dSDoug Rabson /* 4834249382dSDoug Rabson * Claim any unallocated resources to keep other 4844249382dSDoug Rabson * devices from using them. 4854249382dSDoug Rabson */ 48625afb89bSDoug Rabson SLIST_FOREACH(rle, rl, link) { 4874249382dSDoug Rabson if (!rle->res) { 4884249382dSDoug Rabson int rid = rle->rid; 48925afb89bSDoug Rabson resource_list_alloc(rl, dev, child, 4904249382dSDoug Rabson rle->type, 4914249382dSDoug Rabson &rid, 4924249382dSDoug Rabson 0, ~0, 1, 4934249382dSDoug Rabson RF_ACTIVE); 4944249382dSDoug Rabson } 4954249382dSDoug Rabson } 4964249382dSDoug Rabson } 4974249382dSDoug Rabson } 4984249382dSDoug Rabson 4994249382dSDoug Rabson free(children, M_TEMP); 5004249382dSDoug Rabson } 5014249382dSDoug Rabson 5024249382dSDoug Rabson /* 503a3be63b3SDoug Rabson * Add a new child with default ivars. 504a3be63b3SDoug Rabson */ 505a3be63b3SDoug Rabson static device_t 506bea6af4dSDoug Rabson isa_add_child(device_t dev, int order, const char *name, int unit) 507a3be63b3SDoug Rabson { 508a3be63b3SDoug Rabson struct isa_device *idev; 509a3be63b3SDoug Rabson 510a3be63b3SDoug Rabson idev = malloc(sizeof(struct isa_device), M_ISADEV, M_NOWAIT); 511a3be63b3SDoug Rabson if (!idev) 512a3be63b3SDoug Rabson return 0; 513a3be63b3SDoug Rabson bzero(idev, sizeof *idev); 514a3be63b3SDoug Rabson 515a3be63b3SDoug Rabson resource_list_init(&idev->id_resources); 5164249382dSDoug Rabson TAILQ_INIT(&idev->id_configs); 517a3be63b3SDoug Rabson 518bea6af4dSDoug Rabson return device_add_child_ordered(dev, order, name, unit, idev); 519a3be63b3SDoug Rabson } 520a3be63b3SDoug Rabson 521a3be63b3SDoug Rabson static void 522a3be63b3SDoug Rabson isa_print_resources(struct resource_list *rl, const char *name, int type, 52325afb89bSDoug Rabson int count, const char *format) 524a3be63b3SDoug Rabson { 5254249382dSDoug Rabson struct resource_list_entry *rle; 5264249382dSDoug Rabson int printed; 5274249382dSDoug Rabson int i; 528a3be63b3SDoug Rabson 5294249382dSDoug Rabson printed = 0; 53025afb89bSDoug Rabson for (i = 0; i < count; i++) { 5314249382dSDoug Rabson rle = resource_list_find(rl, type, i); 5324249382dSDoug Rabson if (rle) { 5334249382dSDoug Rabson if (printed == 0) 534a3be63b3SDoug Rabson printf(" %s ", name); 5354249382dSDoug Rabson else if (printed > 0) 536a3be63b3SDoug Rabson printf(","); 5374249382dSDoug Rabson printed++; 5384249382dSDoug Rabson printf(format, rle->start); 5394249382dSDoug Rabson if (rle->count > 1) { 540a3be63b3SDoug Rabson printf("-"); 5414249382dSDoug Rabson printf(format, rle->start + rle->count - 1); 542a3be63b3SDoug Rabson } 5434249382dSDoug Rabson } else if (i > 3) { 5444249382dSDoug Rabson /* check the first few regardless */ 5454249382dSDoug Rabson break; 546a3be63b3SDoug Rabson } 547a3be63b3SDoug Rabson } 548a3be63b3SDoug Rabson } 549a3be63b3SDoug Rabson 55015317dd8SMatthew N. Dodd static int 551a3be63b3SDoug Rabson isa_print_child(device_t bus, device_t dev) 552a3be63b3SDoug Rabson { 553a3be63b3SDoug Rabson struct isa_device *idev = DEVTOISA(dev); 554a3be63b3SDoug Rabson struct resource_list *rl = &idev->id_resources; 55515317dd8SMatthew N. Dodd int retval = 0; 55615317dd8SMatthew N. Dodd 55715317dd8SMatthew N. Dodd retval += bus_print_child_header(bus, dev); 558a3be63b3SDoug Rabson 559062acdb7SDoug Rabson if (SLIST_FIRST(rl) || device_get_flags(dev)) 56015317dd8SMatthew N. Dodd retval += printf(" at"); 561a3be63b3SDoug Rabson 56225afb89bSDoug Rabson isa_print_resources(rl, "port", SYS_RES_IOPORT, ISA_NPORT, "%#lx"); 56325afb89bSDoug Rabson isa_print_resources(rl, "iomem", SYS_RES_MEMORY, ISA_NMEM, "%#lx"); 56425afb89bSDoug Rabson isa_print_resources(rl, "irq", SYS_RES_IRQ, ISA_NIRQ, "%ld"); 56525afb89bSDoug Rabson isa_print_resources(rl, "drq", SYS_RES_DRQ, ISA_NDRQ, "%ld"); 566062acdb7SDoug Rabson if (device_get_flags(dev)) 567062acdb7SDoug Rabson retval += printf(" flags %#x", device_get_flags(dev)); 568a3be63b3SDoug Rabson 56915317dd8SMatthew N. Dodd retval += bus_print_child_footer(bus, dev); 57015317dd8SMatthew N. Dodd 57115317dd8SMatthew N. Dodd return (retval); 572a3be63b3SDoug Rabson } 573a3be63b3SDoug Rabson 574a3be63b3SDoug Rabson static int 575a3be63b3SDoug Rabson isa_read_ivar(device_t bus, device_t dev, int index, uintptr_t * result) 576a3be63b3SDoug Rabson { 577a3be63b3SDoug Rabson struct isa_device* idev = DEVTOISA(dev); 578a3be63b3SDoug Rabson struct resource_list *rl = &idev->id_resources; 579a3be63b3SDoug Rabson struct resource_list_entry *rle; 580a3be63b3SDoug Rabson 581a3be63b3SDoug Rabson switch (index) { 582a3be63b3SDoug Rabson case ISA_IVAR_PORT_0: 583a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IOPORT, 0); 584a3be63b3SDoug Rabson if (rle) 585a3be63b3SDoug Rabson *result = rle->start; 586a3be63b3SDoug Rabson else 587a3be63b3SDoug Rabson *result = -1; 588a3be63b3SDoug Rabson break; 589a3be63b3SDoug Rabson 590a3be63b3SDoug Rabson case ISA_IVAR_PORT_1: 591a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IOPORT, 1); 592a3be63b3SDoug Rabson if (rle) 593a3be63b3SDoug Rabson *result = rle->start; 594a3be63b3SDoug Rabson else 595a3be63b3SDoug Rabson *result = -1; 596a3be63b3SDoug Rabson break; 597a3be63b3SDoug Rabson 598a3be63b3SDoug Rabson case ISA_IVAR_PORTSIZE_0: 599a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IOPORT, 0); 600a3be63b3SDoug Rabson if (rle) 601a3be63b3SDoug Rabson *result = rle->count; 602a3be63b3SDoug Rabson else 603a3be63b3SDoug Rabson *result = 0; 604a3be63b3SDoug Rabson break; 605a3be63b3SDoug Rabson 606a3be63b3SDoug Rabson case ISA_IVAR_PORTSIZE_1: 607a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IOPORT, 1); 608a3be63b3SDoug Rabson if (rle) 609a3be63b3SDoug Rabson *result = rle->count; 610a3be63b3SDoug Rabson else 611a3be63b3SDoug Rabson *result = 0; 612a3be63b3SDoug Rabson break; 613a3be63b3SDoug Rabson 614a3be63b3SDoug Rabson case ISA_IVAR_MADDR_0: 615a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_MEMORY, 0); 616a3be63b3SDoug Rabson if (rle) 617a3be63b3SDoug Rabson *result = rle->start; 618a3be63b3SDoug Rabson else 619a3be63b3SDoug Rabson *result = -1; 620a3be63b3SDoug Rabson break; 621a3be63b3SDoug Rabson 622a3be63b3SDoug Rabson case ISA_IVAR_MADDR_1: 623a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_MEMORY, 1); 624a3be63b3SDoug Rabson if (rle) 625a3be63b3SDoug Rabson *result = rle->start; 626a3be63b3SDoug Rabson else 627a3be63b3SDoug Rabson *result = -1; 628a3be63b3SDoug Rabson break; 629a3be63b3SDoug Rabson 630a3be63b3SDoug Rabson case ISA_IVAR_MSIZE_0: 631a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_MEMORY, 0); 632a3be63b3SDoug Rabson if (rle) 633a3be63b3SDoug Rabson *result = rle->count; 634a3be63b3SDoug Rabson else 635a3be63b3SDoug Rabson *result = 0; 636a3be63b3SDoug Rabson break; 637a3be63b3SDoug Rabson 638a3be63b3SDoug Rabson case ISA_IVAR_MSIZE_1: 639a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_MEMORY, 1); 640a3be63b3SDoug Rabson if (rle) 641a3be63b3SDoug Rabson *result = rle->count; 642a3be63b3SDoug Rabson else 643a3be63b3SDoug Rabson *result = 0; 644a3be63b3SDoug Rabson break; 645a3be63b3SDoug Rabson 646a3be63b3SDoug Rabson case ISA_IVAR_IRQ_0: 647a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IRQ, 0); 648a3be63b3SDoug Rabson if (rle) 649a3be63b3SDoug Rabson *result = rle->start; 650a3be63b3SDoug Rabson else 651a3be63b3SDoug Rabson *result = -1; 652a3be63b3SDoug Rabson break; 653a3be63b3SDoug Rabson 654a3be63b3SDoug Rabson case ISA_IVAR_IRQ_1: 655a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IRQ, 1); 656a3be63b3SDoug Rabson if (rle) 657a3be63b3SDoug Rabson *result = rle->start; 658a3be63b3SDoug Rabson else 659a3be63b3SDoug Rabson *result = -1; 660a3be63b3SDoug Rabson break; 661a3be63b3SDoug Rabson 662a3be63b3SDoug Rabson case ISA_IVAR_DRQ_0: 663a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_DRQ, 0); 664a3be63b3SDoug Rabson if (rle) 665a3be63b3SDoug Rabson *result = rle->start; 666a3be63b3SDoug Rabson else 667a3be63b3SDoug Rabson *result = -1; 668a3be63b3SDoug Rabson break; 669a3be63b3SDoug Rabson 670a3be63b3SDoug Rabson case ISA_IVAR_DRQ_1: 671a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_DRQ, 1); 672a3be63b3SDoug Rabson if (rle) 673a3be63b3SDoug Rabson *result = rle->start; 674a3be63b3SDoug Rabson else 675a3be63b3SDoug Rabson *result = -1; 676a3be63b3SDoug Rabson break; 677a3be63b3SDoug Rabson 678cfa84f46SDoug Rabson case ISA_IVAR_VENDORID: 679cfa84f46SDoug Rabson *result = idev->id_vendorid; 680cfa84f46SDoug Rabson break; 681cfa84f46SDoug Rabson 682cfa84f46SDoug Rabson case ISA_IVAR_SERIAL: 683cfa84f46SDoug Rabson *result = idev->id_serial; 684cfa84f46SDoug Rabson break; 685cfa84f46SDoug Rabson 686cfa84f46SDoug Rabson case ISA_IVAR_LOGICALID: 687cfa84f46SDoug Rabson *result = idev->id_logicalid; 688cfa84f46SDoug Rabson break; 689cfa84f46SDoug Rabson 690cfa84f46SDoug Rabson case ISA_IVAR_COMPATID: 691cfa84f46SDoug Rabson *result = idev->id_compatid; 692cfa84f46SDoug Rabson break; 693cfa84f46SDoug Rabson 694cfa84f46SDoug Rabson default: 695a3be63b3SDoug Rabson return ENOENT; 696a3be63b3SDoug Rabson } 697a3be63b3SDoug Rabson 698cfa84f46SDoug Rabson return 0; 699cfa84f46SDoug Rabson } 700cfa84f46SDoug Rabson 701a3be63b3SDoug Rabson static int 702a3be63b3SDoug Rabson isa_write_ivar(device_t bus, device_t dev, 703a3be63b3SDoug Rabson int index, uintptr_t value) 704a3be63b3SDoug Rabson { 705a3be63b3SDoug Rabson struct isa_device* idev = DEVTOISA(dev); 706a3be63b3SDoug Rabson 707a3be63b3SDoug Rabson switch (index) { 708a3be63b3SDoug Rabson case ISA_IVAR_PORT_0: 709a3be63b3SDoug Rabson case ISA_IVAR_PORT_1: 710a3be63b3SDoug Rabson case ISA_IVAR_PORTSIZE_0: 711a3be63b3SDoug Rabson case ISA_IVAR_PORTSIZE_1: 712a3be63b3SDoug Rabson case ISA_IVAR_MADDR_0: 713a3be63b3SDoug Rabson case ISA_IVAR_MADDR_1: 714a3be63b3SDoug Rabson case ISA_IVAR_MSIZE_0: 715a3be63b3SDoug Rabson case ISA_IVAR_MSIZE_1: 716a3be63b3SDoug Rabson case ISA_IVAR_IRQ_0: 717a3be63b3SDoug Rabson case ISA_IVAR_IRQ_1: 718a3be63b3SDoug Rabson case ISA_IVAR_DRQ_0: 719a3be63b3SDoug Rabson case ISA_IVAR_DRQ_1: 720a3be63b3SDoug Rabson return EINVAL; 721a3be63b3SDoug Rabson 722cfa84f46SDoug Rabson case ISA_IVAR_VENDORID: 723cfa84f46SDoug Rabson idev->id_vendorid = value; 724cfa84f46SDoug Rabson break; 725cfa84f46SDoug Rabson 726cfa84f46SDoug Rabson case ISA_IVAR_SERIAL: 727cfa84f46SDoug Rabson idev->id_serial = value; 728cfa84f46SDoug Rabson break; 729cfa84f46SDoug Rabson 730cfa84f46SDoug Rabson case ISA_IVAR_LOGICALID: 731cfa84f46SDoug Rabson idev->id_logicalid = value; 732cfa84f46SDoug Rabson break; 733cfa84f46SDoug Rabson 734cfa84f46SDoug Rabson case ISA_IVAR_COMPATID: 735cfa84f46SDoug Rabson idev->id_compatid = value; 736cfa84f46SDoug Rabson break; 737cfa84f46SDoug Rabson 738a3be63b3SDoug Rabson default: 739a3be63b3SDoug Rabson return (ENOENT); 740a3be63b3SDoug Rabson } 741cfa84f46SDoug Rabson 742a3be63b3SDoug Rabson return (0); 743a3be63b3SDoug Rabson } 744a3be63b3SDoug Rabson 7454249382dSDoug Rabson /* 7464249382dSDoug Rabson * Free any resources which the driver missed or which we were holding for 7474249382dSDoug Rabson * it (see isa_probe_children). 7484249382dSDoug Rabson */ 7494249382dSDoug Rabson static void 7504249382dSDoug Rabson isa_child_detached(device_t dev, device_t child) 7514249382dSDoug Rabson { 7524249382dSDoug Rabson struct isa_device* idev = DEVTOISA(child); 75325afb89bSDoug Rabson struct resource_list *rl = &idev->id_resources; 7544249382dSDoug Rabson struct resource_list_entry *rle; 7554249382dSDoug Rabson 7564249382dSDoug Rabson SLIST_FOREACH(rle, &idev->id_resources, link) { 7574249382dSDoug Rabson if (rle->res) 75825afb89bSDoug Rabson resource_list_release(rl, dev, child, 7594249382dSDoug Rabson rle->type, 7604249382dSDoug Rabson rle->rid, 7614249382dSDoug Rabson rle->res); 7624249382dSDoug Rabson } 7634249382dSDoug Rabson } 7644249382dSDoug Rabson 765a3be63b3SDoug Rabson static int 766a3be63b3SDoug Rabson isa_set_resource(device_t dev, device_t child, int type, int rid, 767a3be63b3SDoug Rabson u_long start, u_long count) 768a3be63b3SDoug Rabson { 769a3be63b3SDoug Rabson struct isa_device* idev = DEVTOISA(child); 770a3be63b3SDoug Rabson struct resource_list *rl = &idev->id_resources; 771a3be63b3SDoug Rabson 772a3be63b3SDoug Rabson if (type != SYS_RES_IOPORT && type != SYS_RES_MEMORY 773a3be63b3SDoug Rabson && type != SYS_RES_IRQ && type != SYS_RES_DRQ) 774a3be63b3SDoug Rabson return EINVAL; 7754249382dSDoug Rabson if (rid < 0) 7764249382dSDoug Rabson return EINVAL; 7774249382dSDoug Rabson if (type == SYS_RES_IOPORT && rid >= ISA_NPORT) 7784249382dSDoug Rabson return EINVAL; 7794249382dSDoug Rabson if (type == SYS_RES_MEMORY && rid >= ISA_NMEM) 7804249382dSDoug Rabson return EINVAL; 7814249382dSDoug Rabson if (type == SYS_RES_IRQ && rid >= ISA_NIRQ) 7824249382dSDoug Rabson return EINVAL; 7834249382dSDoug Rabson if (type == SYS_RES_DRQ && rid >= ISA_NDRQ) 784a3be63b3SDoug Rabson return EINVAL; 785a3be63b3SDoug Rabson 786a3be63b3SDoug Rabson resource_list_add(rl, type, rid, start, start + count - 1, count); 787a3be63b3SDoug Rabson 788a3be63b3SDoug Rabson return 0; 789a3be63b3SDoug Rabson } 790a3be63b3SDoug Rabson 791a3be63b3SDoug Rabson static int 792a3be63b3SDoug Rabson isa_get_resource(device_t dev, device_t child, int type, int rid, 793a3be63b3SDoug Rabson u_long *startp, u_long *countp) 794a3be63b3SDoug Rabson { 795a3be63b3SDoug Rabson struct isa_device* idev = DEVTOISA(child); 796a3be63b3SDoug Rabson struct resource_list *rl = &idev->id_resources; 797a3be63b3SDoug Rabson struct resource_list_entry *rle; 798a3be63b3SDoug Rabson 799a3be63b3SDoug Rabson rle = resource_list_find(rl, type, rid); 800a3be63b3SDoug Rabson if (!rle) 801a3be63b3SDoug Rabson return ENOENT; 802a3be63b3SDoug Rabson 803a3be63b3SDoug Rabson *startp = rle->start; 804a3be63b3SDoug Rabson *countp = rle->count; 805a3be63b3SDoug Rabson 806a3be63b3SDoug Rabson return 0; 807a3be63b3SDoug Rabson } 808a3be63b3SDoug Rabson 809cfa84f46SDoug Rabson static void 810cfa84f46SDoug Rabson isa_delete_resource(device_t dev, device_t child, int type, int rid) 811cfa84f46SDoug Rabson { 812cfa84f46SDoug Rabson struct isa_device* idev = DEVTOISA(child); 813cfa84f46SDoug Rabson struct resource_list *rl = &idev->id_resources; 814cfa84f46SDoug Rabson resource_list_delete(rl, type, rid); 815cfa84f46SDoug Rabson } 816cfa84f46SDoug Rabson 8174249382dSDoug Rabson static int 8184249382dSDoug Rabson isa_add_config(device_t dev, device_t child, 8194249382dSDoug Rabson int priority, struct isa_config *config) 8204249382dSDoug Rabson { 8214249382dSDoug Rabson struct isa_device* idev = DEVTOISA(child); 8224249382dSDoug Rabson struct isa_config_entry *newice, *ice; 8234249382dSDoug Rabson 8244249382dSDoug Rabson newice = malloc(sizeof *ice, M_DEVBUF, M_NOWAIT); 8254249382dSDoug Rabson if (!newice) 8264249382dSDoug Rabson return ENOMEM; 8274249382dSDoug Rabson 8284249382dSDoug Rabson newice->ice_priority = priority; 8294249382dSDoug Rabson newice->ice_config = *config; 8304249382dSDoug Rabson 8314249382dSDoug Rabson TAILQ_FOREACH(ice, &idev->id_configs, ice_link) { 8324249382dSDoug Rabson if (ice->ice_priority > priority) 8334249382dSDoug Rabson break; 8344249382dSDoug Rabson } 8354249382dSDoug Rabson if (ice) 8364249382dSDoug Rabson TAILQ_INSERT_BEFORE(ice, newice, ice_link); 8374249382dSDoug Rabson else 8384249382dSDoug Rabson TAILQ_INSERT_TAIL(&idev->id_configs, newice, ice_link); 8394249382dSDoug Rabson 8404249382dSDoug Rabson return 0; 8414249382dSDoug Rabson } 8424249382dSDoug Rabson 8434249382dSDoug Rabson static void 8444249382dSDoug Rabson isa_set_config_callback(device_t dev, device_t child, 8454249382dSDoug Rabson isa_config_cb *fn, void *arg) 8464249382dSDoug Rabson { 8474249382dSDoug Rabson struct isa_device* idev = DEVTOISA(child); 8484249382dSDoug Rabson 8494249382dSDoug Rabson idev->id_config_cb = fn; 8504249382dSDoug Rabson idev->id_config_arg = arg; 8514249382dSDoug Rabson } 8524249382dSDoug Rabson 8534249382dSDoug Rabson static int 8544249382dSDoug Rabson isa_pnp_probe(device_t dev, device_t child, struct isa_pnp_id *ids) 8554249382dSDoug Rabson { 8564249382dSDoug Rabson struct isa_device* idev = DEVTOISA(child); 8574249382dSDoug Rabson 8584249382dSDoug Rabson if (!idev->id_vendorid) 8594249382dSDoug Rabson return ENOENT; 8604249382dSDoug Rabson 8614249382dSDoug Rabson while (ids->ip_id) { 8624249382dSDoug Rabson /* 8634249382dSDoug Rabson * Really ought to support >1 compat id per device. 8644249382dSDoug Rabson */ 8654249382dSDoug Rabson if (idev->id_logicalid == ids->ip_id 8664249382dSDoug Rabson || idev->id_compatid == ids->ip_id) { 8672aadbbb6SDoug Rabson if (ids->ip_desc) 8684249382dSDoug Rabson device_set_desc(child, ids->ip_desc); 8694249382dSDoug Rabson return 0; 8704249382dSDoug Rabson } 8714249382dSDoug Rabson ids++; 8724249382dSDoug Rabson } 8734249382dSDoug Rabson 8744249382dSDoug Rabson return ENXIO; 8754249382dSDoug Rabson } 8764249382dSDoug Rabson 877a3be63b3SDoug Rabson static device_method_t isa_methods[] = { 878a3be63b3SDoug Rabson /* Device interface */ 879a3be63b3SDoug Rabson DEVMETHOD(device_probe, isa_probe), 880a3be63b3SDoug Rabson DEVMETHOD(device_attach, isa_attach), 881a3be63b3SDoug Rabson DEVMETHOD(device_detach, bus_generic_detach), 882a3be63b3SDoug Rabson DEVMETHOD(device_shutdown, bus_generic_shutdown), 883a3be63b3SDoug Rabson DEVMETHOD(device_suspend, bus_generic_suspend), 884a3be63b3SDoug Rabson DEVMETHOD(device_resume, bus_generic_resume), 885a3be63b3SDoug Rabson 886a3be63b3SDoug Rabson /* Bus interface */ 887a3be63b3SDoug Rabson DEVMETHOD(bus_add_child, isa_add_child), 888a3be63b3SDoug Rabson DEVMETHOD(bus_print_child, isa_print_child), 889a3be63b3SDoug Rabson DEVMETHOD(bus_read_ivar, isa_read_ivar), 890a3be63b3SDoug Rabson DEVMETHOD(bus_write_ivar, isa_write_ivar), 8914249382dSDoug Rabson DEVMETHOD(bus_child_detached, isa_child_detached), 892a3be63b3SDoug Rabson DEVMETHOD(bus_alloc_resource, isa_alloc_resource), 893a3be63b3SDoug Rabson DEVMETHOD(bus_release_resource, isa_release_resource), 894a3be63b3SDoug Rabson DEVMETHOD(bus_activate_resource, bus_generic_activate_resource), 895a3be63b3SDoug Rabson DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource), 896a3be63b3SDoug Rabson DEVMETHOD(bus_setup_intr, isa_setup_intr), 897a3be63b3SDoug Rabson DEVMETHOD(bus_teardown_intr, isa_teardown_intr), 89825afb89bSDoug Rabson DEVMETHOD(bus_set_resource, isa_set_resource), 89925afb89bSDoug Rabson DEVMETHOD(bus_get_resource, isa_get_resource), 90025afb89bSDoug Rabson DEVMETHOD(bus_delete_resource, isa_delete_resource), 901a3be63b3SDoug Rabson 902a3be63b3SDoug Rabson /* ISA interface */ 9034249382dSDoug Rabson DEVMETHOD(isa_add_config, isa_add_config), 9044249382dSDoug Rabson DEVMETHOD(isa_set_config_callback, isa_set_config_callback), 9054249382dSDoug Rabson DEVMETHOD(isa_pnp_probe, isa_pnp_probe), 906a3be63b3SDoug Rabson 907a3be63b3SDoug Rabson { 0, 0 } 908a3be63b3SDoug Rabson }; 909a3be63b3SDoug Rabson 910a3be63b3SDoug Rabson static driver_t isa_driver = { 911a3be63b3SDoug Rabson "isa", 912a3be63b3SDoug Rabson isa_methods, 913a3be63b3SDoug Rabson 1, /* no softc */ 914a3be63b3SDoug Rabson }; 915a3be63b3SDoug Rabson 916a3be63b3SDoug Rabson /* 917a3be63b3SDoug Rabson * ISA can be attached to a PCI-ISA bridge or directly to the nexus. 918a3be63b3SDoug Rabson */ 919a3be63b3SDoug Rabson DRIVER_MODULE(isa, isab, isa_driver, isa_devclass, 0, 0); 920a3be63b3SDoug Rabson #ifdef __i386__ 921a3be63b3SDoug Rabson DRIVER_MODULE(isa, nexus, isa_driver, isa_devclass, 0, 0); 922a3be63b3SDoug Rabson #endif 9234249382dSDoug Rabson 9244249382dSDoug Rabson /* 9254249382dSDoug Rabson * A fallback driver for reporting un-matched pnp devices. 9264249382dSDoug Rabson */ 9274249382dSDoug Rabson 9284249382dSDoug Rabson static int 9294249382dSDoug Rabson unknown_probe(device_t dev) 9304249382dSDoug Rabson { 9314249382dSDoug Rabson /* 9324249382dSDoug Rabson * Only match pnp devices. 9334249382dSDoug Rabson */ 9344249382dSDoug Rabson if (isa_get_vendorid(dev) != 0) 9354249382dSDoug Rabson return -100; 9364249382dSDoug Rabson return ENXIO; 9374249382dSDoug Rabson } 9384249382dSDoug Rabson 9394249382dSDoug Rabson static int 9404249382dSDoug Rabson unknown_attach(device_t dev) 9414249382dSDoug Rabson { 9424249382dSDoug Rabson return 0; 9434249382dSDoug Rabson } 9444249382dSDoug Rabson 9454249382dSDoug Rabson static int 9464249382dSDoug Rabson unknown_detach(device_t dev) 9474249382dSDoug Rabson { 9484249382dSDoug Rabson return 0; 9494249382dSDoug Rabson } 9504249382dSDoug Rabson 9514249382dSDoug Rabson static device_method_t unknown_methods[] = { 9524249382dSDoug Rabson /* Device interface */ 9534249382dSDoug Rabson DEVMETHOD(device_probe, unknown_probe), 9544249382dSDoug Rabson DEVMETHOD(device_attach, unknown_attach), 9554249382dSDoug Rabson DEVMETHOD(device_detach, unknown_detach), 9564249382dSDoug Rabson 9574249382dSDoug Rabson { 0, 0 } 9584249382dSDoug Rabson }; 9594249382dSDoug Rabson 9604249382dSDoug Rabson static driver_t unknown_driver = { 9614249382dSDoug Rabson "unknown", 9624249382dSDoug Rabson unknown_methods, 9634249382dSDoug Rabson 1, /* no softc */ 9644249382dSDoug Rabson }; 9654249382dSDoug Rabson 9664249382dSDoug Rabson static devclass_t unknown_devclass; 9674249382dSDoug Rabson 9684249382dSDoug Rabson DRIVER_MODULE(unknown, isa, unknown_driver, unknown_devclass, 0, 0); 969