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 /* 4384249382dSDoug Rabson * First probe all non-pnp devices so that they claim their 4394249382dSDoug Rabson * resources first. 4404249382dSDoug Rabson */ 4414249382dSDoug Rabson for (i = 0; i < nchildren; i++) { 4424249382dSDoug Rabson device_t child = children[i]; 4434249382dSDoug Rabson struct isa_device *idev = DEVTOISA(child); 4444249382dSDoug Rabson 4454249382dSDoug Rabson if (TAILQ_FIRST(&idev->id_configs)) 4464249382dSDoug Rabson continue; 4474249382dSDoug Rabson 4484249382dSDoug Rabson device_probe_and_attach(child); 4494249382dSDoug Rabson } 4504249382dSDoug Rabson 4514249382dSDoug Rabson /* 4524249382dSDoug Rabson * Next assign resource to pnp devices and probe them. 4534249382dSDoug Rabson */ 4544249382dSDoug Rabson for (i = 0; i < nchildren; i++) { 4554249382dSDoug Rabson device_t child = children[i]; 4564249382dSDoug Rabson struct isa_device* idev = DEVTOISA(child); 4574249382dSDoug Rabson 4584249382dSDoug Rabson if (!TAILQ_FIRST(&idev->id_configs)) 4594249382dSDoug Rabson continue; 4604249382dSDoug Rabson 4614249382dSDoug Rabson if (isa_assign_resources(child)) { 4624249382dSDoug Rabson struct resource_list_entry *rle; 4634249382dSDoug Rabson 4644249382dSDoug Rabson device_probe_and_attach(child); 4654249382dSDoug Rabson 4664249382dSDoug Rabson /* 4674249382dSDoug Rabson * Claim any unallocated resources to keep other 4684249382dSDoug Rabson * devices from using them. 4694249382dSDoug Rabson */ 4704249382dSDoug Rabson SLIST_FOREACH(rle, &idev->id_resources, link) { 4714249382dSDoug Rabson if (!rle->res) { 4724249382dSDoug Rabson int rid = rle->rid; 4734249382dSDoug Rabson resource_list_alloc(dev, child, 4744249382dSDoug Rabson rle->type, 4754249382dSDoug Rabson &rid, 4764249382dSDoug Rabson 0, ~0, 1, 4774249382dSDoug Rabson RF_ACTIVE); 4784249382dSDoug Rabson } 4794249382dSDoug Rabson } 4804249382dSDoug Rabson } 4814249382dSDoug Rabson } 4824249382dSDoug Rabson 4834249382dSDoug Rabson free(children, M_TEMP); 4844249382dSDoug Rabson } 4854249382dSDoug Rabson 4864249382dSDoug Rabson /* 487a3be63b3SDoug Rabson * Add a new child with default ivars. 488a3be63b3SDoug Rabson */ 489a3be63b3SDoug Rabson static device_t 490bea6af4dSDoug Rabson isa_add_child(device_t dev, int order, const char *name, int unit) 491a3be63b3SDoug Rabson { 492a3be63b3SDoug Rabson struct isa_device *idev; 493a3be63b3SDoug Rabson 494a3be63b3SDoug Rabson idev = malloc(sizeof(struct isa_device), M_ISADEV, M_NOWAIT); 495a3be63b3SDoug Rabson if (!idev) 496a3be63b3SDoug Rabson return 0; 497a3be63b3SDoug Rabson bzero(idev, sizeof *idev); 498a3be63b3SDoug Rabson 499a3be63b3SDoug Rabson resource_list_init(&idev->id_resources); 500a3be63b3SDoug Rabson idev->id_flags = 0; 5014249382dSDoug Rabson TAILQ_INIT(&idev->id_configs); 502a3be63b3SDoug Rabson 503bea6af4dSDoug Rabson return device_add_child_ordered(dev, order, name, unit, idev); 504a3be63b3SDoug Rabson } 505a3be63b3SDoug Rabson 506a3be63b3SDoug Rabson static void 507a3be63b3SDoug Rabson isa_print_resources(struct resource_list *rl, const char *name, int type, 508a3be63b3SDoug Rabson const char *format) 509a3be63b3SDoug Rabson { 5104249382dSDoug Rabson struct resource_list_entry *rle; 5114249382dSDoug Rabson int printed; 5124249382dSDoug Rabson int i; 513a3be63b3SDoug Rabson 5144249382dSDoug Rabson printed = 0; 5154249382dSDoug Rabson for (i = 0; i < 16; i++) { 5164249382dSDoug Rabson rle = resource_list_find(rl, type, i); 5174249382dSDoug Rabson if (rle) { 5184249382dSDoug Rabson if (printed == 0) 519a3be63b3SDoug Rabson printf(" %s ", name); 5204249382dSDoug Rabson else if (printed > 0) 521a3be63b3SDoug Rabson printf(","); 5224249382dSDoug Rabson printed++; 5234249382dSDoug Rabson printf(format, rle->start); 5244249382dSDoug Rabson if (rle->count > 1) { 525a3be63b3SDoug Rabson printf("-"); 5264249382dSDoug Rabson printf(format, rle->start + rle->count - 1); 527a3be63b3SDoug Rabson } 5284249382dSDoug Rabson } else if (i > 3) { 5294249382dSDoug Rabson /* check the first few regardless */ 5304249382dSDoug Rabson break; 531a3be63b3SDoug Rabson } 532a3be63b3SDoug Rabson } 533a3be63b3SDoug Rabson } 534a3be63b3SDoug Rabson 53515317dd8SMatthew N. Dodd static int 536a3be63b3SDoug Rabson isa_print_child(device_t bus, device_t dev) 537a3be63b3SDoug Rabson { 538a3be63b3SDoug Rabson struct isa_device *idev = DEVTOISA(dev); 539a3be63b3SDoug Rabson struct resource_list *rl = &idev->id_resources; 54015317dd8SMatthew N. Dodd int retval = 0; 54115317dd8SMatthew N. Dodd 54215317dd8SMatthew N. Dodd retval += bus_print_child_header(bus, dev); 543a3be63b3SDoug Rabson 544a3be63b3SDoug Rabson if (SLIST_FIRST(rl) || idev->id_flags) 54515317dd8SMatthew N. Dodd retval += printf(" at"); 546a3be63b3SDoug Rabson 547f4e3b1e7SMatthew N. Dodd isa_print_resources(rl, "port", SYS_RES_IOPORT, "%#lx"); 548f4e3b1e7SMatthew N. Dodd isa_print_resources(rl, "iomem", SYS_RES_MEMORY, "%#lx"); 549f4e3b1e7SMatthew N. Dodd isa_print_resources(rl, "irq", SYS_RES_IRQ, "%ld"); 550f4e3b1e7SMatthew N. Dodd isa_print_resources(rl, "drq", SYS_RES_DRQ, "%ld"); 551a3be63b3SDoug Rabson if (idev->id_flags) 55215317dd8SMatthew N. Dodd retval += printf(" flags %#x", idev->id_flags); 553a3be63b3SDoug Rabson 55415317dd8SMatthew N. Dodd retval += bus_print_child_footer(bus, dev); 55515317dd8SMatthew N. Dodd 55615317dd8SMatthew N. Dodd return (retval); 557a3be63b3SDoug Rabson } 558a3be63b3SDoug Rabson 559a3be63b3SDoug Rabson static int 560a3be63b3SDoug Rabson isa_read_ivar(device_t bus, device_t dev, int index, uintptr_t * result) 561a3be63b3SDoug Rabson { 562a3be63b3SDoug Rabson struct isa_device* idev = DEVTOISA(dev); 563a3be63b3SDoug Rabson struct resource_list *rl = &idev->id_resources; 564a3be63b3SDoug Rabson struct resource_list_entry *rle; 565a3be63b3SDoug Rabson 566a3be63b3SDoug Rabson switch (index) { 567a3be63b3SDoug Rabson case ISA_IVAR_PORT_0: 568a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IOPORT, 0); 569a3be63b3SDoug Rabson if (rle) 570a3be63b3SDoug Rabson *result = rle->start; 571a3be63b3SDoug Rabson else 572a3be63b3SDoug Rabson *result = -1; 573a3be63b3SDoug Rabson break; 574a3be63b3SDoug Rabson 575a3be63b3SDoug Rabson case ISA_IVAR_PORT_1: 576a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IOPORT, 1); 577a3be63b3SDoug Rabson if (rle) 578a3be63b3SDoug Rabson *result = rle->start; 579a3be63b3SDoug Rabson else 580a3be63b3SDoug Rabson *result = -1; 581a3be63b3SDoug Rabson break; 582a3be63b3SDoug Rabson 583a3be63b3SDoug Rabson case ISA_IVAR_PORTSIZE_0: 584a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IOPORT, 0); 585a3be63b3SDoug Rabson if (rle) 586a3be63b3SDoug Rabson *result = rle->count; 587a3be63b3SDoug Rabson else 588a3be63b3SDoug Rabson *result = 0; 589a3be63b3SDoug Rabson break; 590a3be63b3SDoug Rabson 591a3be63b3SDoug Rabson case ISA_IVAR_PORTSIZE_1: 592a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IOPORT, 1); 593a3be63b3SDoug Rabson if (rle) 594a3be63b3SDoug Rabson *result = rle->count; 595a3be63b3SDoug Rabson else 596a3be63b3SDoug Rabson *result = 0; 597a3be63b3SDoug Rabson break; 598a3be63b3SDoug Rabson 599a3be63b3SDoug Rabson case ISA_IVAR_MADDR_0: 600a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_MEMORY, 0); 601a3be63b3SDoug Rabson if (rle) 602a3be63b3SDoug Rabson *result = rle->start; 603a3be63b3SDoug Rabson else 604a3be63b3SDoug Rabson *result = -1; 605a3be63b3SDoug Rabson break; 606a3be63b3SDoug Rabson 607a3be63b3SDoug Rabson case ISA_IVAR_MADDR_1: 608a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_MEMORY, 1); 609a3be63b3SDoug Rabson if (rle) 610a3be63b3SDoug Rabson *result = rle->start; 611a3be63b3SDoug Rabson else 612a3be63b3SDoug Rabson *result = -1; 613a3be63b3SDoug Rabson break; 614a3be63b3SDoug Rabson 615a3be63b3SDoug Rabson case ISA_IVAR_MSIZE_0: 616a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_MEMORY, 0); 617a3be63b3SDoug Rabson if (rle) 618a3be63b3SDoug Rabson *result = rle->count; 619a3be63b3SDoug Rabson else 620a3be63b3SDoug Rabson *result = 0; 621a3be63b3SDoug Rabson break; 622a3be63b3SDoug Rabson 623a3be63b3SDoug Rabson case ISA_IVAR_MSIZE_1: 624a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_MEMORY, 1); 625a3be63b3SDoug Rabson if (rle) 626a3be63b3SDoug Rabson *result = rle->count; 627a3be63b3SDoug Rabson else 628a3be63b3SDoug Rabson *result = 0; 629a3be63b3SDoug Rabson break; 630a3be63b3SDoug Rabson 631a3be63b3SDoug Rabson case ISA_IVAR_IRQ_0: 632a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IRQ, 0); 633a3be63b3SDoug Rabson if (rle) 634a3be63b3SDoug Rabson *result = rle->start; 635a3be63b3SDoug Rabson else 636a3be63b3SDoug Rabson *result = -1; 637a3be63b3SDoug Rabson break; 638a3be63b3SDoug Rabson 639a3be63b3SDoug Rabson case ISA_IVAR_IRQ_1: 640a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IRQ, 1); 641a3be63b3SDoug Rabson if (rle) 642a3be63b3SDoug Rabson *result = rle->start; 643a3be63b3SDoug Rabson else 644a3be63b3SDoug Rabson *result = -1; 645a3be63b3SDoug Rabson break; 646a3be63b3SDoug Rabson 647a3be63b3SDoug Rabson case ISA_IVAR_DRQ_0: 648a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_DRQ, 0); 649a3be63b3SDoug Rabson if (rle) 650a3be63b3SDoug Rabson *result = rle->start; 651a3be63b3SDoug Rabson else 652a3be63b3SDoug Rabson *result = -1; 653a3be63b3SDoug Rabson break; 654a3be63b3SDoug Rabson 655a3be63b3SDoug Rabson case ISA_IVAR_DRQ_1: 656a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_DRQ, 1); 657a3be63b3SDoug Rabson if (rle) 658a3be63b3SDoug Rabson *result = rle->start; 659a3be63b3SDoug Rabson else 660a3be63b3SDoug Rabson *result = -1; 661a3be63b3SDoug Rabson break; 662a3be63b3SDoug Rabson 663a3be63b3SDoug Rabson case ISA_IVAR_FLAGS: 664a3be63b3SDoug Rabson *result = idev->id_flags; 665a3be63b3SDoug Rabson break; 666cfa84f46SDoug Rabson 667cfa84f46SDoug Rabson case ISA_IVAR_VENDORID: 668cfa84f46SDoug Rabson *result = idev->id_vendorid; 669cfa84f46SDoug Rabson break; 670cfa84f46SDoug Rabson 671cfa84f46SDoug Rabson case ISA_IVAR_SERIAL: 672cfa84f46SDoug Rabson *result = idev->id_serial; 673cfa84f46SDoug Rabson break; 674cfa84f46SDoug Rabson 675cfa84f46SDoug Rabson case ISA_IVAR_LOGICALID: 676cfa84f46SDoug Rabson *result = idev->id_logicalid; 677cfa84f46SDoug Rabson break; 678cfa84f46SDoug Rabson 679cfa84f46SDoug Rabson case ISA_IVAR_COMPATID: 680cfa84f46SDoug Rabson *result = idev->id_compatid; 681cfa84f46SDoug Rabson break; 682cfa84f46SDoug Rabson 683cfa84f46SDoug Rabson default: 684a3be63b3SDoug Rabson return ENOENT; 685a3be63b3SDoug Rabson } 686a3be63b3SDoug Rabson 687cfa84f46SDoug Rabson return 0; 688cfa84f46SDoug Rabson } 689cfa84f46SDoug Rabson 690a3be63b3SDoug Rabson static int 691a3be63b3SDoug Rabson isa_write_ivar(device_t bus, device_t dev, 692a3be63b3SDoug Rabson int index, uintptr_t value) 693a3be63b3SDoug Rabson { 694a3be63b3SDoug Rabson struct isa_device* idev = DEVTOISA(dev); 695a3be63b3SDoug Rabson 696a3be63b3SDoug Rabson switch (index) { 697a3be63b3SDoug Rabson case ISA_IVAR_PORT_0: 698a3be63b3SDoug Rabson case ISA_IVAR_PORT_1: 699a3be63b3SDoug Rabson case ISA_IVAR_PORTSIZE_0: 700a3be63b3SDoug Rabson case ISA_IVAR_PORTSIZE_1: 701a3be63b3SDoug Rabson case ISA_IVAR_MADDR_0: 702a3be63b3SDoug Rabson case ISA_IVAR_MADDR_1: 703a3be63b3SDoug Rabson case ISA_IVAR_MSIZE_0: 704a3be63b3SDoug Rabson case ISA_IVAR_MSIZE_1: 705a3be63b3SDoug Rabson case ISA_IVAR_IRQ_0: 706a3be63b3SDoug Rabson case ISA_IVAR_IRQ_1: 707a3be63b3SDoug Rabson case ISA_IVAR_DRQ_0: 708a3be63b3SDoug Rabson case ISA_IVAR_DRQ_1: 709a3be63b3SDoug Rabson return EINVAL; 710a3be63b3SDoug Rabson 711a3be63b3SDoug Rabson case ISA_IVAR_FLAGS: 712a3be63b3SDoug Rabson idev->id_flags = value; 713a3be63b3SDoug Rabson break; 714cfa84f46SDoug Rabson 715cfa84f46SDoug Rabson case ISA_IVAR_VENDORID: 716cfa84f46SDoug Rabson idev->id_vendorid = value; 717cfa84f46SDoug Rabson break; 718cfa84f46SDoug Rabson 719cfa84f46SDoug Rabson case ISA_IVAR_SERIAL: 720cfa84f46SDoug Rabson idev->id_serial = value; 721cfa84f46SDoug Rabson break; 722cfa84f46SDoug Rabson 723cfa84f46SDoug Rabson case ISA_IVAR_LOGICALID: 724cfa84f46SDoug Rabson idev->id_logicalid = value; 725cfa84f46SDoug Rabson break; 726cfa84f46SDoug Rabson 727cfa84f46SDoug Rabson case ISA_IVAR_COMPATID: 728cfa84f46SDoug Rabson idev->id_compatid = value; 729cfa84f46SDoug Rabson break; 730cfa84f46SDoug Rabson 731a3be63b3SDoug Rabson default: 732a3be63b3SDoug Rabson return (ENOENT); 733a3be63b3SDoug Rabson } 734cfa84f46SDoug Rabson 735a3be63b3SDoug Rabson return (0); 736a3be63b3SDoug Rabson } 737a3be63b3SDoug Rabson 7384249382dSDoug Rabson /* 7394249382dSDoug Rabson * Free any resources which the driver missed or which we were holding for 7404249382dSDoug Rabson * it (see isa_probe_children). 7414249382dSDoug Rabson */ 7424249382dSDoug Rabson static void 7434249382dSDoug Rabson isa_child_detached(device_t dev, device_t child) 7444249382dSDoug Rabson { 7454249382dSDoug Rabson struct isa_device* idev = DEVTOISA(child); 7464249382dSDoug Rabson struct resource_list_entry *rle; 7474249382dSDoug Rabson 7484249382dSDoug Rabson SLIST_FOREACH(rle, &idev->id_resources, link) { 7494249382dSDoug Rabson if (rle->res) 7504249382dSDoug Rabson resource_list_release(dev, child, 7514249382dSDoug Rabson rle->type, 7524249382dSDoug Rabson rle->rid, 7534249382dSDoug Rabson rle->res); 7544249382dSDoug Rabson } 7554249382dSDoug Rabson } 7564249382dSDoug Rabson 757a3be63b3SDoug Rabson static int 758a3be63b3SDoug Rabson isa_set_resource(device_t dev, device_t child, int type, int rid, 759a3be63b3SDoug Rabson u_long start, u_long count) 760a3be63b3SDoug Rabson { 761a3be63b3SDoug Rabson struct isa_device* idev = DEVTOISA(child); 762a3be63b3SDoug Rabson struct resource_list *rl = &idev->id_resources; 763a3be63b3SDoug Rabson 764a3be63b3SDoug Rabson if (type != SYS_RES_IOPORT && type != SYS_RES_MEMORY 765a3be63b3SDoug Rabson && type != SYS_RES_IRQ && type != SYS_RES_DRQ) 766a3be63b3SDoug Rabson return EINVAL; 7674249382dSDoug Rabson if (rid < 0) 7684249382dSDoug Rabson return EINVAL; 7694249382dSDoug Rabson if (type == SYS_RES_IOPORT && rid >= ISA_NPORT) 7704249382dSDoug Rabson return EINVAL; 7714249382dSDoug Rabson if (type == SYS_RES_MEMORY && rid >= ISA_NMEM) 7724249382dSDoug Rabson return EINVAL; 7734249382dSDoug Rabson if (type == SYS_RES_IRQ && rid >= ISA_NIRQ) 7744249382dSDoug Rabson return EINVAL; 7754249382dSDoug Rabson if (type == SYS_RES_DRQ && rid >= ISA_NDRQ) 776a3be63b3SDoug Rabson return EINVAL; 777a3be63b3SDoug Rabson 778a3be63b3SDoug Rabson resource_list_add(rl, type, rid, start, start + count - 1, count); 779a3be63b3SDoug Rabson 780a3be63b3SDoug Rabson return 0; 781a3be63b3SDoug Rabson } 782a3be63b3SDoug Rabson 783a3be63b3SDoug Rabson static int 784a3be63b3SDoug Rabson isa_get_resource(device_t dev, device_t child, int type, int rid, 785a3be63b3SDoug Rabson u_long *startp, u_long *countp) 786a3be63b3SDoug Rabson { 787a3be63b3SDoug Rabson struct isa_device* idev = DEVTOISA(child); 788a3be63b3SDoug Rabson struct resource_list *rl = &idev->id_resources; 789a3be63b3SDoug Rabson struct resource_list_entry *rle; 790a3be63b3SDoug Rabson 791a3be63b3SDoug Rabson rle = resource_list_find(rl, type, rid); 792a3be63b3SDoug Rabson if (!rle) 793a3be63b3SDoug Rabson return ENOENT; 794a3be63b3SDoug Rabson 795a3be63b3SDoug Rabson *startp = rle->start; 796a3be63b3SDoug Rabson *countp = rle->count; 797a3be63b3SDoug Rabson 798a3be63b3SDoug Rabson return 0; 799a3be63b3SDoug Rabson } 800a3be63b3SDoug Rabson 801cfa84f46SDoug Rabson static void 802cfa84f46SDoug Rabson isa_delete_resource(device_t dev, device_t child, int type, int rid) 803cfa84f46SDoug Rabson { 804cfa84f46SDoug Rabson struct isa_device* idev = DEVTOISA(child); 805cfa84f46SDoug Rabson struct resource_list *rl = &idev->id_resources; 806cfa84f46SDoug Rabson resource_list_delete(rl, type, rid); 807cfa84f46SDoug Rabson } 808cfa84f46SDoug Rabson 8094249382dSDoug Rabson static int 8104249382dSDoug Rabson isa_add_config(device_t dev, device_t child, 8114249382dSDoug Rabson int priority, struct isa_config *config) 8124249382dSDoug Rabson { 8134249382dSDoug Rabson struct isa_device* idev = DEVTOISA(child); 8144249382dSDoug Rabson struct isa_config_entry *newice, *ice; 8154249382dSDoug Rabson 8164249382dSDoug Rabson newice = malloc(sizeof *ice, M_DEVBUF, M_NOWAIT); 8174249382dSDoug Rabson if (!newice) 8184249382dSDoug Rabson return ENOMEM; 8194249382dSDoug Rabson 8204249382dSDoug Rabson newice->ice_priority = priority; 8214249382dSDoug Rabson newice->ice_config = *config; 8224249382dSDoug Rabson 8234249382dSDoug Rabson TAILQ_FOREACH(ice, &idev->id_configs, ice_link) { 8244249382dSDoug Rabson if (ice->ice_priority > priority) 8254249382dSDoug Rabson break; 8264249382dSDoug Rabson } 8274249382dSDoug Rabson if (ice) 8284249382dSDoug Rabson TAILQ_INSERT_BEFORE(ice, newice, ice_link); 8294249382dSDoug Rabson else 8304249382dSDoug Rabson TAILQ_INSERT_TAIL(&idev->id_configs, newice, ice_link); 8314249382dSDoug Rabson 8324249382dSDoug Rabson return 0; 8334249382dSDoug Rabson } 8344249382dSDoug Rabson 8354249382dSDoug Rabson static void 8364249382dSDoug Rabson isa_set_config_callback(device_t dev, device_t child, 8374249382dSDoug Rabson isa_config_cb *fn, void *arg) 8384249382dSDoug Rabson { 8394249382dSDoug Rabson struct isa_device* idev = DEVTOISA(child); 8404249382dSDoug Rabson 8414249382dSDoug Rabson idev->id_config_cb = fn; 8424249382dSDoug Rabson idev->id_config_arg = arg; 8434249382dSDoug Rabson } 8444249382dSDoug Rabson 8454249382dSDoug Rabson static int 8464249382dSDoug Rabson isa_pnp_probe(device_t dev, device_t child, struct isa_pnp_id *ids) 8474249382dSDoug Rabson { 8484249382dSDoug Rabson struct isa_device* idev = DEVTOISA(child); 8494249382dSDoug Rabson 8504249382dSDoug Rabson if (!idev->id_vendorid) 8514249382dSDoug Rabson return ENOENT; 8524249382dSDoug Rabson 8534249382dSDoug Rabson while (ids->ip_id) { 8544249382dSDoug Rabson /* 8554249382dSDoug Rabson * Really ought to support >1 compat id per device. 8564249382dSDoug Rabson */ 8574249382dSDoug Rabson if (idev->id_logicalid == ids->ip_id 8584249382dSDoug Rabson || idev->id_compatid == ids->ip_id) { 8594249382dSDoug Rabson device_set_desc(child, ids->ip_desc); 8604249382dSDoug Rabson return 0; 8614249382dSDoug Rabson } 8624249382dSDoug Rabson ids++; 8634249382dSDoug Rabson } 8644249382dSDoug Rabson 8654249382dSDoug Rabson return ENXIO; 8664249382dSDoug Rabson } 8674249382dSDoug Rabson 868a3be63b3SDoug Rabson static device_method_t isa_methods[] = { 869a3be63b3SDoug Rabson /* Device interface */ 870a3be63b3SDoug Rabson DEVMETHOD(device_probe, isa_probe), 871a3be63b3SDoug Rabson DEVMETHOD(device_attach, isa_attach), 872a3be63b3SDoug Rabson DEVMETHOD(device_detach, bus_generic_detach), 873a3be63b3SDoug Rabson DEVMETHOD(device_shutdown, bus_generic_shutdown), 874a3be63b3SDoug Rabson DEVMETHOD(device_suspend, bus_generic_suspend), 875a3be63b3SDoug Rabson DEVMETHOD(device_resume, bus_generic_resume), 876a3be63b3SDoug Rabson 877a3be63b3SDoug Rabson /* Bus interface */ 878a3be63b3SDoug Rabson DEVMETHOD(bus_add_child, isa_add_child), 879a3be63b3SDoug Rabson DEVMETHOD(bus_print_child, isa_print_child), 880a3be63b3SDoug Rabson DEVMETHOD(bus_read_ivar, isa_read_ivar), 881a3be63b3SDoug Rabson DEVMETHOD(bus_write_ivar, isa_write_ivar), 8824249382dSDoug Rabson DEVMETHOD(bus_child_detached, isa_child_detached), 883a3be63b3SDoug Rabson DEVMETHOD(bus_alloc_resource, isa_alloc_resource), 884a3be63b3SDoug Rabson DEVMETHOD(bus_release_resource, isa_release_resource), 885a3be63b3SDoug Rabson DEVMETHOD(bus_activate_resource, bus_generic_activate_resource), 886a3be63b3SDoug Rabson DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource), 887a3be63b3SDoug Rabson DEVMETHOD(bus_setup_intr, isa_setup_intr), 888a3be63b3SDoug Rabson DEVMETHOD(bus_teardown_intr, isa_teardown_intr), 889a3be63b3SDoug Rabson 890a3be63b3SDoug Rabson /* ISA interface */ 891a3be63b3SDoug Rabson DEVMETHOD(isa_set_resource, isa_set_resource), 892a3be63b3SDoug Rabson DEVMETHOD(isa_get_resource, isa_get_resource), 893cfa84f46SDoug Rabson DEVMETHOD(isa_delete_resource, isa_delete_resource), 8944249382dSDoug Rabson DEVMETHOD(isa_add_config, isa_add_config), 8954249382dSDoug Rabson DEVMETHOD(isa_set_config_callback, isa_set_config_callback), 8964249382dSDoug Rabson DEVMETHOD(isa_pnp_probe, isa_pnp_probe), 897a3be63b3SDoug Rabson 898a3be63b3SDoug Rabson { 0, 0 } 899a3be63b3SDoug Rabson }; 900a3be63b3SDoug Rabson 901a3be63b3SDoug Rabson static driver_t isa_driver = { 902a3be63b3SDoug Rabson "isa", 903a3be63b3SDoug Rabson isa_methods, 904a3be63b3SDoug Rabson 1, /* no softc */ 905a3be63b3SDoug Rabson }; 906a3be63b3SDoug Rabson 907a3be63b3SDoug Rabson /* 908a3be63b3SDoug Rabson * ISA can be attached to a PCI-ISA bridge or directly to the nexus. 909a3be63b3SDoug Rabson */ 910a3be63b3SDoug Rabson DRIVER_MODULE(isa, isab, isa_driver, isa_devclass, 0, 0); 911a3be63b3SDoug Rabson #ifdef __i386__ 912a3be63b3SDoug Rabson DRIVER_MODULE(isa, nexus, isa_driver, isa_devclass, 0, 0); 913a3be63b3SDoug Rabson #endif 9144249382dSDoug Rabson 9154249382dSDoug Rabson /* 9164249382dSDoug Rabson * A fallback driver for reporting un-matched pnp devices. 9174249382dSDoug Rabson */ 9184249382dSDoug Rabson 9194249382dSDoug Rabson static int 9204249382dSDoug Rabson unknown_probe(device_t dev) 9214249382dSDoug Rabson { 9224249382dSDoug Rabson /* 9234249382dSDoug Rabson * Only match pnp devices. 9244249382dSDoug Rabson */ 9254249382dSDoug Rabson if (isa_get_vendorid(dev) != 0) 9264249382dSDoug Rabson return -100; 9274249382dSDoug Rabson return ENXIO; 9284249382dSDoug Rabson } 9294249382dSDoug Rabson 9304249382dSDoug Rabson static int 9314249382dSDoug Rabson unknown_attach(device_t dev) 9324249382dSDoug Rabson { 9334249382dSDoug Rabson return 0; 9344249382dSDoug Rabson } 9354249382dSDoug Rabson 9364249382dSDoug Rabson static int 9374249382dSDoug Rabson unknown_detach(device_t dev) 9384249382dSDoug Rabson { 9394249382dSDoug Rabson return 0; 9404249382dSDoug Rabson } 9414249382dSDoug Rabson 9424249382dSDoug Rabson static device_method_t unknown_methods[] = { 9434249382dSDoug Rabson /* Device interface */ 9444249382dSDoug Rabson DEVMETHOD(device_probe, unknown_probe), 9454249382dSDoug Rabson DEVMETHOD(device_attach, unknown_attach), 9464249382dSDoug Rabson DEVMETHOD(device_detach, unknown_detach), 9474249382dSDoug Rabson 9484249382dSDoug Rabson { 0, 0 } 9494249382dSDoug Rabson }; 9504249382dSDoug Rabson 9514249382dSDoug Rabson static driver_t unknown_driver = { 9524249382dSDoug Rabson "unknown", 9534249382dSDoug Rabson unknown_methods, 9544249382dSDoug Rabson 1, /* no softc */ 9554249382dSDoug Rabson }; 9564249382dSDoug Rabson 9574249382dSDoug Rabson static devclass_t unknown_devclass; 9584249382dSDoug Rabson 9594249382dSDoug Rabson DRIVER_MODULE(unknown, isa, unknown_driver, unknown_devclass, 0, 0); 960