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; 82ec22663bSDoug Rabson static int isa_running; 83a3be63b3SDoug Rabson 84a3be63b3SDoug Rabson /* 85a3be63b3SDoug Rabson * At 'probe' time, we add all the devices which we know about to the 86a3be63b3SDoug Rabson * bus. The generic attach routine will probe and attach them if they 87a3be63b3SDoug Rabson * are alive. 88a3be63b3SDoug Rabson */ 89a3be63b3SDoug Rabson static int 90a3be63b3SDoug Rabson isa_probe(device_t dev) 91a3be63b3SDoug Rabson { 92a3be63b3SDoug Rabson device_set_desc(dev, "ISA bus"); 93a3be63b3SDoug Rabson isa_init(); /* Allow machdep code to initialise */ 94ec22663bSDoug Rabson return 0; 95a3be63b3SDoug Rabson } 96a3be63b3SDoug Rabson 97a3be63b3SDoug Rabson extern device_t isa_bus_device; 98a3be63b3SDoug Rabson 99a3be63b3SDoug Rabson static int 100a3be63b3SDoug Rabson isa_attach(device_t dev) 101a3be63b3SDoug Rabson { 102a3be63b3SDoug Rabson /* 1034249382dSDoug Rabson * Arrange for isa_probe_children(dev) to be called later. XXX 104a3be63b3SDoug Rabson */ 105a3be63b3SDoug Rabson isa_bus_device = dev; 106a3be63b3SDoug Rabson return 0; 107a3be63b3SDoug Rabson } 108a3be63b3SDoug Rabson 109a3be63b3SDoug Rabson /* 1104249382dSDoug Rabson * Find a working set of memory regions for a child using the ranges 1114249382dSDoug Rabson * in *config and return the regions in *result. Returns non-zero if 1124249382dSDoug Rabson * a set of ranges was found. 1134249382dSDoug Rabson */ 1144249382dSDoug Rabson static int 1154249382dSDoug Rabson isa_find_memory(device_t child, 1164249382dSDoug Rabson struct isa_config *config, 1174249382dSDoug Rabson struct isa_config *result) 1184249382dSDoug Rabson { 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++) { 12625afb89bSDoug Rabson bus_delete_resource(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) { 14025afb89bSDoug Rabson bus_set_resource(child, SYS_RES_MEMORY, i, 1414249382dSDoug Rabson start, size); 1424249382dSDoug Rabson res[i] = bus_alloc_resource(child, 1434249382dSDoug Rabson SYS_RES_MEMORY, &i, 144208cc52fSMike Smith 0, ~0, 1, 0 /* !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 int success, i; 1844249382dSDoug Rabson struct resource *res[ISA_NPORT]; 1854249382dSDoug Rabson 1864249382dSDoug Rabson /* 1874249382dSDoug Rabson * First clear out any existing resource definitions. 1884249382dSDoug Rabson */ 1894249382dSDoug Rabson for (i = 0; i < ISA_NPORT; i++) { 19025afb89bSDoug Rabson bus_delete_resource(child, SYS_RES_IOPORT, i); 1914249382dSDoug Rabson res[i] = NULL; 1924249382dSDoug Rabson } 1934249382dSDoug Rabson 1944249382dSDoug Rabson success = 1; 1954249382dSDoug Rabson result->ic_nport = config->ic_nport; 1964249382dSDoug Rabson for (i = 0; i < config->ic_nport; i++) { 1974249382dSDoug Rabson u_int32_t start, end, size, align; 1984249382dSDoug Rabson for (start = config->ic_port[i].ir_start, 1994249382dSDoug Rabson end = config->ic_port[i].ir_end, 2004249382dSDoug Rabson size = config->ic_port[i].ir_size, 2014249382dSDoug Rabson align = config->ic_port[i].ir_align; 2024249382dSDoug Rabson start + size - 1 <= end; 2034249382dSDoug Rabson start += align) { 20425afb89bSDoug Rabson bus_set_resource(child, SYS_RES_IOPORT, i, 2054249382dSDoug Rabson start, size); 2064249382dSDoug Rabson res[i] = bus_alloc_resource(child, 2074249382dSDoug Rabson SYS_RES_IOPORT, &i, 208208cc52fSMike Smith 0, ~0, 1, 0 /* !RF_ACTIVE */); 2094249382dSDoug Rabson if (res[i]) { 2104249382dSDoug Rabson result->ic_port[i].ir_start = start; 2114249382dSDoug Rabson result->ic_port[i].ir_end = start + size - 1; 2124249382dSDoug Rabson result->ic_port[i].ir_size = size; 2134249382dSDoug Rabson result->ic_port[i].ir_align = align; 2144249382dSDoug Rabson break; 2154249382dSDoug Rabson } 2164249382dSDoug Rabson } 2174249382dSDoug Rabson 2184249382dSDoug Rabson /* 2194249382dSDoug Rabson * If we didn't find a place for port range i, then 2204249382dSDoug Rabson * give up now. 2214249382dSDoug Rabson */ 2224249382dSDoug Rabson if (!res[i]) { 2234249382dSDoug Rabson success = 0; 2244249382dSDoug Rabson break; 2254249382dSDoug Rabson } 2264249382dSDoug Rabson } 2274249382dSDoug Rabson 2284249382dSDoug Rabson for (i = 0; i < ISA_NPORT; i++) { 2294249382dSDoug Rabson if (res[i]) 2304249382dSDoug Rabson bus_release_resource(child, SYS_RES_IOPORT, 2314249382dSDoug Rabson i, res[i]); 2324249382dSDoug Rabson } 2334249382dSDoug Rabson 2344249382dSDoug Rabson return success; 2354249382dSDoug Rabson } 2364249382dSDoug Rabson 2374249382dSDoug Rabson /* 2384249382dSDoug Rabson * Return the index of the first bit in the mask (or -1 if mask is empty. 2394249382dSDoug Rabson */ 2404249382dSDoug Rabson static int 2414249382dSDoug Rabson find_first_bit(u_int32_t mask) 2424249382dSDoug Rabson { 2434249382dSDoug Rabson return ffs(mask) - 1; 2444249382dSDoug Rabson } 2454249382dSDoug Rabson 2464249382dSDoug Rabson /* 2474249382dSDoug Rabson * Return the index of the next bit in the mask, or -1 if there are no more. 2484249382dSDoug Rabson */ 2494249382dSDoug Rabson static int 2504249382dSDoug Rabson find_next_bit(u_int32_t mask, int bit) 2514249382dSDoug Rabson { 2524249382dSDoug Rabson bit++; 2534249382dSDoug Rabson while (bit < 32 && !(mask & (1 << bit))) 2544249382dSDoug Rabson bit++; 2554249382dSDoug Rabson if (bit != 32) 2564249382dSDoug Rabson return bit; 2574249382dSDoug Rabson return -1; 2584249382dSDoug Rabson } 2594249382dSDoug Rabson 2604249382dSDoug Rabson /* 2614249382dSDoug Rabson * Find a working set of irqs for a child using the masks in *config 2624249382dSDoug Rabson * and return the regions in *result. Returns non-zero if a set of 2634249382dSDoug Rabson * irqs was found. 2644249382dSDoug Rabson */ 2654249382dSDoug Rabson static int 2664249382dSDoug Rabson isa_find_irq(device_t child, 2674249382dSDoug Rabson struct isa_config *config, 2684249382dSDoug Rabson struct isa_config *result) 2694249382dSDoug Rabson { 2704249382dSDoug Rabson int success, i; 2714249382dSDoug Rabson struct resource *res[ISA_NIRQ]; 2724249382dSDoug Rabson 2734249382dSDoug Rabson /* 2744249382dSDoug Rabson * First clear out any existing resource definitions. 2754249382dSDoug Rabson */ 2764249382dSDoug Rabson for (i = 0; i < ISA_NIRQ; i++) { 27725afb89bSDoug Rabson bus_delete_resource(child, SYS_RES_IRQ, i); 2784249382dSDoug Rabson res[i] = NULL; 2794249382dSDoug Rabson } 2804249382dSDoug Rabson 2814249382dSDoug Rabson success = 1; 2824249382dSDoug Rabson result->ic_nirq = config->ic_nirq; 2834249382dSDoug Rabson for (i = 0; i < config->ic_nirq; i++) { 2844249382dSDoug Rabson u_int32_t mask = config->ic_irqmask[i]; 2854249382dSDoug Rabson int irq; 2864249382dSDoug Rabson for (irq = find_first_bit(mask); 2874249382dSDoug Rabson irq != -1; 2884249382dSDoug Rabson irq = find_next_bit(mask, irq)) { 28925afb89bSDoug Rabson bus_set_resource(child, SYS_RES_IRQ, i, 2904249382dSDoug Rabson irq, 1); 2914249382dSDoug Rabson res[i] = bus_alloc_resource(child, 2924249382dSDoug Rabson SYS_RES_IRQ, &i, 293208cc52fSMike Smith 0, ~0, 1, 0 /* !RF_ACTIVE */ ); 2944249382dSDoug Rabson if (res[i]) { 2954249382dSDoug Rabson result->ic_irqmask[i] = (1 << irq); 2964249382dSDoug Rabson break; 2974249382dSDoug Rabson } 2984249382dSDoug Rabson } 2994249382dSDoug Rabson 3004249382dSDoug Rabson /* 3014249382dSDoug Rabson * If we didn't find a place for irq range i, then 3024249382dSDoug Rabson * give up now. 3034249382dSDoug Rabson */ 3044249382dSDoug Rabson if (!res[i]) { 3054249382dSDoug Rabson success = 0; 3064249382dSDoug Rabson break; 3074249382dSDoug Rabson } 3084249382dSDoug Rabson } 3094249382dSDoug Rabson 3104249382dSDoug Rabson for (i = 0; i < ISA_NIRQ; i++) { 3114249382dSDoug Rabson if (res[i]) 3124249382dSDoug Rabson bus_release_resource(child, SYS_RES_IRQ, 3134249382dSDoug Rabson i, res[i]); 3144249382dSDoug Rabson } 3154249382dSDoug Rabson 3164249382dSDoug Rabson return success; 3174249382dSDoug Rabson } 3184249382dSDoug Rabson 3194249382dSDoug Rabson /* 3204249382dSDoug Rabson * Find a working set of drqs for a child using the masks in *config 3214249382dSDoug Rabson * and return the regions in *result. Returns non-zero if a set of 3224249382dSDoug Rabson * drqs was found. 3234249382dSDoug Rabson */ 3244249382dSDoug Rabson static int 3254249382dSDoug Rabson isa_find_drq(device_t child, 3264249382dSDoug Rabson struct isa_config *config, 3274249382dSDoug Rabson struct isa_config *result) 3284249382dSDoug Rabson { 3294249382dSDoug Rabson int success, i; 3304249382dSDoug Rabson struct resource *res[ISA_NDRQ]; 3314249382dSDoug Rabson 3324249382dSDoug Rabson /* 3334249382dSDoug Rabson * First clear out any existing resource definitions. 3344249382dSDoug Rabson */ 3354249382dSDoug Rabson for (i = 0; i < ISA_NDRQ; i++) { 33625afb89bSDoug Rabson bus_delete_resource(child, SYS_RES_DRQ, i); 3374249382dSDoug Rabson res[i] = NULL; 3384249382dSDoug Rabson } 3394249382dSDoug Rabson 3404249382dSDoug Rabson success = 1; 3414249382dSDoug Rabson result->ic_ndrq = config->ic_ndrq; 3424249382dSDoug Rabson for (i = 0; i < config->ic_ndrq; i++) { 3434249382dSDoug Rabson u_int32_t mask = config->ic_drqmask[i]; 3444249382dSDoug Rabson int drq; 3454249382dSDoug Rabson for (drq = find_first_bit(mask); 3464249382dSDoug Rabson drq != -1; 3474249382dSDoug Rabson drq = find_next_bit(mask, drq)) { 34825afb89bSDoug Rabson bus_set_resource(child, SYS_RES_DRQ, i, 3494249382dSDoug Rabson drq, 1); 3504249382dSDoug Rabson res[i] = bus_alloc_resource(child, 3514249382dSDoug Rabson SYS_RES_DRQ, &i, 352208cc52fSMike Smith 0, ~0, 1, 0 /* !RF_ACTIVE */); 3534249382dSDoug Rabson if (res[i]) { 3544249382dSDoug Rabson result->ic_drqmask[i] = (1 << drq); 3554249382dSDoug Rabson break; 3564249382dSDoug Rabson } 3574249382dSDoug Rabson } 3584249382dSDoug Rabson 3594249382dSDoug Rabson /* 3604249382dSDoug Rabson * If we didn't find a place for drq range i, then 3614249382dSDoug Rabson * give up now. 3624249382dSDoug Rabson */ 3634249382dSDoug Rabson if (!res[i]) { 3644249382dSDoug Rabson success = 0; 3654249382dSDoug Rabson break; 3664249382dSDoug Rabson } 3674249382dSDoug Rabson } 3684249382dSDoug Rabson 3694249382dSDoug Rabson for (i = 0; i < ISA_NDRQ; i++) { 3704249382dSDoug Rabson if (res[i]) 3714249382dSDoug Rabson bus_release_resource(child, SYS_RES_DRQ, 3724249382dSDoug Rabson i, res[i]); 3734249382dSDoug Rabson } 3744249382dSDoug Rabson 3754249382dSDoug Rabson return success; 3764249382dSDoug Rabson } 3774249382dSDoug Rabson 3784249382dSDoug Rabson /* 3794249382dSDoug Rabson * Attempt to find a working set of resources for a device. Return 3804249382dSDoug Rabson * non-zero if a working configuration is found. 3814249382dSDoug Rabson */ 3824249382dSDoug Rabson static int 3834249382dSDoug Rabson isa_assign_resources(device_t child) 3844249382dSDoug Rabson { 3854249382dSDoug Rabson struct isa_device *idev = DEVTOISA(child); 3864249382dSDoug Rabson struct isa_config_entry *ice; 3874249382dSDoug Rabson struct isa_config config; 3884249382dSDoug Rabson 3894249382dSDoug Rabson bzero(&config, sizeof config); 3904249382dSDoug Rabson TAILQ_FOREACH(ice, &idev->id_configs, ice_link) { 3914249382dSDoug Rabson if (!isa_find_memory(child, &ice->ice_config, &config)) 3924249382dSDoug Rabson continue; 3934249382dSDoug Rabson if (!isa_find_port(child, &ice->ice_config, &config)) 3944249382dSDoug Rabson continue; 3954249382dSDoug Rabson if (!isa_find_irq(child, &ice->ice_config, &config)) 3964249382dSDoug Rabson continue; 3974249382dSDoug Rabson if (!isa_find_drq(child, &ice->ice_config, &config)) 3984249382dSDoug Rabson continue; 3994249382dSDoug Rabson 4004249382dSDoug Rabson /* 4014249382dSDoug Rabson * A working configuration was found enable the device 4024249382dSDoug Rabson * with this configuration. 4034249382dSDoug Rabson */ 4044249382dSDoug Rabson if (idev->id_config_cb) { 4054249382dSDoug Rabson idev->id_config_cb(idev->id_config_arg, 4064249382dSDoug Rabson &config, 1); 4074249382dSDoug Rabson return 1; 4084249382dSDoug Rabson } 4094249382dSDoug Rabson } 4104249382dSDoug Rabson 4114249382dSDoug Rabson /* 4124249382dSDoug Rabson * Disable the device. 4134249382dSDoug Rabson */ 41425afb89bSDoug Rabson if (device_get_desc(child)) 41525afb89bSDoug Rabson device_printf(child, "<%s> can't assign resources\n", 41625afb89bSDoug Rabson device_get_desc(child)); 41725afb89bSDoug Rabson else 41825afb89bSDoug Rabson device_printf(child, "can't assign resources\n"); 4194249382dSDoug Rabson bzero(&config, sizeof config); 4204249382dSDoug Rabson if (idev->id_config_cb) 4214249382dSDoug Rabson idev->id_config_cb(idev->id_config_arg, &config, 0); 4224249382dSDoug Rabson device_disable(child); 4234249382dSDoug Rabson 4244249382dSDoug Rabson return 0; 4254249382dSDoug Rabson } 4264249382dSDoug Rabson 4274249382dSDoug Rabson /* 4284249382dSDoug Rabson * Called after other devices have initialised to probe for isa devices. 4294249382dSDoug Rabson */ 4304249382dSDoug Rabson void 4314249382dSDoug Rabson isa_probe_children(device_t dev) 4324249382dSDoug Rabson { 4334249382dSDoug Rabson device_t *children; 4344249382dSDoug Rabson int nchildren, i; 4354249382dSDoug Rabson 436ec22663bSDoug Rabson /* 437ec22663bSDoug Rabson * Create all the children by calling driver's identify methods. 438ec22663bSDoug Rabson */ 439ec22663bSDoug Rabson bus_generic_probe(dev); 440ec22663bSDoug Rabson 4414249382dSDoug Rabson if (device_get_children(dev, &children, &nchildren)) 4424249382dSDoug Rabson return; 4434249382dSDoug Rabson 4444249382dSDoug Rabson /* 445a2e6dbb3SDoug Rabson * First disable all pnp devices so that they don't get 446a2e6dbb3SDoug Rabson * matched by legacy probes. 447a2e6dbb3SDoug Rabson */ 448ec22663bSDoug Rabson if (bootverbose) 449ec22663bSDoug Rabson printf("isa_probe_children: disabling PnP devices\n"); 450a2e6dbb3SDoug Rabson for (i = 0; i < nchildren; i++) { 451a2e6dbb3SDoug Rabson device_t child = children[i]; 452a2e6dbb3SDoug Rabson struct isa_device *idev = DEVTOISA(child); 453a2e6dbb3SDoug Rabson struct isa_config config; 454a2e6dbb3SDoug Rabson 455a2e6dbb3SDoug Rabson bzero(&config, sizeof config); 456a2e6dbb3SDoug Rabson if (idev->id_config_cb) 457a2e6dbb3SDoug Rabson idev->id_config_cb(idev->id_config_arg, &config, 0); 458a2e6dbb3SDoug Rabson } 459a2e6dbb3SDoug Rabson 460a2e6dbb3SDoug Rabson /* 461a2e6dbb3SDoug Rabson * Next probe all non-pnp devices so that they claim their 4624249382dSDoug Rabson * resources first. 4634249382dSDoug Rabson */ 464ec22663bSDoug Rabson if (bootverbose) 465ec22663bSDoug Rabson printf("isa_probe_children: probing non-PnP devices\n"); 4664249382dSDoug Rabson for (i = 0; i < nchildren; i++) { 4674249382dSDoug Rabson device_t child = children[i]; 4684249382dSDoug Rabson struct isa_device *idev = DEVTOISA(child); 4694249382dSDoug Rabson 4704249382dSDoug Rabson if (TAILQ_FIRST(&idev->id_configs)) 4714249382dSDoug Rabson continue; 4724249382dSDoug Rabson 4734249382dSDoug Rabson device_probe_and_attach(child); 4744249382dSDoug Rabson } 4754249382dSDoug Rabson 4764249382dSDoug Rabson /* 477a2e6dbb3SDoug Rabson * Finally assign resource to pnp devices and probe them. 4784249382dSDoug Rabson */ 479ec22663bSDoug Rabson if (bootverbose) 480ec22663bSDoug Rabson printf("isa_probe_children: probing PnP devices\n"); 4814249382dSDoug Rabson for (i = 0; i < nchildren; i++) { 4824249382dSDoug Rabson device_t child = children[i]; 4834249382dSDoug Rabson struct isa_device* idev = DEVTOISA(child); 4844249382dSDoug Rabson 4854249382dSDoug Rabson if (!TAILQ_FIRST(&idev->id_configs)) 4864249382dSDoug Rabson continue; 4874249382dSDoug Rabson 4884249382dSDoug Rabson if (isa_assign_resources(child)) { 48925afb89bSDoug Rabson struct resource_list *rl = &idev->id_resources; 4904249382dSDoug Rabson struct resource_list_entry *rle; 4914249382dSDoug Rabson 4924249382dSDoug Rabson device_probe_and_attach(child); 4934249382dSDoug Rabson 4944249382dSDoug Rabson /* 4954249382dSDoug Rabson * Claim any unallocated resources to keep other 4964249382dSDoug Rabson * devices from using them. 4974249382dSDoug Rabson */ 49825afb89bSDoug Rabson SLIST_FOREACH(rle, rl, link) { 4994249382dSDoug Rabson if (!rle->res) { 5004249382dSDoug Rabson int rid = rle->rid; 50125afb89bSDoug Rabson resource_list_alloc(rl, dev, child, 5024249382dSDoug Rabson rle->type, 5034249382dSDoug Rabson &rid, 504328d36e9SDoug Rabson 0, ~0, 1, 0); 5054249382dSDoug Rabson } 5064249382dSDoug Rabson } 5074249382dSDoug Rabson } 5084249382dSDoug Rabson } 5094249382dSDoug Rabson 5104249382dSDoug Rabson free(children, M_TEMP); 511ec22663bSDoug Rabson 512ec22663bSDoug Rabson isa_running = 1; 5134249382dSDoug Rabson } 5144249382dSDoug Rabson 5154249382dSDoug Rabson /* 516a3be63b3SDoug Rabson * Add a new child with default ivars. 517a3be63b3SDoug Rabson */ 518a3be63b3SDoug Rabson static device_t 519bea6af4dSDoug Rabson isa_add_child(device_t dev, int order, const char *name, int unit) 520a3be63b3SDoug Rabson { 521fe0d4089SMatthew N. Dodd device_t child; 522a3be63b3SDoug Rabson struct isa_device *idev; 523a3be63b3SDoug Rabson 524a3be63b3SDoug Rabson idev = malloc(sizeof(struct isa_device), M_ISADEV, M_NOWAIT); 525a3be63b3SDoug Rabson if (!idev) 526a3be63b3SDoug Rabson return 0; 527a3be63b3SDoug Rabson bzero(idev, sizeof *idev); 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 { 608328d36e9SDoug Rabson device_printf(dev, "<%s> found", 609328d36e9SDoug Rabson pnp_eisaformat(isa_get_logicalid(child))); 610328d36e9SDoug Rabson if (bootverbose) 611328d36e9SDoug Rabson isa_print_all_resources(child); 612328d36e9SDoug Rabson printf("\n"); 613328d36e9SDoug Rabson 614328d36e9SDoug Rabson return; 615328d36e9SDoug Rabson } 616328d36e9SDoug Rabson 617a3be63b3SDoug Rabson static int 618a3be63b3SDoug Rabson isa_read_ivar(device_t bus, device_t dev, int index, uintptr_t * result) 619a3be63b3SDoug Rabson { 620a3be63b3SDoug Rabson struct isa_device* idev = DEVTOISA(dev); 621a3be63b3SDoug Rabson struct resource_list *rl = &idev->id_resources; 622a3be63b3SDoug Rabson struct resource_list_entry *rle; 623a3be63b3SDoug Rabson 624a3be63b3SDoug Rabson switch (index) { 625a3be63b3SDoug Rabson case ISA_IVAR_PORT_0: 626a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IOPORT, 0); 627a3be63b3SDoug Rabson if (rle) 628a3be63b3SDoug Rabson *result = rle->start; 629a3be63b3SDoug Rabson else 630a3be63b3SDoug Rabson *result = -1; 631a3be63b3SDoug Rabson break; 632a3be63b3SDoug Rabson 633a3be63b3SDoug Rabson case ISA_IVAR_PORT_1: 634a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IOPORT, 1); 635a3be63b3SDoug Rabson if (rle) 636a3be63b3SDoug Rabson *result = rle->start; 637a3be63b3SDoug Rabson else 638a3be63b3SDoug Rabson *result = -1; 639a3be63b3SDoug Rabson break; 640a3be63b3SDoug Rabson 641a3be63b3SDoug Rabson case ISA_IVAR_PORTSIZE_0: 642a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IOPORT, 0); 643a3be63b3SDoug Rabson if (rle) 644a3be63b3SDoug Rabson *result = rle->count; 645a3be63b3SDoug Rabson else 646a3be63b3SDoug Rabson *result = 0; 647a3be63b3SDoug Rabson break; 648a3be63b3SDoug Rabson 649a3be63b3SDoug Rabson case ISA_IVAR_PORTSIZE_1: 650a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IOPORT, 1); 651a3be63b3SDoug Rabson if (rle) 652a3be63b3SDoug Rabson *result = rle->count; 653a3be63b3SDoug Rabson else 654a3be63b3SDoug Rabson *result = 0; 655a3be63b3SDoug Rabson break; 656a3be63b3SDoug Rabson 657a3be63b3SDoug Rabson case ISA_IVAR_MADDR_0: 658a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_MEMORY, 0); 659a3be63b3SDoug Rabson if (rle) 660a3be63b3SDoug Rabson *result = rle->start; 661a3be63b3SDoug Rabson else 662a3be63b3SDoug Rabson *result = -1; 663a3be63b3SDoug Rabson break; 664a3be63b3SDoug Rabson 665a3be63b3SDoug Rabson case ISA_IVAR_MADDR_1: 666a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_MEMORY, 1); 667a3be63b3SDoug Rabson if (rle) 668a3be63b3SDoug Rabson *result = rle->start; 669a3be63b3SDoug Rabson else 670a3be63b3SDoug Rabson *result = -1; 671a3be63b3SDoug Rabson break; 672a3be63b3SDoug Rabson 673a3be63b3SDoug Rabson case ISA_IVAR_MSIZE_0: 674a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_MEMORY, 0); 675a3be63b3SDoug Rabson if (rle) 676a3be63b3SDoug Rabson *result = rle->count; 677a3be63b3SDoug Rabson else 678a3be63b3SDoug Rabson *result = 0; 679a3be63b3SDoug Rabson break; 680a3be63b3SDoug Rabson 681a3be63b3SDoug Rabson case ISA_IVAR_MSIZE_1: 682a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_MEMORY, 1); 683a3be63b3SDoug Rabson if (rle) 684a3be63b3SDoug Rabson *result = rle->count; 685a3be63b3SDoug Rabson else 686a3be63b3SDoug Rabson *result = 0; 687a3be63b3SDoug Rabson break; 688a3be63b3SDoug Rabson 689a3be63b3SDoug Rabson case ISA_IVAR_IRQ_0: 690a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IRQ, 0); 691a3be63b3SDoug Rabson if (rle) 692a3be63b3SDoug Rabson *result = rle->start; 693a3be63b3SDoug Rabson else 694a3be63b3SDoug Rabson *result = -1; 695a3be63b3SDoug Rabson break; 696a3be63b3SDoug Rabson 697a3be63b3SDoug Rabson case ISA_IVAR_IRQ_1: 698a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_IRQ, 1); 699a3be63b3SDoug Rabson if (rle) 700a3be63b3SDoug Rabson *result = rle->start; 701a3be63b3SDoug Rabson else 702a3be63b3SDoug Rabson *result = -1; 703a3be63b3SDoug Rabson break; 704a3be63b3SDoug Rabson 705a3be63b3SDoug Rabson case ISA_IVAR_DRQ_0: 706a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_DRQ, 0); 707a3be63b3SDoug Rabson if (rle) 708a3be63b3SDoug Rabson *result = rle->start; 709a3be63b3SDoug Rabson else 710a3be63b3SDoug Rabson *result = -1; 711a3be63b3SDoug Rabson break; 712a3be63b3SDoug Rabson 713a3be63b3SDoug Rabson case ISA_IVAR_DRQ_1: 714a3be63b3SDoug Rabson rle = resource_list_find(rl, SYS_RES_DRQ, 1); 715a3be63b3SDoug Rabson if (rle) 716a3be63b3SDoug Rabson *result = rle->start; 717a3be63b3SDoug Rabson else 718a3be63b3SDoug Rabson *result = -1; 719a3be63b3SDoug Rabson break; 720a3be63b3SDoug Rabson 721cfa84f46SDoug Rabson case ISA_IVAR_VENDORID: 722cfa84f46SDoug Rabson *result = idev->id_vendorid; 723cfa84f46SDoug Rabson break; 724cfa84f46SDoug Rabson 725cfa84f46SDoug Rabson case ISA_IVAR_SERIAL: 726cfa84f46SDoug Rabson *result = idev->id_serial; 727cfa84f46SDoug Rabson break; 728cfa84f46SDoug Rabson 729cfa84f46SDoug Rabson case ISA_IVAR_LOGICALID: 730cfa84f46SDoug Rabson *result = idev->id_logicalid; 731cfa84f46SDoug Rabson break; 732cfa84f46SDoug Rabson 733cfa84f46SDoug Rabson case ISA_IVAR_COMPATID: 734cfa84f46SDoug Rabson *result = idev->id_compatid; 735cfa84f46SDoug Rabson break; 736cfa84f46SDoug Rabson 737cfa84f46SDoug Rabson default: 738a3be63b3SDoug Rabson return ENOENT; 739a3be63b3SDoug Rabson } 740a3be63b3SDoug Rabson 741cfa84f46SDoug Rabson return 0; 742cfa84f46SDoug Rabson } 743cfa84f46SDoug Rabson 744a3be63b3SDoug Rabson static int 745a3be63b3SDoug Rabson isa_write_ivar(device_t bus, device_t dev, 746a3be63b3SDoug Rabson int index, uintptr_t value) 747a3be63b3SDoug Rabson { 748a3be63b3SDoug Rabson struct isa_device* idev = DEVTOISA(dev); 749a3be63b3SDoug Rabson 750a3be63b3SDoug Rabson switch (index) { 751a3be63b3SDoug Rabson case ISA_IVAR_PORT_0: 752a3be63b3SDoug Rabson case ISA_IVAR_PORT_1: 753a3be63b3SDoug Rabson case ISA_IVAR_PORTSIZE_0: 754a3be63b3SDoug Rabson case ISA_IVAR_PORTSIZE_1: 755a3be63b3SDoug Rabson case ISA_IVAR_MADDR_0: 756a3be63b3SDoug Rabson case ISA_IVAR_MADDR_1: 757a3be63b3SDoug Rabson case ISA_IVAR_MSIZE_0: 758a3be63b3SDoug Rabson case ISA_IVAR_MSIZE_1: 759a3be63b3SDoug Rabson case ISA_IVAR_IRQ_0: 760a3be63b3SDoug Rabson case ISA_IVAR_IRQ_1: 761a3be63b3SDoug Rabson case ISA_IVAR_DRQ_0: 762a3be63b3SDoug Rabson case ISA_IVAR_DRQ_1: 763a3be63b3SDoug Rabson return EINVAL; 764a3be63b3SDoug Rabson 765cfa84f46SDoug Rabson case ISA_IVAR_VENDORID: 766cfa84f46SDoug Rabson idev->id_vendorid = value; 767cfa84f46SDoug Rabson break; 768cfa84f46SDoug Rabson 769cfa84f46SDoug Rabson case ISA_IVAR_SERIAL: 770cfa84f46SDoug Rabson idev->id_serial = value; 771cfa84f46SDoug Rabson break; 772cfa84f46SDoug Rabson 773cfa84f46SDoug Rabson case ISA_IVAR_LOGICALID: 774cfa84f46SDoug Rabson idev->id_logicalid = value; 775cfa84f46SDoug Rabson break; 776cfa84f46SDoug Rabson 777cfa84f46SDoug Rabson case ISA_IVAR_COMPATID: 778cfa84f46SDoug Rabson idev->id_compatid = value; 779cfa84f46SDoug Rabson break; 780cfa84f46SDoug Rabson 781a3be63b3SDoug Rabson default: 782a3be63b3SDoug Rabson return (ENOENT); 783a3be63b3SDoug Rabson } 784cfa84f46SDoug Rabson 785a3be63b3SDoug Rabson return (0); 786a3be63b3SDoug Rabson } 787a3be63b3SDoug Rabson 7884249382dSDoug Rabson /* 7894249382dSDoug Rabson * Free any resources which the driver missed or which we were holding for 7904249382dSDoug Rabson * it (see isa_probe_children). 7914249382dSDoug Rabson */ 7924249382dSDoug Rabson static void 7934249382dSDoug Rabson isa_child_detached(device_t dev, device_t child) 7944249382dSDoug Rabson { 7954249382dSDoug Rabson struct isa_device* idev = DEVTOISA(child); 79625afb89bSDoug Rabson struct resource_list *rl = &idev->id_resources; 7974249382dSDoug Rabson struct resource_list_entry *rle; 7984249382dSDoug Rabson 799328d36e9SDoug Rabson if (TAILQ_FIRST(&idev->id_configs)) { 800328d36e9SDoug Rabson /* 801328d36e9SDoug Rabson * Claim any unallocated resources to keep other 802328d36e9SDoug Rabson * devices from using them. 803328d36e9SDoug Rabson */ 804328d36e9SDoug Rabson SLIST_FOREACH(rle, rl, link) { 805328d36e9SDoug Rabson if (!rle->res) { 806328d36e9SDoug Rabson int rid = rle->rid; 807328d36e9SDoug Rabson resource_list_alloc(rl, dev, child, 8084249382dSDoug Rabson rle->type, 809328d36e9SDoug Rabson &rid, 0, ~0, 1, 0); 810328d36e9SDoug Rabson } 811328d36e9SDoug Rabson } 8124249382dSDoug Rabson } 8134249382dSDoug Rabson } 8144249382dSDoug Rabson 815ec22663bSDoug Rabson static void 816ec22663bSDoug Rabson isa_driver_added(device_t dev, driver_t *driver) 817ec22663bSDoug Rabson { 818ec22663bSDoug Rabson device_t *children; 819ec22663bSDoug Rabson int nchildren, i; 820ec22663bSDoug Rabson 821ec22663bSDoug Rabson /* 822ec22663bSDoug Rabson * Don't do anything if drivers are dynamically 823ec22663bSDoug Rabson * added during autoconfiguration (cf. ymf724). 824ec22663bSDoug Rabson * since that would end up calling identify 825ec22663bSDoug Rabson * twice. 826ec22663bSDoug Rabson */ 827ec22663bSDoug Rabson if (!isa_running) 828ec22663bSDoug Rabson return; 829ec22663bSDoug Rabson 830ec22663bSDoug Rabson DEVICE_IDENTIFY(driver, dev); 831ec22663bSDoug Rabson if (device_get_children(dev, &children, &nchildren)) 832ec22663bSDoug Rabson return; 833ec22663bSDoug Rabson 834ec22663bSDoug Rabson for (i = 0; i < nchildren; i++) { 835ec22663bSDoug Rabson device_t child = children[i]; 836ec22663bSDoug Rabson struct isa_device *idev = DEVTOISA(child); 837ec22663bSDoug Rabson struct resource_list *rl = &idev->id_resources; 838ec22663bSDoug Rabson struct resource_list_entry *rle; 839ec22663bSDoug Rabson 840ec22663bSDoug Rabson if (device_get_state(child) != DS_NOTPRESENT) 841ec22663bSDoug Rabson continue; 842328d36e9SDoug Rabson if (!device_is_enabled(child)) 843328d36e9SDoug Rabson continue; 844328d36e9SDoug Rabson 845328d36e9SDoug Rabson /* 846328d36e9SDoug Rabson * Free resources which we were holding on behalf of 847328d36e9SDoug Rabson * the device. 848328d36e9SDoug Rabson */ 849328d36e9SDoug Rabson SLIST_FOREACH(rle, &idev->id_resources, link) { 850328d36e9SDoug Rabson if (rle->res) 851328d36e9SDoug Rabson resource_list_release(rl, dev, child, 852328d36e9SDoug Rabson rle->type, 853328d36e9SDoug Rabson rle->rid, 854328d36e9SDoug Rabson rle->res); 855328d36e9SDoug Rabson } 856ec22663bSDoug Rabson 857ec22663bSDoug Rabson if (TAILQ_FIRST(&idev->id_configs)) 858ec22663bSDoug Rabson if (!isa_assign_resources(child)) 859ec22663bSDoug Rabson continue; 860ec22663bSDoug Rabson 861ec22663bSDoug Rabson device_probe_and_attach(child); 862ec22663bSDoug Rabson 863ec22663bSDoug Rabson if (TAILQ_FIRST(&idev->id_configs)) { 864ec22663bSDoug Rabson /* 865ec22663bSDoug Rabson * Claim any unallocated resources to keep other 866ec22663bSDoug Rabson * devices from using them. 867ec22663bSDoug Rabson */ 868ec22663bSDoug Rabson SLIST_FOREACH(rle, rl, link) { 869ec22663bSDoug Rabson if (!rle->res) { 870ec22663bSDoug Rabson int rid = rle->rid; 871ec22663bSDoug Rabson resource_list_alloc(rl, dev, child, 872ec22663bSDoug Rabson rle->type, 873328d36e9SDoug Rabson &rid, 0, ~0, 1, 0); 874ec22663bSDoug Rabson } 875ec22663bSDoug Rabson } 876ec22663bSDoug Rabson } 877ec22663bSDoug Rabson } 878ec22663bSDoug Rabson 879ec22663bSDoug Rabson free(children, M_TEMP); 880ec22663bSDoug Rabson } 881ec22663bSDoug Rabson 882a3be63b3SDoug Rabson static int 883a3be63b3SDoug Rabson isa_set_resource(device_t dev, device_t child, int type, int rid, 884a3be63b3SDoug Rabson u_long start, u_long count) 885a3be63b3SDoug Rabson { 886a3be63b3SDoug Rabson struct isa_device* idev = DEVTOISA(child); 887a3be63b3SDoug Rabson struct resource_list *rl = &idev->id_resources; 888a3be63b3SDoug Rabson 889a3be63b3SDoug Rabson if (type != SYS_RES_IOPORT && type != SYS_RES_MEMORY 890a3be63b3SDoug Rabson && type != SYS_RES_IRQ && type != SYS_RES_DRQ) 891a3be63b3SDoug Rabson return EINVAL; 8924249382dSDoug Rabson if (rid < 0) 8934249382dSDoug Rabson return EINVAL; 8944249382dSDoug Rabson if (type == SYS_RES_IOPORT && rid >= ISA_NPORT) 8954249382dSDoug Rabson return EINVAL; 8964249382dSDoug Rabson if (type == SYS_RES_MEMORY && rid >= ISA_NMEM) 8974249382dSDoug Rabson return EINVAL; 8984249382dSDoug Rabson if (type == SYS_RES_IRQ && rid >= ISA_NIRQ) 8994249382dSDoug Rabson return EINVAL; 9004249382dSDoug Rabson if (type == SYS_RES_DRQ && rid >= ISA_NDRQ) 901a3be63b3SDoug Rabson return EINVAL; 902a3be63b3SDoug Rabson 903a3be63b3SDoug Rabson resource_list_add(rl, type, rid, start, start + count - 1, count); 904a3be63b3SDoug Rabson 905a3be63b3SDoug Rabson return 0; 906a3be63b3SDoug Rabson } 907a3be63b3SDoug Rabson 908a3be63b3SDoug Rabson static int 909a3be63b3SDoug Rabson isa_get_resource(device_t dev, device_t child, int type, int rid, 910a3be63b3SDoug Rabson u_long *startp, u_long *countp) 911a3be63b3SDoug Rabson { 912a3be63b3SDoug Rabson struct isa_device* idev = DEVTOISA(child); 913a3be63b3SDoug Rabson struct resource_list *rl = &idev->id_resources; 914a3be63b3SDoug Rabson struct resource_list_entry *rle; 915a3be63b3SDoug Rabson 916a3be63b3SDoug Rabson rle = resource_list_find(rl, type, rid); 917a3be63b3SDoug Rabson if (!rle) 918a3be63b3SDoug Rabson return ENOENT; 919a3be63b3SDoug Rabson 9205ab05143SPeter Wemm if (startp) 921a3be63b3SDoug Rabson *startp = rle->start; 9225ab05143SPeter Wemm if (countp) 923a3be63b3SDoug Rabson *countp = rle->count; 924a3be63b3SDoug Rabson 925a3be63b3SDoug Rabson return 0; 926a3be63b3SDoug Rabson } 927a3be63b3SDoug Rabson 928cfa84f46SDoug Rabson static void 929cfa84f46SDoug Rabson isa_delete_resource(device_t dev, device_t child, int type, int rid) 930cfa84f46SDoug Rabson { 931cfa84f46SDoug Rabson struct isa_device* idev = DEVTOISA(child); 932cfa84f46SDoug Rabson struct resource_list *rl = &idev->id_resources; 933cfa84f46SDoug Rabson resource_list_delete(rl, type, rid); 934cfa84f46SDoug Rabson } 935cfa84f46SDoug Rabson 9364249382dSDoug Rabson static int 9374249382dSDoug Rabson isa_add_config(device_t dev, device_t child, 9384249382dSDoug Rabson int priority, struct isa_config *config) 9394249382dSDoug Rabson { 9404249382dSDoug Rabson struct isa_device* idev = DEVTOISA(child); 9414249382dSDoug Rabson struct isa_config_entry *newice, *ice; 9424249382dSDoug Rabson 9434249382dSDoug Rabson newice = malloc(sizeof *ice, M_DEVBUF, M_NOWAIT); 9444249382dSDoug Rabson if (!newice) 9454249382dSDoug Rabson return ENOMEM; 9464249382dSDoug Rabson 9474249382dSDoug Rabson newice->ice_priority = priority; 9484249382dSDoug Rabson newice->ice_config = *config; 9494249382dSDoug Rabson 9504249382dSDoug Rabson TAILQ_FOREACH(ice, &idev->id_configs, ice_link) { 9514249382dSDoug Rabson if (ice->ice_priority > priority) 9524249382dSDoug Rabson break; 9534249382dSDoug Rabson } 9544249382dSDoug Rabson if (ice) 9554249382dSDoug Rabson TAILQ_INSERT_BEFORE(ice, newice, ice_link); 9564249382dSDoug Rabson else 9574249382dSDoug Rabson TAILQ_INSERT_TAIL(&idev->id_configs, newice, ice_link); 9584249382dSDoug Rabson 9594249382dSDoug Rabson return 0; 9604249382dSDoug Rabson } 9614249382dSDoug Rabson 9624249382dSDoug Rabson static void 9634249382dSDoug Rabson isa_set_config_callback(device_t dev, device_t child, 9644249382dSDoug Rabson isa_config_cb *fn, void *arg) 9654249382dSDoug Rabson { 9664249382dSDoug Rabson struct isa_device* idev = DEVTOISA(child); 9674249382dSDoug Rabson 9684249382dSDoug Rabson idev->id_config_cb = fn; 9694249382dSDoug Rabson idev->id_config_arg = arg; 9704249382dSDoug Rabson } 9714249382dSDoug Rabson 9724249382dSDoug Rabson static int 9734249382dSDoug Rabson isa_pnp_probe(device_t dev, device_t child, struct isa_pnp_id *ids) 9744249382dSDoug Rabson { 9754249382dSDoug Rabson struct isa_device* idev = DEVTOISA(child); 9764249382dSDoug Rabson 9774249382dSDoug Rabson if (!idev->id_vendorid) 9784249382dSDoug Rabson return ENOENT; 9794249382dSDoug Rabson 9804249382dSDoug Rabson while (ids->ip_id) { 9814249382dSDoug Rabson /* 9824249382dSDoug Rabson * Really ought to support >1 compat id per device. 9834249382dSDoug Rabson */ 9844249382dSDoug Rabson if (idev->id_logicalid == ids->ip_id 9854249382dSDoug Rabson || idev->id_compatid == ids->ip_id) { 9862aadbbb6SDoug Rabson if (ids->ip_desc) 9874249382dSDoug Rabson device_set_desc(child, ids->ip_desc); 9884249382dSDoug Rabson return 0; 9894249382dSDoug Rabson } 9904249382dSDoug Rabson ids++; 9914249382dSDoug Rabson } 9924249382dSDoug Rabson 9934249382dSDoug Rabson return ENXIO; 9944249382dSDoug Rabson } 9954249382dSDoug Rabson 996a3be63b3SDoug Rabson static device_method_t isa_methods[] = { 997a3be63b3SDoug Rabson /* Device interface */ 998a3be63b3SDoug Rabson DEVMETHOD(device_probe, isa_probe), 999a3be63b3SDoug Rabson DEVMETHOD(device_attach, isa_attach), 1000a3be63b3SDoug Rabson DEVMETHOD(device_detach, bus_generic_detach), 1001a3be63b3SDoug Rabson DEVMETHOD(device_shutdown, bus_generic_shutdown), 1002a3be63b3SDoug Rabson DEVMETHOD(device_suspend, bus_generic_suspend), 1003a3be63b3SDoug Rabson DEVMETHOD(device_resume, bus_generic_resume), 1004a3be63b3SDoug Rabson 1005a3be63b3SDoug Rabson /* Bus interface */ 1006a3be63b3SDoug Rabson DEVMETHOD(bus_add_child, isa_add_child), 1007a3be63b3SDoug Rabson DEVMETHOD(bus_print_child, isa_print_child), 1008328d36e9SDoug Rabson DEVMETHOD(bus_probe_nomatch, isa_probe_nomatch), 1009a3be63b3SDoug Rabson DEVMETHOD(bus_read_ivar, isa_read_ivar), 1010a3be63b3SDoug Rabson DEVMETHOD(bus_write_ivar, isa_write_ivar), 10114249382dSDoug Rabson DEVMETHOD(bus_child_detached, isa_child_detached), 1012ec22663bSDoug Rabson DEVMETHOD(bus_driver_added, isa_driver_added), 1013a3be63b3SDoug Rabson DEVMETHOD(bus_alloc_resource, isa_alloc_resource), 1014a3be63b3SDoug Rabson DEVMETHOD(bus_release_resource, isa_release_resource), 1015a3be63b3SDoug Rabson DEVMETHOD(bus_activate_resource, bus_generic_activate_resource), 1016a3be63b3SDoug Rabson DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource), 1017a3be63b3SDoug Rabson DEVMETHOD(bus_setup_intr, isa_setup_intr), 1018a3be63b3SDoug Rabson DEVMETHOD(bus_teardown_intr, isa_teardown_intr), 101925afb89bSDoug Rabson DEVMETHOD(bus_set_resource, isa_set_resource), 102025afb89bSDoug Rabson DEVMETHOD(bus_get_resource, isa_get_resource), 102125afb89bSDoug Rabson DEVMETHOD(bus_delete_resource, isa_delete_resource), 1022a3be63b3SDoug Rabson 1023a3be63b3SDoug Rabson /* ISA interface */ 10244249382dSDoug Rabson DEVMETHOD(isa_add_config, isa_add_config), 10254249382dSDoug Rabson DEVMETHOD(isa_set_config_callback, isa_set_config_callback), 10264249382dSDoug Rabson DEVMETHOD(isa_pnp_probe, isa_pnp_probe), 1027a3be63b3SDoug Rabson 1028a3be63b3SDoug Rabson { 0, 0 } 1029a3be63b3SDoug Rabson }; 1030a3be63b3SDoug Rabson 1031a3be63b3SDoug Rabson static driver_t isa_driver = { 1032a3be63b3SDoug Rabson "isa", 1033a3be63b3SDoug Rabson isa_methods, 1034a3be63b3SDoug Rabson 1, /* no softc */ 1035a3be63b3SDoug Rabson }; 1036a3be63b3SDoug Rabson 1037a3be63b3SDoug Rabson /* 1038a3be63b3SDoug Rabson * ISA can be attached to a PCI-ISA bridge or directly to the nexus. 1039a3be63b3SDoug Rabson */ 1040a3be63b3SDoug Rabson DRIVER_MODULE(isa, isab, isa_driver, isa_devclass, 0, 0); 1041a3be63b3SDoug Rabson #ifdef __i386__ 1042a3be63b3SDoug Rabson DRIVER_MODULE(isa, nexus, isa_driver, isa_devclass, 0, 0); 1043a3be63b3SDoug Rabson #endif 1044