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 792b2b44c9SJohn Baldwin static int isa_print_child(device_t bus, device_t dev); 802b2b44c9SJohn Baldwin 81959b7375SPoul-Henning Kamp static MALLOC_DEFINE(M_ISADEV, "isadev", "ISA device"); 82a3be63b3SDoug Rabson 83a3be63b3SDoug Rabson static devclass_t isa_devclass; 84ec22663bSDoug Rabson static int isa_running; 85a3be63b3SDoug Rabson 86a3be63b3SDoug Rabson /* 87a3be63b3SDoug Rabson * At 'probe' time, we add all the devices which we know about to the 88a3be63b3SDoug Rabson * bus. The generic attach routine will probe and attach them if they 89a3be63b3SDoug Rabson * are alive. 90a3be63b3SDoug Rabson */ 91a3be63b3SDoug Rabson static int 92a3be63b3SDoug Rabson isa_probe(device_t dev) 93a3be63b3SDoug Rabson { 94a3be63b3SDoug Rabson device_set_desc(dev, "ISA bus"); 95a3be63b3SDoug Rabson isa_init(); /* Allow machdep code to initialise */ 96ec22663bSDoug Rabson return 0; 97a3be63b3SDoug Rabson } 98a3be63b3SDoug Rabson 99a3be63b3SDoug Rabson extern device_t isa_bus_device; 100a3be63b3SDoug Rabson 101a3be63b3SDoug Rabson static int 102a3be63b3SDoug Rabson isa_attach(device_t dev) 103a3be63b3SDoug Rabson { 104a3be63b3SDoug Rabson /* 1054249382dSDoug Rabson * Arrange for isa_probe_children(dev) to be called later. XXX 106a3be63b3SDoug Rabson */ 107a3be63b3SDoug Rabson isa_bus_device = dev; 108a3be63b3SDoug Rabson return 0; 109a3be63b3SDoug Rabson } 110a3be63b3SDoug Rabson 111a3be63b3SDoug Rabson /* 1124249382dSDoug Rabson * Find a working set of memory regions for a child using the ranges 1134249382dSDoug Rabson * in *config and return the regions in *result. Returns non-zero if 1144249382dSDoug Rabson * a set of ranges was found. 1154249382dSDoug Rabson */ 1164249382dSDoug Rabson static int 1174249382dSDoug Rabson isa_find_memory(device_t child, 1184249382dSDoug Rabson struct isa_config *config, 1194249382dSDoug Rabson struct isa_config *result) 1204249382dSDoug Rabson { 1214249382dSDoug Rabson int success, i; 1224249382dSDoug Rabson struct resource *res[ISA_NMEM]; 1234249382dSDoug Rabson 1244249382dSDoug Rabson /* 1254249382dSDoug Rabson * First clear out any existing resource definitions. 1264249382dSDoug Rabson */ 1274249382dSDoug Rabson for (i = 0; i < ISA_NMEM; i++) { 12825afb89bSDoug Rabson bus_delete_resource(child, SYS_RES_MEMORY, i); 1294249382dSDoug Rabson res[i] = NULL; 1304249382dSDoug Rabson } 1314249382dSDoug Rabson 1324249382dSDoug Rabson success = 1; 1334249382dSDoug Rabson result->ic_nmem = config->ic_nmem; 1344249382dSDoug Rabson for (i = 0; i < config->ic_nmem; i++) { 1354249382dSDoug Rabson u_int32_t start, end, size, align; 1364249382dSDoug Rabson for (start = config->ic_mem[i].ir_start, 1374249382dSDoug Rabson end = config->ic_mem[i].ir_end, 1384249382dSDoug Rabson size = config->ic_mem[i].ir_size, 1394249382dSDoug Rabson align = config->ic_mem[i].ir_align; 1404249382dSDoug Rabson start + size - 1 <= end; 1414249382dSDoug Rabson start += align) { 14225afb89bSDoug Rabson bus_set_resource(child, SYS_RES_MEMORY, i, 1434249382dSDoug Rabson start, size); 1444249382dSDoug Rabson res[i] = bus_alloc_resource(child, 1454249382dSDoug Rabson SYS_RES_MEMORY, &i, 146208cc52fSMike Smith 0, ~0, 1, 0 /* !RF_ACTIVE */); 1474249382dSDoug Rabson if (res[i]) { 1484249382dSDoug Rabson result->ic_mem[i].ir_start = start; 1494249382dSDoug Rabson result->ic_mem[i].ir_end = start + size - 1; 1504249382dSDoug Rabson result->ic_mem[i].ir_size = size; 1514249382dSDoug Rabson result->ic_mem[i].ir_align = align; 1524249382dSDoug Rabson break; 1534249382dSDoug Rabson } 1544249382dSDoug Rabson } 1554249382dSDoug Rabson 1564249382dSDoug Rabson /* 1574249382dSDoug Rabson * If we didn't find a place for memory range i, then 1584249382dSDoug Rabson * give up now. 1594249382dSDoug Rabson */ 1604249382dSDoug Rabson if (!res[i]) { 1614249382dSDoug Rabson success = 0; 1624249382dSDoug Rabson break; 1634249382dSDoug Rabson } 1644249382dSDoug Rabson } 1654249382dSDoug Rabson 1664249382dSDoug Rabson for (i = 0; i < ISA_NMEM; i++) { 1674249382dSDoug Rabson if (res[i]) 1684249382dSDoug Rabson bus_release_resource(child, SYS_RES_MEMORY, 1694249382dSDoug Rabson i, res[i]); 1704249382dSDoug Rabson } 1714249382dSDoug Rabson 1724249382dSDoug Rabson return success; 1734249382dSDoug Rabson } 1744249382dSDoug Rabson 1754249382dSDoug Rabson /* 1764249382dSDoug Rabson * Find a working set of port regions for a child using the ranges 1774249382dSDoug Rabson * in *config and return the regions in *result. Returns non-zero if 1784249382dSDoug Rabson * a set of ranges was found. 1794249382dSDoug Rabson */ 1804249382dSDoug Rabson static int 1814249382dSDoug Rabson isa_find_port(device_t child, 1824249382dSDoug Rabson struct isa_config *config, 1834249382dSDoug Rabson struct isa_config *result) 1844249382dSDoug Rabson { 1854249382dSDoug Rabson int success, i; 1864249382dSDoug Rabson struct resource *res[ISA_NPORT]; 1874249382dSDoug Rabson 1884249382dSDoug Rabson /* 1894249382dSDoug Rabson * First clear out any existing resource definitions. 1904249382dSDoug Rabson */ 1914249382dSDoug Rabson for (i = 0; i < ISA_NPORT; i++) { 19225afb89bSDoug Rabson bus_delete_resource(child, SYS_RES_IOPORT, i); 1934249382dSDoug Rabson res[i] = NULL; 1944249382dSDoug Rabson } 1954249382dSDoug Rabson 1964249382dSDoug Rabson success = 1; 1974249382dSDoug Rabson result->ic_nport = config->ic_nport; 1984249382dSDoug Rabson for (i = 0; i < config->ic_nport; i++) { 1994249382dSDoug Rabson u_int32_t start, end, size, align; 2004249382dSDoug Rabson for (start = config->ic_port[i].ir_start, 2014249382dSDoug Rabson end = config->ic_port[i].ir_end, 2024249382dSDoug Rabson size = config->ic_port[i].ir_size, 2034249382dSDoug Rabson align = config->ic_port[i].ir_align; 2044249382dSDoug Rabson start + size - 1 <= end; 2054249382dSDoug Rabson start += align) { 20625afb89bSDoug Rabson bus_set_resource(child, SYS_RES_IOPORT, i, 2074249382dSDoug Rabson start, size); 2084249382dSDoug Rabson res[i] = bus_alloc_resource(child, 2094249382dSDoug Rabson SYS_RES_IOPORT, &i, 210208cc52fSMike Smith 0, ~0, 1, 0 /* !RF_ACTIVE */); 2114249382dSDoug Rabson if (res[i]) { 2124249382dSDoug Rabson result->ic_port[i].ir_start = start; 2134249382dSDoug Rabson result->ic_port[i].ir_end = start + size - 1; 2144249382dSDoug Rabson result->ic_port[i].ir_size = size; 2154249382dSDoug Rabson result->ic_port[i].ir_align = align; 2164249382dSDoug Rabson break; 2174249382dSDoug Rabson } 2184249382dSDoug Rabson } 2194249382dSDoug Rabson 2204249382dSDoug Rabson /* 2214249382dSDoug Rabson * If we didn't find a place for port range i, then 2224249382dSDoug Rabson * give up now. 2234249382dSDoug Rabson */ 2244249382dSDoug Rabson if (!res[i]) { 2254249382dSDoug Rabson success = 0; 2264249382dSDoug Rabson break; 2274249382dSDoug Rabson } 2284249382dSDoug Rabson } 2294249382dSDoug Rabson 2304249382dSDoug Rabson for (i = 0; i < ISA_NPORT; i++) { 2314249382dSDoug Rabson if (res[i]) 2324249382dSDoug Rabson bus_release_resource(child, SYS_RES_IOPORT, 2334249382dSDoug Rabson i, res[i]); 2344249382dSDoug Rabson } 2354249382dSDoug Rabson 2364249382dSDoug Rabson return success; 2374249382dSDoug Rabson } 2384249382dSDoug Rabson 2394249382dSDoug Rabson /* 2404249382dSDoug Rabson * Return the index of the first bit in the mask (or -1 if mask is empty. 2414249382dSDoug Rabson */ 2424249382dSDoug Rabson static int 2434249382dSDoug Rabson find_first_bit(u_int32_t mask) 2444249382dSDoug Rabson { 2454249382dSDoug Rabson return ffs(mask) - 1; 2464249382dSDoug Rabson } 2474249382dSDoug Rabson 2484249382dSDoug Rabson /* 2494249382dSDoug Rabson * Return the index of the next bit in the mask, or -1 if there are no more. 2504249382dSDoug Rabson */ 2514249382dSDoug Rabson static int 2524249382dSDoug Rabson find_next_bit(u_int32_t mask, int bit) 2534249382dSDoug Rabson { 2544249382dSDoug Rabson bit++; 2554249382dSDoug Rabson while (bit < 32 && !(mask & (1 << bit))) 2564249382dSDoug Rabson bit++; 2574249382dSDoug Rabson if (bit != 32) 2584249382dSDoug Rabson return bit; 2594249382dSDoug Rabson return -1; 2604249382dSDoug Rabson } 2614249382dSDoug Rabson 2624249382dSDoug Rabson /* 2634249382dSDoug Rabson * Find a working set of irqs for a child using the masks in *config 2644249382dSDoug Rabson * and return the regions in *result. Returns non-zero if a set of 2654249382dSDoug Rabson * irqs was found. 2664249382dSDoug Rabson */ 2674249382dSDoug Rabson static int 2684249382dSDoug Rabson isa_find_irq(device_t child, 2694249382dSDoug Rabson struct isa_config *config, 2704249382dSDoug Rabson struct isa_config *result) 2714249382dSDoug Rabson { 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++) { 27925afb89bSDoug Rabson bus_delete_resource(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)) { 29125afb89bSDoug Rabson bus_set_resource(child, SYS_RES_IRQ, i, 2924249382dSDoug Rabson irq, 1); 2934249382dSDoug Rabson res[i] = bus_alloc_resource(child, 2944249382dSDoug Rabson SYS_RES_IRQ, &i, 295208cc52fSMike Smith 0, ~0, 1, 0 /* !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 int success, i; 3324249382dSDoug Rabson struct resource *res[ISA_NDRQ]; 3334249382dSDoug Rabson 3344249382dSDoug Rabson /* 3354249382dSDoug Rabson * First clear out any existing resource definitions. 3364249382dSDoug Rabson */ 3374249382dSDoug Rabson for (i = 0; i < ISA_NDRQ; i++) { 33825afb89bSDoug Rabson bus_delete_resource(child, SYS_RES_DRQ, i); 3394249382dSDoug Rabson res[i] = NULL; 3404249382dSDoug Rabson } 3414249382dSDoug Rabson 3424249382dSDoug Rabson success = 1; 3434249382dSDoug Rabson result->ic_ndrq = config->ic_ndrq; 3444249382dSDoug Rabson for (i = 0; i < config->ic_ndrq; i++) { 3454249382dSDoug Rabson u_int32_t mask = config->ic_drqmask[i]; 3464249382dSDoug Rabson int drq; 3474249382dSDoug Rabson for (drq = find_first_bit(mask); 3484249382dSDoug Rabson drq != -1; 3494249382dSDoug Rabson drq = find_next_bit(mask, drq)) { 35025afb89bSDoug Rabson bus_set_resource(child, SYS_RES_DRQ, i, 3514249382dSDoug Rabson drq, 1); 3524249382dSDoug Rabson res[i] = bus_alloc_resource(child, 3534249382dSDoug Rabson SYS_RES_DRQ, &i, 354208cc52fSMike Smith 0, ~0, 1, 0 /* !RF_ACTIVE */); 3554249382dSDoug Rabson if (res[i]) { 3564249382dSDoug Rabson result->ic_drqmask[i] = (1 << drq); 3574249382dSDoug Rabson break; 3584249382dSDoug Rabson } 3594249382dSDoug Rabson } 3604249382dSDoug Rabson 3614249382dSDoug Rabson /* 3624249382dSDoug Rabson * If we didn't find a place for drq range i, then 3634249382dSDoug Rabson * give up now. 3644249382dSDoug Rabson */ 3654249382dSDoug Rabson if (!res[i]) { 3664249382dSDoug Rabson success = 0; 3674249382dSDoug Rabson break; 3684249382dSDoug Rabson } 3694249382dSDoug Rabson } 3704249382dSDoug Rabson 3714249382dSDoug Rabson for (i = 0; i < ISA_NDRQ; i++) { 3724249382dSDoug Rabson if (res[i]) 3734249382dSDoug Rabson bus_release_resource(child, SYS_RES_DRQ, 3744249382dSDoug Rabson i, res[i]); 3754249382dSDoug Rabson } 3764249382dSDoug Rabson 3774249382dSDoug Rabson return success; 3784249382dSDoug Rabson } 3794249382dSDoug Rabson 3804249382dSDoug Rabson /* 3814249382dSDoug Rabson * Attempt to find a working set of resources for a device. Return 3824249382dSDoug Rabson * non-zero if a working configuration is found. 3834249382dSDoug Rabson */ 3844249382dSDoug Rabson static int 3854249382dSDoug Rabson isa_assign_resources(device_t child) 3864249382dSDoug Rabson { 3874249382dSDoug Rabson struct isa_device *idev = DEVTOISA(child); 3884249382dSDoug Rabson struct isa_config_entry *ice; 3894249382dSDoug Rabson struct isa_config config; 3904249382dSDoug Rabson 3914249382dSDoug Rabson bzero(&config, sizeof config); 3924249382dSDoug Rabson TAILQ_FOREACH(ice, &idev->id_configs, ice_link) { 3934249382dSDoug Rabson if (!isa_find_memory(child, &ice->ice_config, &config)) 3944249382dSDoug Rabson continue; 3954249382dSDoug Rabson if (!isa_find_port(child, &ice->ice_config, &config)) 3964249382dSDoug Rabson continue; 3974249382dSDoug Rabson if (!isa_find_irq(child, &ice->ice_config, &config)) 3984249382dSDoug Rabson continue; 3994249382dSDoug Rabson if (!isa_find_drq(child, &ice->ice_config, &config)) 4004249382dSDoug Rabson continue; 4014249382dSDoug Rabson 4024249382dSDoug Rabson /* 4034249382dSDoug Rabson * A working configuration was found enable the device 4044249382dSDoug Rabson * with this configuration. 4054249382dSDoug Rabson */ 4064249382dSDoug Rabson if (idev->id_config_cb) { 4074249382dSDoug Rabson idev->id_config_cb(idev->id_config_arg, 4084249382dSDoug Rabson &config, 1); 4094249382dSDoug Rabson return 1; 4104249382dSDoug Rabson } 4114249382dSDoug Rabson } 4124249382dSDoug Rabson 4134249382dSDoug Rabson /* 4144249382dSDoug Rabson * Disable the device. 4154249382dSDoug Rabson */ 4162b2b44c9SJohn Baldwin bus_print_child_header(device_get_parent(child), child); 4172b2b44c9SJohn Baldwin printf(" can't assign resources\n"); 4182b2b44c9SJohn Baldwin if (bootverbose) 4192b2b44c9SJohn Baldwin isa_print_child(device_get_parent(child), child); 4204249382dSDoug Rabson bzero(&config, sizeof config); 4214249382dSDoug Rabson if (idev->id_config_cb) 4224249382dSDoug Rabson idev->id_config_cb(idev->id_config_arg, &config, 0); 4234249382dSDoug Rabson device_disable(child); 4244249382dSDoug Rabson 4254249382dSDoug Rabson return 0; 4264249382dSDoug Rabson } 4274249382dSDoug Rabson 4284249382dSDoug Rabson /* 4294249382dSDoug Rabson * Called after other devices have initialised to probe for isa devices. 4304249382dSDoug Rabson */ 4314249382dSDoug Rabson void 4324249382dSDoug Rabson isa_probe_children(device_t dev) 4334249382dSDoug Rabson { 4344249382dSDoug Rabson device_t *children; 4354249382dSDoug Rabson int nchildren, i; 4364249382dSDoug Rabson 437ec22663bSDoug Rabson /* 438ec22663bSDoug Rabson * Create all the children by calling driver's identify methods. 439ec22663bSDoug Rabson */ 440ec22663bSDoug Rabson bus_generic_probe(dev); 441ec22663bSDoug Rabson 4424249382dSDoug Rabson if (device_get_children(dev, &children, &nchildren)) 4434249382dSDoug Rabson return; 4444249382dSDoug Rabson 4454249382dSDoug Rabson /* 446a2e6dbb3SDoug Rabson * First disable all pnp devices so that they don't get 447a2e6dbb3SDoug Rabson * matched by legacy probes. 448a2e6dbb3SDoug Rabson */ 449ec22663bSDoug Rabson if (bootverbose) 450ec22663bSDoug Rabson printf("isa_probe_children: disabling PnP devices\n"); 451a2e6dbb3SDoug Rabson for (i = 0; i < nchildren; i++) { 452a2e6dbb3SDoug Rabson device_t child = children[i]; 453a2e6dbb3SDoug Rabson struct isa_device *idev = DEVTOISA(child); 454a2e6dbb3SDoug Rabson struct isa_config config; 455a2e6dbb3SDoug Rabson 456a2e6dbb3SDoug Rabson bzero(&config, sizeof config); 457a2e6dbb3SDoug Rabson if (idev->id_config_cb) 458a2e6dbb3SDoug Rabson idev->id_config_cb(idev->id_config_arg, &config, 0); 459a2e6dbb3SDoug Rabson } 460a2e6dbb3SDoug Rabson 461a2e6dbb3SDoug Rabson /* 462a2e6dbb3SDoug Rabson * Next probe all non-pnp devices so that they claim their 4634249382dSDoug Rabson * resources first. 4644249382dSDoug Rabson */ 465ec22663bSDoug Rabson if (bootverbose) 466ec22663bSDoug Rabson printf("isa_probe_children: probing non-PnP devices\n"); 4674249382dSDoug Rabson for (i = 0; i < nchildren; i++) { 4684249382dSDoug Rabson device_t child = children[i]; 4694249382dSDoug Rabson struct isa_device *idev = DEVTOISA(child); 4704249382dSDoug Rabson 4714249382dSDoug Rabson if (TAILQ_FIRST(&idev->id_configs)) 4724249382dSDoug Rabson continue; 4734249382dSDoug Rabson 4744249382dSDoug Rabson device_probe_and_attach(child); 4754249382dSDoug Rabson } 4764249382dSDoug Rabson 4774249382dSDoug Rabson /* 478a2e6dbb3SDoug Rabson * Finally assign resource to pnp devices and probe them. 4794249382dSDoug Rabson */ 480ec22663bSDoug Rabson if (bootverbose) 481ec22663bSDoug Rabson printf("isa_probe_children: probing PnP devices\n"); 4824249382dSDoug Rabson for (i = 0; i < nchildren; i++) { 4834249382dSDoug Rabson device_t child = children[i]; 4844249382dSDoug Rabson struct isa_device* idev = DEVTOISA(child); 4854249382dSDoug Rabson 4864249382dSDoug Rabson if (!TAILQ_FIRST(&idev->id_configs)) 4874249382dSDoug Rabson continue; 4884249382dSDoug Rabson 4894249382dSDoug Rabson if (isa_assign_resources(child)) { 49025afb89bSDoug Rabson struct resource_list *rl = &idev->id_resources; 4914249382dSDoug Rabson struct resource_list_entry *rle; 4924249382dSDoug Rabson 4934249382dSDoug Rabson device_probe_and_attach(child); 4944249382dSDoug Rabson 4954249382dSDoug Rabson /* 4964249382dSDoug Rabson * Claim any unallocated resources to keep other 4974249382dSDoug Rabson * devices from using them. 4984249382dSDoug Rabson */ 49925afb89bSDoug Rabson SLIST_FOREACH(rle, rl, link) { 5004249382dSDoug Rabson if (!rle->res) { 5014249382dSDoug Rabson int rid = rle->rid; 50225afb89bSDoug Rabson resource_list_alloc(rl, dev, child, 5034249382dSDoug Rabson rle->type, 5044249382dSDoug Rabson &rid, 505328d36e9SDoug Rabson 0, ~0, 1, 0); 5064249382dSDoug Rabson } 5074249382dSDoug Rabson } 5084249382dSDoug Rabson } 5094249382dSDoug Rabson } 5104249382dSDoug Rabson 5114249382dSDoug Rabson free(children, M_TEMP); 512ec22663bSDoug Rabson 513ec22663bSDoug Rabson isa_running = 1; 5144249382dSDoug Rabson } 5154249382dSDoug Rabson 5164249382dSDoug Rabson /* 517a3be63b3SDoug Rabson * Add a new child with default ivars. 518a3be63b3SDoug Rabson */ 519a3be63b3SDoug Rabson static device_t 520bea6af4dSDoug Rabson isa_add_child(device_t dev, int order, const char *name, int unit) 521a3be63b3SDoug Rabson { 522fe0d4089SMatthew N. Dodd device_t child; 523a3be63b3SDoug Rabson struct isa_device *idev; 524a3be63b3SDoug Rabson 5257cc0979fSDavid Malone idev = malloc(sizeof(struct isa_device), M_ISADEV, M_NOWAIT | M_ZERO); 526a3be63b3SDoug Rabson if (!idev) 527a3be63b3SDoug Rabson return 0; 528a3be63b3SDoug Rabson 529a3be63b3SDoug Rabson resource_list_init(&idev->id_resources); 5304249382dSDoug Rabson TAILQ_INIT(&idev->id_configs); 531a3be63b3SDoug Rabson 532fe0d4089SMatthew N. Dodd child = device_add_child_ordered(dev, order, name, unit); 533fe0d4089SMatthew N. Dodd device_set_ivars(child, idev); 534fe0d4089SMatthew N. Dodd 535fe0d4089SMatthew N. Dodd return child; 536a3be63b3SDoug Rabson } 537a3be63b3SDoug Rabson 538328d36e9SDoug Rabson static int 539a3be63b3SDoug Rabson isa_print_resources(struct resource_list *rl, const char *name, int type, 54025afb89bSDoug Rabson int count, const char *format) 541a3be63b3SDoug Rabson { 5424249382dSDoug Rabson struct resource_list_entry *rle; 5434249382dSDoug Rabson int printed; 544328d36e9SDoug Rabson int i, retval = 0;; 545a3be63b3SDoug Rabson 5464249382dSDoug Rabson printed = 0; 54725afb89bSDoug Rabson for (i = 0; i < count; i++) { 5484249382dSDoug Rabson rle = resource_list_find(rl, type, i); 5494249382dSDoug Rabson if (rle) { 5504249382dSDoug Rabson if (printed == 0) 551328d36e9SDoug Rabson retval += printf(" %s ", name); 5524249382dSDoug Rabson else if (printed > 0) 553328d36e9SDoug Rabson retval += printf(","); 5544249382dSDoug Rabson printed++; 555328d36e9SDoug Rabson retval += printf(format, rle->start); 5564249382dSDoug Rabson if (rle->count > 1) { 557328d36e9SDoug Rabson retval += printf("-"); 558328d36e9SDoug Rabson retval += printf(format, 559328d36e9SDoug Rabson rle->start + rle->count - 1); 560a3be63b3SDoug Rabson } 5614249382dSDoug Rabson } else if (i > 3) { 5624249382dSDoug Rabson /* check the first few regardless */ 5634249382dSDoug Rabson break; 564a3be63b3SDoug Rabson } 565a3be63b3SDoug Rabson } 566328d36e9SDoug Rabson return retval; 567a3be63b3SDoug Rabson } 568a3be63b3SDoug Rabson 56915317dd8SMatthew N. Dodd static int 570328d36e9SDoug Rabson isa_print_all_resources(device_t dev) 571a3be63b3SDoug Rabson { 572a3be63b3SDoug Rabson struct isa_device *idev = DEVTOISA(dev); 573a3be63b3SDoug Rabson struct resource_list *rl = &idev->id_resources; 57415317dd8SMatthew N. Dodd int retval = 0; 57515317dd8SMatthew N. Dodd 576062acdb7SDoug Rabson if (SLIST_FIRST(rl) || device_get_flags(dev)) 57715317dd8SMatthew N. Dodd retval += printf(" at"); 578a3be63b3SDoug Rabson 579328d36e9SDoug Rabson retval += isa_print_resources(rl, "port", SYS_RES_IOPORT, 580328d36e9SDoug Rabson ISA_NPORT, "%#lx"); 581328d36e9SDoug Rabson retval += isa_print_resources(rl, "iomem", SYS_RES_MEMORY, 582328d36e9SDoug Rabson ISA_NMEM, "%#lx"); 583328d36e9SDoug Rabson retval += isa_print_resources(rl, "irq", SYS_RES_IRQ, 584328d36e9SDoug Rabson ISA_NIRQ, "%ld"); 585328d36e9SDoug Rabson retval += isa_print_resources(rl, "drq", SYS_RES_DRQ, 586328d36e9SDoug Rabson ISA_NDRQ, "%ld"); 587062acdb7SDoug Rabson if (device_get_flags(dev)) 588062acdb7SDoug Rabson retval += printf(" flags %#x", device_get_flags(dev)); 589a3be63b3SDoug Rabson 590328d36e9SDoug Rabson return retval; 591328d36e9SDoug Rabson } 592328d36e9SDoug Rabson 593328d36e9SDoug Rabson static int 594328d36e9SDoug Rabson isa_print_child(device_t bus, device_t dev) 595328d36e9SDoug Rabson { 596328d36e9SDoug Rabson int retval = 0; 597328d36e9SDoug Rabson 598328d36e9SDoug Rabson retval += bus_print_child_header(bus, dev); 599328d36e9SDoug Rabson retval += isa_print_all_resources(dev); 60015317dd8SMatthew N. Dodd retval += bus_print_child_footer(bus, dev); 60115317dd8SMatthew N. Dodd 60215317dd8SMatthew N. Dodd return (retval); 603a3be63b3SDoug Rabson } 604a3be63b3SDoug Rabson 605328d36e9SDoug Rabson static void 606328d36e9SDoug Rabson isa_probe_nomatch(device_t dev, device_t child) 607328d36e9SDoug Rabson { 6082b2b44c9SJohn Baldwin if (bootverbose) { 6092b2b44c9SJohn Baldwin bus_print_child_header(dev, child); 6102b2b44c9SJohn Baldwin printf(" failed to probe"); 611328d36e9SDoug Rabson isa_print_all_resources(child); 6122b2b44c9SJohn Baldwin bus_print_child_footer(dev, child); 6132b2b44c9SJohn Baldwin } 614328d36e9SDoug Rabson 615328d36e9SDoug Rabson return; 616328d36e9SDoug Rabson } 617328d36e9SDoug Rabson 618a3be63b3SDoug Rabson static int 619a3be63b3SDoug Rabson isa_read_ivar(device_t bus, device_t dev, int index, uintptr_t * result) 620a3be63b3SDoug Rabson { 621a3be63b3SDoug Rabson struct isa_device* idev = DEVTOISA(dev); 622a3be63b3SDoug Rabson struct resource_list *rl = &idev->id_resources; 623a3be63b3SDoug Rabson struct resource_list_entry *rle; 624a3be63b3SDoug Rabson 625a3be63b3SDoug Rabson switch (index) { 626a3be63b3SDoug Rabson case ISA_IVAR_PORT_0: 627a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IOPORT, 0); 628a3be63b3SDoug Rabson if (rle) 629a3be63b3SDoug Rabson *result = rle->start; 630a3be63b3SDoug Rabson else 631a3be63b3SDoug Rabson *result = -1; 632a3be63b3SDoug Rabson break; 633a3be63b3SDoug Rabson 634a3be63b3SDoug Rabson case ISA_IVAR_PORT_1: 635a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IOPORT, 1); 636a3be63b3SDoug Rabson if (rle) 637a3be63b3SDoug Rabson *result = rle->start; 638a3be63b3SDoug Rabson else 639a3be63b3SDoug Rabson *result = -1; 640a3be63b3SDoug Rabson break; 641a3be63b3SDoug Rabson 642a3be63b3SDoug Rabson case ISA_IVAR_PORTSIZE_0: 643a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IOPORT, 0); 644a3be63b3SDoug Rabson if (rle) 645a3be63b3SDoug Rabson *result = rle->count; 646a3be63b3SDoug Rabson else 647a3be63b3SDoug Rabson *result = 0; 648a3be63b3SDoug Rabson break; 649a3be63b3SDoug Rabson 650a3be63b3SDoug Rabson case ISA_IVAR_PORTSIZE_1: 651a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IOPORT, 1); 652a3be63b3SDoug Rabson if (rle) 653a3be63b3SDoug Rabson *result = rle->count; 654a3be63b3SDoug Rabson else 655a3be63b3SDoug Rabson *result = 0; 656a3be63b3SDoug Rabson break; 657a3be63b3SDoug Rabson 658a3be63b3SDoug Rabson case ISA_IVAR_MADDR_0: 659a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_MEMORY, 0); 660a3be63b3SDoug Rabson if (rle) 661a3be63b3SDoug Rabson *result = rle->start; 662a3be63b3SDoug Rabson else 663a3be63b3SDoug Rabson *result = -1; 664a3be63b3SDoug Rabson break; 665a3be63b3SDoug Rabson 666a3be63b3SDoug Rabson case ISA_IVAR_MADDR_1: 667a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_MEMORY, 1); 668a3be63b3SDoug Rabson if (rle) 669a3be63b3SDoug Rabson *result = rle->start; 670a3be63b3SDoug Rabson else 671a3be63b3SDoug Rabson *result = -1; 672a3be63b3SDoug Rabson break; 673a3be63b3SDoug Rabson 674a3be63b3SDoug Rabson case ISA_IVAR_MSIZE_0: 675a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_MEMORY, 0); 676a3be63b3SDoug Rabson if (rle) 677a3be63b3SDoug Rabson *result = rle->count; 678a3be63b3SDoug Rabson else 679a3be63b3SDoug Rabson *result = 0; 680a3be63b3SDoug Rabson break; 681a3be63b3SDoug Rabson 682a3be63b3SDoug Rabson case ISA_IVAR_MSIZE_1: 683a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_MEMORY, 1); 684a3be63b3SDoug Rabson if (rle) 685a3be63b3SDoug Rabson *result = rle->count; 686a3be63b3SDoug Rabson else 687a3be63b3SDoug Rabson *result = 0; 688a3be63b3SDoug Rabson break; 689a3be63b3SDoug Rabson 690a3be63b3SDoug Rabson case ISA_IVAR_IRQ_0: 691a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IRQ, 0); 692a3be63b3SDoug Rabson if (rle) 693a3be63b3SDoug Rabson *result = rle->start; 694a3be63b3SDoug Rabson else 695a3be63b3SDoug Rabson *result = -1; 696a3be63b3SDoug Rabson break; 697a3be63b3SDoug Rabson 698a3be63b3SDoug Rabson case ISA_IVAR_IRQ_1: 699a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IRQ, 1); 700a3be63b3SDoug Rabson if (rle) 701a3be63b3SDoug Rabson *result = rle->start; 702a3be63b3SDoug Rabson else 703a3be63b3SDoug Rabson *result = -1; 704a3be63b3SDoug Rabson break; 705a3be63b3SDoug Rabson 706a3be63b3SDoug Rabson case ISA_IVAR_DRQ_0: 707a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_DRQ, 0); 708a3be63b3SDoug Rabson if (rle) 709a3be63b3SDoug Rabson *result = rle->start; 710a3be63b3SDoug Rabson else 711a3be63b3SDoug Rabson *result = -1; 712a3be63b3SDoug Rabson break; 713a3be63b3SDoug Rabson 714a3be63b3SDoug Rabson case ISA_IVAR_DRQ_1: 715a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_DRQ, 1); 716a3be63b3SDoug Rabson if (rle) 717a3be63b3SDoug Rabson *result = rle->start; 718a3be63b3SDoug Rabson else 719a3be63b3SDoug Rabson *result = -1; 720a3be63b3SDoug Rabson break; 721a3be63b3SDoug Rabson 722cfa84f46SDoug Rabson case ISA_IVAR_VENDORID: 723cfa84f46SDoug Rabson *result = idev->id_vendorid; 724cfa84f46SDoug Rabson break; 725cfa84f46SDoug Rabson 726cfa84f46SDoug Rabson case ISA_IVAR_SERIAL: 727cfa84f46SDoug Rabson *result = idev->id_serial; 728cfa84f46SDoug Rabson break; 729cfa84f46SDoug Rabson 730cfa84f46SDoug Rabson case ISA_IVAR_LOGICALID: 731cfa84f46SDoug Rabson *result = idev->id_logicalid; 732cfa84f46SDoug Rabson break; 733cfa84f46SDoug Rabson 734cfa84f46SDoug Rabson case ISA_IVAR_COMPATID: 735cfa84f46SDoug Rabson *result = idev->id_compatid; 736cfa84f46SDoug Rabson break; 737cfa84f46SDoug Rabson 738cfa84f46SDoug Rabson default: 739a3be63b3SDoug Rabson return ENOENT; 740a3be63b3SDoug Rabson } 741a3be63b3SDoug Rabson 742cfa84f46SDoug Rabson return 0; 743cfa84f46SDoug Rabson } 744cfa84f46SDoug Rabson 745a3be63b3SDoug Rabson static int 746a3be63b3SDoug Rabson isa_write_ivar(device_t bus, device_t dev, 747a3be63b3SDoug Rabson int index, uintptr_t value) 748a3be63b3SDoug Rabson { 749a3be63b3SDoug Rabson struct isa_device* idev = DEVTOISA(dev); 750a3be63b3SDoug Rabson 751a3be63b3SDoug Rabson switch (index) { 752a3be63b3SDoug Rabson case ISA_IVAR_PORT_0: 753a3be63b3SDoug Rabson case ISA_IVAR_PORT_1: 754a3be63b3SDoug Rabson case ISA_IVAR_PORTSIZE_0: 755a3be63b3SDoug Rabson case ISA_IVAR_PORTSIZE_1: 756a3be63b3SDoug Rabson case ISA_IVAR_MADDR_0: 757a3be63b3SDoug Rabson case ISA_IVAR_MADDR_1: 758a3be63b3SDoug Rabson case ISA_IVAR_MSIZE_0: 759a3be63b3SDoug Rabson case ISA_IVAR_MSIZE_1: 760a3be63b3SDoug Rabson case ISA_IVAR_IRQ_0: 761a3be63b3SDoug Rabson case ISA_IVAR_IRQ_1: 762a3be63b3SDoug Rabson case ISA_IVAR_DRQ_0: 763a3be63b3SDoug Rabson case ISA_IVAR_DRQ_1: 764a3be63b3SDoug Rabson return EINVAL; 765a3be63b3SDoug Rabson 766cfa84f46SDoug Rabson case ISA_IVAR_VENDORID: 767cfa84f46SDoug Rabson idev->id_vendorid = value; 768cfa84f46SDoug Rabson break; 769cfa84f46SDoug Rabson 770cfa84f46SDoug Rabson case ISA_IVAR_SERIAL: 771cfa84f46SDoug Rabson idev->id_serial = value; 772cfa84f46SDoug Rabson break; 773cfa84f46SDoug Rabson 774cfa84f46SDoug Rabson case ISA_IVAR_LOGICALID: 775cfa84f46SDoug Rabson idev->id_logicalid = value; 776cfa84f46SDoug Rabson break; 777cfa84f46SDoug Rabson 778cfa84f46SDoug Rabson case ISA_IVAR_COMPATID: 779cfa84f46SDoug Rabson idev->id_compatid = value; 780cfa84f46SDoug Rabson break; 781cfa84f46SDoug Rabson 782a3be63b3SDoug Rabson default: 783a3be63b3SDoug Rabson return (ENOENT); 784a3be63b3SDoug Rabson } 785cfa84f46SDoug Rabson 786a3be63b3SDoug Rabson return (0); 787a3be63b3SDoug Rabson } 788a3be63b3SDoug Rabson 7894249382dSDoug Rabson /* 7904249382dSDoug Rabson * Free any resources which the driver missed or which we were holding for 7914249382dSDoug Rabson * it (see isa_probe_children). 7924249382dSDoug Rabson */ 7934249382dSDoug Rabson static void 7944249382dSDoug Rabson isa_child_detached(device_t dev, device_t child) 7954249382dSDoug Rabson { 7964249382dSDoug Rabson struct isa_device* idev = DEVTOISA(child); 79725afb89bSDoug Rabson struct resource_list *rl = &idev->id_resources; 7984249382dSDoug Rabson struct resource_list_entry *rle; 7994249382dSDoug Rabson 800328d36e9SDoug Rabson if (TAILQ_FIRST(&idev->id_configs)) { 801328d36e9SDoug Rabson /* 802328d36e9SDoug Rabson * Claim any unallocated resources to keep other 803328d36e9SDoug Rabson * devices from using them. 804328d36e9SDoug Rabson */ 805328d36e9SDoug Rabson SLIST_FOREACH(rle, rl, link) { 806328d36e9SDoug Rabson if (!rle->res) { 807328d36e9SDoug Rabson int rid = rle->rid; 808328d36e9SDoug Rabson resource_list_alloc(rl, dev, child, 8094249382dSDoug Rabson rle->type, 810328d36e9SDoug Rabson &rid, 0, ~0, 1, 0); 811328d36e9SDoug Rabson } 812328d36e9SDoug Rabson } 8134249382dSDoug Rabson } 8144249382dSDoug Rabson } 8154249382dSDoug Rabson 816ec22663bSDoug Rabson static void 817ec22663bSDoug Rabson isa_driver_added(device_t dev, driver_t *driver) 818ec22663bSDoug Rabson { 819ec22663bSDoug Rabson device_t *children; 820ec22663bSDoug Rabson int nchildren, i; 821ec22663bSDoug Rabson 822ec22663bSDoug Rabson /* 823ec22663bSDoug Rabson * Don't do anything if drivers are dynamically 824ec22663bSDoug Rabson * added during autoconfiguration (cf. ymf724). 825ec22663bSDoug Rabson * since that would end up calling identify 826ec22663bSDoug Rabson * twice. 827ec22663bSDoug Rabson */ 828ec22663bSDoug Rabson if (!isa_running) 829ec22663bSDoug Rabson return; 830ec22663bSDoug Rabson 831ec22663bSDoug Rabson DEVICE_IDENTIFY(driver, dev); 832ec22663bSDoug Rabson if (device_get_children(dev, &children, &nchildren)) 833ec22663bSDoug Rabson return; 834ec22663bSDoug Rabson 835ec22663bSDoug Rabson for (i = 0; i < nchildren; i++) { 836ec22663bSDoug Rabson device_t child = children[i]; 837ec22663bSDoug Rabson struct isa_device *idev = DEVTOISA(child); 838ec22663bSDoug Rabson struct resource_list *rl = &idev->id_resources; 839ec22663bSDoug Rabson struct resource_list_entry *rle; 840ec22663bSDoug Rabson 841ec22663bSDoug Rabson if (device_get_state(child) != DS_NOTPRESENT) 842ec22663bSDoug Rabson continue; 843328d36e9SDoug Rabson if (!device_is_enabled(child)) 844328d36e9SDoug Rabson continue; 845328d36e9SDoug Rabson 846328d36e9SDoug Rabson /* 847328d36e9SDoug Rabson * Free resources which we were holding on behalf of 848328d36e9SDoug Rabson * the device. 849328d36e9SDoug Rabson */ 850328d36e9SDoug Rabson SLIST_FOREACH(rle, &idev->id_resources, link) { 851328d36e9SDoug Rabson if (rle->res) 852328d36e9SDoug Rabson resource_list_release(rl, dev, child, 853328d36e9SDoug Rabson rle->type, 854328d36e9SDoug Rabson rle->rid, 855328d36e9SDoug Rabson rle->res); 856328d36e9SDoug Rabson } 857ec22663bSDoug Rabson 858ec22663bSDoug Rabson if (TAILQ_FIRST(&idev->id_configs)) 859ec22663bSDoug Rabson if (!isa_assign_resources(child)) 860ec22663bSDoug Rabson continue; 861ec22663bSDoug Rabson 862ec22663bSDoug Rabson device_probe_and_attach(child); 863ec22663bSDoug Rabson 864ec22663bSDoug Rabson if (TAILQ_FIRST(&idev->id_configs)) { 865ec22663bSDoug Rabson /* 866ec22663bSDoug Rabson * Claim any unallocated resources to keep other 867ec22663bSDoug Rabson * devices from using them. 868ec22663bSDoug Rabson */ 869ec22663bSDoug Rabson SLIST_FOREACH(rle, rl, link) { 870ec22663bSDoug Rabson if (!rle->res) { 871ec22663bSDoug Rabson int rid = rle->rid; 872ec22663bSDoug Rabson resource_list_alloc(rl, dev, child, 873ec22663bSDoug Rabson rle->type, 874328d36e9SDoug Rabson &rid, 0, ~0, 1, 0); 875ec22663bSDoug Rabson } 876ec22663bSDoug Rabson } 877ec22663bSDoug Rabson } 878ec22663bSDoug Rabson } 879ec22663bSDoug Rabson 880ec22663bSDoug Rabson free(children, M_TEMP); 881ec22663bSDoug Rabson } 882ec22663bSDoug Rabson 883a3be63b3SDoug Rabson static int 884a3be63b3SDoug Rabson isa_set_resource(device_t dev, device_t child, int type, int rid, 885a3be63b3SDoug Rabson u_long start, u_long count) 886a3be63b3SDoug Rabson { 887a3be63b3SDoug Rabson struct isa_device* idev = DEVTOISA(child); 888a3be63b3SDoug Rabson struct resource_list *rl = &idev->id_resources; 889a3be63b3SDoug Rabson 890a3be63b3SDoug Rabson if (type != SYS_RES_IOPORT && type != SYS_RES_MEMORY 891a3be63b3SDoug Rabson && type != SYS_RES_IRQ && type != SYS_RES_DRQ) 892a3be63b3SDoug Rabson return EINVAL; 8934249382dSDoug Rabson if (rid < 0) 8944249382dSDoug Rabson return EINVAL; 8954249382dSDoug Rabson if (type == SYS_RES_IOPORT && rid >= ISA_NPORT) 8964249382dSDoug Rabson return EINVAL; 8974249382dSDoug Rabson if (type == SYS_RES_MEMORY && rid >= ISA_NMEM) 8984249382dSDoug Rabson return EINVAL; 8994249382dSDoug Rabson if (type == SYS_RES_IRQ && rid >= ISA_NIRQ) 9004249382dSDoug Rabson return EINVAL; 9014249382dSDoug Rabson if (type == SYS_RES_DRQ && rid >= ISA_NDRQ) 902a3be63b3SDoug Rabson return EINVAL; 903a3be63b3SDoug Rabson 904a3be63b3SDoug Rabson resource_list_add(rl, type, rid, start, start + count - 1, count); 905a3be63b3SDoug Rabson 906a3be63b3SDoug Rabson return 0; 907a3be63b3SDoug Rabson } 908a3be63b3SDoug Rabson 9091581afb3SMatthew N. Dodd static struct resource_list * 9101581afb3SMatthew N. Dodd isa_get_resource_list (device_t dev, device_t child) 911a3be63b3SDoug Rabson { 912a3be63b3SDoug Rabson struct isa_device* idev = DEVTOISA(child); 913a3be63b3SDoug Rabson struct resource_list *rl = &idev->id_resources; 914a3be63b3SDoug Rabson 9151581afb3SMatthew N. Dodd if (!rl) 9161581afb3SMatthew N. Dodd return (NULL); 917a3be63b3SDoug Rabson 9181581afb3SMatthew N. Dodd return (rl); 919cfa84f46SDoug Rabson } 920cfa84f46SDoug Rabson 9214249382dSDoug Rabson static int 9224249382dSDoug Rabson isa_add_config(device_t dev, device_t child, 9234249382dSDoug Rabson int priority, struct isa_config *config) 9244249382dSDoug Rabson { 9254249382dSDoug Rabson struct isa_device* idev = DEVTOISA(child); 9264249382dSDoug Rabson struct isa_config_entry *newice, *ice; 9274249382dSDoug Rabson 9284249382dSDoug Rabson newice = malloc(sizeof *ice, M_DEVBUF, M_NOWAIT); 9294249382dSDoug Rabson if (!newice) 9304249382dSDoug Rabson return ENOMEM; 9314249382dSDoug Rabson 9324249382dSDoug Rabson newice->ice_priority = priority; 9334249382dSDoug Rabson newice->ice_config = *config; 9344249382dSDoug Rabson 9354249382dSDoug Rabson TAILQ_FOREACH(ice, &idev->id_configs, ice_link) { 9364249382dSDoug Rabson if (ice->ice_priority > priority) 9374249382dSDoug Rabson break; 9384249382dSDoug Rabson } 9394249382dSDoug Rabson if (ice) 9404249382dSDoug Rabson TAILQ_INSERT_BEFORE(ice, newice, ice_link); 9414249382dSDoug Rabson else 9424249382dSDoug Rabson TAILQ_INSERT_TAIL(&idev->id_configs, newice, ice_link); 9434249382dSDoug Rabson 9444249382dSDoug Rabson return 0; 9454249382dSDoug Rabson } 9464249382dSDoug Rabson 9474249382dSDoug Rabson static void 9484249382dSDoug Rabson isa_set_config_callback(device_t dev, device_t child, 9494249382dSDoug Rabson isa_config_cb *fn, void *arg) 9504249382dSDoug Rabson { 9514249382dSDoug Rabson struct isa_device* idev = DEVTOISA(child); 9524249382dSDoug Rabson 9534249382dSDoug Rabson idev->id_config_cb = fn; 9544249382dSDoug Rabson idev->id_config_arg = arg; 9554249382dSDoug Rabson } 9564249382dSDoug Rabson 9574249382dSDoug Rabson static int 9584249382dSDoug Rabson isa_pnp_probe(device_t dev, device_t child, struct isa_pnp_id *ids) 9594249382dSDoug Rabson { 9604249382dSDoug Rabson struct isa_device* idev = DEVTOISA(child); 9614249382dSDoug Rabson 9624249382dSDoug Rabson if (!idev->id_vendorid) 9634249382dSDoug Rabson return ENOENT; 9644249382dSDoug Rabson 9654249382dSDoug Rabson while (ids->ip_id) { 9664249382dSDoug Rabson /* 9674249382dSDoug Rabson * Really ought to support >1 compat id per device. 9684249382dSDoug Rabson */ 9694249382dSDoug Rabson if (idev->id_logicalid == ids->ip_id 9704249382dSDoug Rabson || idev->id_compatid == ids->ip_id) { 9712aadbbb6SDoug Rabson if (ids->ip_desc) 9724249382dSDoug Rabson device_set_desc(child, ids->ip_desc); 9734249382dSDoug Rabson return 0; 9744249382dSDoug Rabson } 9754249382dSDoug Rabson ids++; 9764249382dSDoug Rabson } 9774249382dSDoug Rabson 9784249382dSDoug Rabson return ENXIO; 9794249382dSDoug Rabson } 9804249382dSDoug Rabson 981a3be63b3SDoug Rabson static device_method_t isa_methods[] = { 982a3be63b3SDoug Rabson /* Device interface */ 983a3be63b3SDoug Rabson DEVMETHOD(device_probe, isa_probe), 984a3be63b3SDoug Rabson DEVMETHOD(device_attach, isa_attach), 985a3be63b3SDoug Rabson DEVMETHOD(device_detach, bus_generic_detach), 986a3be63b3SDoug Rabson DEVMETHOD(device_shutdown, bus_generic_shutdown), 987a3be63b3SDoug Rabson DEVMETHOD(device_suspend, bus_generic_suspend), 988a3be63b3SDoug Rabson DEVMETHOD(device_resume, bus_generic_resume), 989a3be63b3SDoug Rabson 990a3be63b3SDoug Rabson /* Bus interface */ 991a3be63b3SDoug Rabson DEVMETHOD(bus_add_child, isa_add_child), 992a3be63b3SDoug Rabson DEVMETHOD(bus_print_child, isa_print_child), 993328d36e9SDoug Rabson DEVMETHOD(bus_probe_nomatch, isa_probe_nomatch), 994a3be63b3SDoug Rabson DEVMETHOD(bus_read_ivar, isa_read_ivar), 995a3be63b3SDoug Rabson DEVMETHOD(bus_write_ivar, isa_write_ivar), 9964249382dSDoug Rabson DEVMETHOD(bus_child_detached, isa_child_detached), 997ec22663bSDoug Rabson DEVMETHOD(bus_driver_added, isa_driver_added), 998a3be63b3SDoug Rabson DEVMETHOD(bus_setup_intr, isa_setup_intr), 999a3be63b3SDoug Rabson DEVMETHOD(bus_teardown_intr, isa_teardown_intr), 10001581afb3SMatthew N. Dodd 10011581afb3SMatthew N. Dodd DEVMETHOD(bus_get_resource_list,isa_get_resource_list), 10021581afb3SMatthew N. Dodd DEVMETHOD(bus_alloc_resource, isa_alloc_resource), 10031581afb3SMatthew N. Dodd DEVMETHOD(bus_release_resource, isa_release_resource), 100425afb89bSDoug Rabson DEVMETHOD(bus_set_resource, isa_set_resource), 10051581afb3SMatthew N. Dodd DEVMETHOD(bus_get_resource, bus_generic_rl_get_resource), 10061581afb3SMatthew N. Dodd DEVMETHOD(bus_delete_resource, bus_generic_rl_delete_resource), 10071581afb3SMatthew N. Dodd DEVMETHOD(bus_activate_resource, bus_generic_activate_resource), 10081581afb3SMatthew N. Dodd DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource), 1009a3be63b3SDoug Rabson 1010a3be63b3SDoug Rabson /* ISA interface */ 10114249382dSDoug Rabson DEVMETHOD(isa_add_config, isa_add_config), 10124249382dSDoug Rabson DEVMETHOD(isa_set_config_callback, isa_set_config_callback), 10134249382dSDoug Rabson DEVMETHOD(isa_pnp_probe, isa_pnp_probe), 1014a3be63b3SDoug Rabson 1015a3be63b3SDoug Rabson { 0, 0 } 1016a3be63b3SDoug Rabson }; 1017a3be63b3SDoug Rabson 1018a3be63b3SDoug Rabson static driver_t isa_driver = { 1019a3be63b3SDoug Rabson "isa", 1020a3be63b3SDoug Rabson isa_methods, 1021a3be63b3SDoug Rabson 1, /* no softc */ 1022a3be63b3SDoug Rabson }; 1023a3be63b3SDoug Rabson 1024a3be63b3SDoug Rabson /* 1025a3be63b3SDoug Rabson * ISA can be attached to a PCI-ISA bridge or directly to the nexus. 1026a3be63b3SDoug Rabson */ 1027a3be63b3SDoug Rabson DRIVER_MODULE(isa, isab, isa_driver, isa_devclass, 0, 0); 10285aea03b0SMike Smith DRIVER_MODULE(isa, eisab, isa_driver, isa_devclass, 0, 0); 1029a3be63b3SDoug Rabson #ifdef __i386__ 1030a3be63b3SDoug Rabson DRIVER_MODULE(isa, nexus, isa_driver, isa_devclass, 0, 0); 1031a3be63b3SDoug Rabson #endif 1032