ddfc9c4c59
Now that the upper layers all go through a layer to tie into these information functions that translates an sbuf into char * and len. The current interface suffers issues of what to do in cases of truncation, etc. Instead, migrate all these functions to using struct sbuf and these issues go away. The caller is also in charge of any memory allocation and/or expansion that's needed during this process. Create a bus_generic_child_{pnpinfo,location} and make it default. It just returns success. This is for those busses that have no information for these items. Migrate the now-empty routines to using this as appropriate. Document these new interfaces with man pages, and oversight from before. Reviewed by: jhb, bcr Sponsored by: Netflix Differential Revision: https://reviews.freebsd.org/D29937
1148 lines
26 KiB
C
1148 lines
26 KiB
C
/*-
|
|
* SPDX-License-Identifier: BSD-2-Clause-FreeBSD AND MIT
|
|
*
|
|
* Copyright (c) 1999 Doug Rabson
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
|
|
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
|
|
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
|
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
|
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
|
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
|
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
|
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
|
* SUCH DAMAGE.
|
|
*/
|
|
/*
|
|
* Modifications for Intel architecture by Garrett A. Wollman.
|
|
* Copyright 1998 Massachusetts Institute of Technology
|
|
*
|
|
* Permission to use, copy, modify, and distribute this software and
|
|
* its documentation for any purpose and without fee is hereby
|
|
* granted, provided that both the above copyright notice and this
|
|
* permission notice appear in all copies, that both the above
|
|
* copyright notice and this permission notice appear in all
|
|
* supporting documentation, and that the name of M.I.T. not be used
|
|
* in advertising or publicity pertaining to distribution of the
|
|
* software without specific, written prior permission. M.I.T. makes
|
|
* no representations about the suitability of this software for any
|
|
* purpose. It is provided "as is" without express or implied
|
|
* warranty.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY M.I.T. ``AS IS''. M.I.T. DISCLAIMS
|
|
* ALL EXPRESS OR IMPLIED WARRANTIES WITH REGARD TO THIS SOFTWARE,
|
|
* INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE. IN NO EVENT
|
|
* SHALL M.I.T. BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
|
|
* SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
|
|
* USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
|
|
* ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
|
|
* OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
|
|
* OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
|
* SUCH DAMAGE.
|
|
*/
|
|
|
|
/*
|
|
* Parts of the ISA bus implementation common to all architectures.
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__FBSDID("$FreeBSD$");
|
|
|
|
#include "opt_isa.h"
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/bus.h>
|
|
#include <sys/endian.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/module.h>
|
|
#include <machine/bus.h>
|
|
#include <sys/rman.h>
|
|
#include <sys/sbuf.h>
|
|
#include <sys/sysctl.h>
|
|
|
|
#include <machine/resource.h>
|
|
|
|
#include <isa/isavar.h>
|
|
#include <isa/isa_common.h>
|
|
|
|
static int isa_print_child(device_t bus, device_t dev);
|
|
|
|
static MALLOC_DEFINE(M_ISADEV, "isadev", "ISA device");
|
|
|
|
static int isa_running;
|
|
|
|
/*
|
|
* At 'probe' time, we add all the devices which we know about to the
|
|
* bus. The generic attach routine will probe and attach them if they
|
|
* are alive.
|
|
*/
|
|
static int
|
|
isa_probe(device_t dev)
|
|
{
|
|
device_set_desc(dev, "ISA bus");
|
|
isa_init(dev); /* Allow machdep code to initialise */
|
|
return (0);
|
|
}
|
|
|
|
extern device_t isa_bus_device;
|
|
|
|
static int
|
|
isa_attach(device_t dev)
|
|
{
|
|
/*
|
|
* Arrange for isa_probe_children(dev) to be called later. XXX
|
|
*/
|
|
isa_bus_device = dev;
|
|
return (0);
|
|
}
|
|
|
|
/*
|
|
* Find a working set of memory regions for a child using the ranges
|
|
* in *config and return the regions in *result. Returns non-zero if
|
|
* a set of ranges was found.
|
|
*/
|
|
static int
|
|
isa_find_memory(device_t child, struct isa_config *config,
|
|
struct isa_config *result)
|
|
{
|
|
int success, i;
|
|
struct resource *res[ISA_NMEM];
|
|
|
|
/*
|
|
* First clear out any existing resource definitions.
|
|
*/
|
|
for (i = 0; i < ISA_NMEM; i++) {
|
|
bus_delete_resource(child, SYS_RES_MEMORY, i);
|
|
res[i] = NULL;
|
|
}
|
|
|
|
success = 1;
|
|
result->ic_nmem = config->ic_nmem;
|
|
for (i = 0; i < config->ic_nmem; i++) {
|
|
uint32_t start, end, size, align;
|
|
|
|
size = config->ic_mem[i].ir_size;
|
|
|
|
/* the PnP device may have a null resource as filler */
|
|
if (size == 0) {
|
|
result->ic_mem[i].ir_start = 0;
|
|
result->ic_mem[i].ir_end = 0;
|
|
result->ic_mem[i].ir_size = 0;
|
|
result->ic_mem[i].ir_align = 0;
|
|
continue;
|
|
}
|
|
|
|
for (start = config->ic_mem[i].ir_start,
|
|
end = config->ic_mem[i].ir_end,
|
|
align = config->ic_mem[i].ir_align;
|
|
start + size - 1 <= end && start + size > start;
|
|
start += MAX(align, 1)) {
|
|
bus_set_resource(child, SYS_RES_MEMORY, i,
|
|
start, size);
|
|
res[i] = bus_alloc_resource_any(child,
|
|
SYS_RES_MEMORY, &i,
|
|
rman_make_alignment_flags(align) /* !RF_ACTIVE */);
|
|
if (res[i]) {
|
|
result->ic_mem[i].ir_start = start;
|
|
result->ic_mem[i].ir_end = start + size - 1;
|
|
result->ic_mem[i].ir_size = size;
|
|
result->ic_mem[i].ir_align = align;
|
|
break;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* If we didn't find a place for memory range i, then
|
|
* give up now.
|
|
*/
|
|
if (!res[i]) {
|
|
success = 0;
|
|
break;
|
|
}
|
|
}
|
|
|
|
for (i = 0; i < ISA_NMEM; i++) {
|
|
if (res[i])
|
|
bus_release_resource(child, SYS_RES_MEMORY,
|
|
i, res[i]);
|
|
}
|
|
|
|
return (success);
|
|
}
|
|
|
|
/*
|
|
* Find a working set of port regions for a child using the ranges
|
|
* in *config and return the regions in *result. Returns non-zero if
|
|
* a set of ranges was found.
|
|
*/
|
|
static int
|
|
isa_find_port(device_t child, struct isa_config *config,
|
|
struct isa_config *result)
|
|
{
|
|
int success, i;
|
|
struct resource *res[ISA_NPORT];
|
|
|
|
/*
|
|
* First clear out any existing resource definitions.
|
|
*/
|
|
for (i = 0; i < ISA_NPORT; i++) {
|
|
bus_delete_resource(child, SYS_RES_IOPORT, i);
|
|
res[i] = NULL;
|
|
}
|
|
|
|
success = 1;
|
|
result->ic_nport = config->ic_nport;
|
|
for (i = 0; i < config->ic_nport; i++) {
|
|
uint32_t start, end, size, align;
|
|
|
|
size = config->ic_port[i].ir_size;
|
|
|
|
/* the PnP device may have a null resource as filler */
|
|
if (size == 0) {
|
|
result->ic_port[i].ir_start = 0;
|
|
result->ic_port[i].ir_end = 0;
|
|
result->ic_port[i].ir_size = 0;
|
|
result->ic_port[i].ir_align = 0;
|
|
continue;
|
|
}
|
|
|
|
for (start = config->ic_port[i].ir_start,
|
|
end = config->ic_port[i].ir_end,
|
|
align = config->ic_port[i].ir_align;
|
|
start + size - 1 <= end;
|
|
start += align) {
|
|
bus_set_resource(child, SYS_RES_IOPORT, i,
|
|
start, size);
|
|
res[i] = bus_alloc_resource_any(child,
|
|
SYS_RES_IOPORT, &i,
|
|
rman_make_alignment_flags(align) /* !RF_ACTIVE */);
|
|
if (res[i]) {
|
|
result->ic_port[i].ir_start = start;
|
|
result->ic_port[i].ir_end = start + size - 1;
|
|
result->ic_port[i].ir_size = size;
|
|
result->ic_port[i].ir_align = align;
|
|
break;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* If we didn't find a place for port range i, then
|
|
* give up now.
|
|
*/
|
|
if (!res[i]) {
|
|
success = 0;
|
|
break;
|
|
}
|
|
}
|
|
|
|
for (i = 0; i < ISA_NPORT; i++) {
|
|
if (res[i])
|
|
bus_release_resource(child, SYS_RES_IOPORT,
|
|
i, res[i]);
|
|
}
|
|
|
|
return success;
|
|
}
|
|
|
|
/*
|
|
* Return the index of the first bit in the mask (or -1 if mask is empty.
|
|
*/
|
|
static int
|
|
find_first_bit(uint32_t mask)
|
|
{
|
|
return (ffs(mask) - 1);
|
|
}
|
|
|
|
/*
|
|
* Return the index of the next bit in the mask, or -1 if there are no more.
|
|
*/
|
|
static int
|
|
find_next_bit(uint32_t mask, int bit)
|
|
{
|
|
bit++;
|
|
while (bit < 32 && !(mask & (1 << bit)))
|
|
bit++;
|
|
if (bit != 32)
|
|
return (bit);
|
|
return (-1);
|
|
}
|
|
|
|
/*
|
|
* Find a working set of irqs for a child using the masks in *config
|
|
* and return the regions in *result. Returns non-zero if a set of
|
|
* irqs was found.
|
|
*/
|
|
static int
|
|
isa_find_irq(device_t child, struct isa_config *config,
|
|
struct isa_config *result)
|
|
{
|
|
int success, i;
|
|
struct resource *res[ISA_NIRQ];
|
|
|
|
/*
|
|
* First clear out any existing resource definitions.
|
|
*/
|
|
for (i = 0; i < ISA_NIRQ; i++) {
|
|
bus_delete_resource(child, SYS_RES_IRQ, i);
|
|
res[i] = NULL;
|
|
}
|
|
|
|
success = 1;
|
|
result->ic_nirq = config->ic_nirq;
|
|
for (i = 0; i < config->ic_nirq; i++) {
|
|
uint32_t mask = config->ic_irqmask[i];
|
|
int irq;
|
|
|
|
/* the PnP device may have a null resource as filler */
|
|
if (mask == 0) {
|
|
result->ic_irqmask[i] = 0;
|
|
continue;
|
|
}
|
|
|
|
for (irq = find_first_bit(mask);
|
|
irq != -1;
|
|
irq = find_next_bit(mask, irq)) {
|
|
bus_set_resource(child, SYS_RES_IRQ, i,
|
|
irq, 1);
|
|
res[i] = bus_alloc_resource_any(child,
|
|
SYS_RES_IRQ, &i,
|
|
0 /* !RF_ACTIVE */ );
|
|
if (res[i]) {
|
|
result->ic_irqmask[i] = (1 << irq);
|
|
break;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* If we didn't find a place for irq range i, then
|
|
* give up now.
|
|
*/
|
|
if (!res[i]) {
|
|
success = 0;
|
|
break;
|
|
}
|
|
}
|
|
|
|
for (i = 0; i < ISA_NIRQ; i++) {
|
|
if (res[i])
|
|
bus_release_resource(child, SYS_RES_IRQ,
|
|
i, res[i]);
|
|
}
|
|
|
|
return (success);
|
|
}
|
|
|
|
/*
|
|
* Find a working set of drqs for a child using the masks in *config
|
|
* and return the regions in *result. Returns non-zero if a set of
|
|
* drqs was found.
|
|
*/
|
|
static int
|
|
isa_find_drq(device_t child, struct isa_config *config,
|
|
struct isa_config *result)
|
|
{
|
|
int success, i;
|
|
struct resource *res[ISA_NDRQ];
|
|
|
|
/*
|
|
* First clear out any existing resource definitions.
|
|
*/
|
|
for (i = 0; i < ISA_NDRQ; i++) {
|
|
bus_delete_resource(child, SYS_RES_DRQ, i);
|
|
res[i] = NULL;
|
|
}
|
|
|
|
success = 1;
|
|
result->ic_ndrq = config->ic_ndrq;
|
|
for (i = 0; i < config->ic_ndrq; i++) {
|
|
uint32_t mask = config->ic_drqmask[i];
|
|
int drq;
|
|
|
|
/* the PnP device may have a null resource as filler */
|
|
if (mask == 0) {
|
|
result->ic_drqmask[i] = 0;
|
|
continue;
|
|
}
|
|
|
|
for (drq = find_first_bit(mask);
|
|
drq != -1;
|
|
drq = find_next_bit(mask, drq)) {
|
|
bus_set_resource(child, SYS_RES_DRQ, i,
|
|
drq, 1);
|
|
res[i] = bus_alloc_resource_any(child,
|
|
SYS_RES_DRQ, &i,
|
|
0 /* !RF_ACTIVE */);
|
|
if (res[i]) {
|
|
result->ic_drqmask[i] = (1 << drq);
|
|
break;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* If we didn't find a place for drq range i, then
|
|
* give up now.
|
|
*/
|
|
if (!res[i]) {
|
|
success = 0;
|
|
break;
|
|
}
|
|
}
|
|
|
|
for (i = 0; i < ISA_NDRQ; i++) {
|
|
if (res[i])
|
|
bus_release_resource(child, SYS_RES_DRQ,
|
|
i, res[i]);
|
|
}
|
|
|
|
return (success);
|
|
}
|
|
|
|
/*
|
|
* Attempt to find a working set of resources for a device. Return
|
|
* non-zero if a working configuration is found.
|
|
*/
|
|
static int
|
|
isa_assign_resources(device_t child)
|
|
{
|
|
struct isa_device *idev = DEVTOISA(child);
|
|
struct isa_config_entry *ice;
|
|
struct isa_config *cfg;
|
|
const char *reason;
|
|
|
|
reason = "Empty ISA id_configs";
|
|
cfg = malloc(sizeof(struct isa_config), M_TEMP, M_NOWAIT|M_ZERO);
|
|
if (cfg == NULL)
|
|
return(0);
|
|
TAILQ_FOREACH(ice, &idev->id_configs, ice_link) {
|
|
reason = "memory";
|
|
if (!isa_find_memory(child, &ice->ice_config, cfg))
|
|
continue;
|
|
reason = "port";
|
|
if (!isa_find_port(child, &ice->ice_config, cfg))
|
|
continue;
|
|
reason = "irq";
|
|
if (!isa_find_irq(child, &ice->ice_config, cfg))
|
|
continue;
|
|
reason = "drq";
|
|
if (!isa_find_drq(child, &ice->ice_config, cfg))
|
|
continue;
|
|
|
|
/*
|
|
* A working configuration was found enable the device
|
|
* with this configuration.
|
|
*/
|
|
reason = "no callback";
|
|
if (idev->id_config_cb) {
|
|
idev->id_config_cb(idev->id_config_arg,
|
|
cfg, 1);
|
|
free(cfg, M_TEMP);
|
|
return (1);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Disable the device.
|
|
*/
|
|
bus_print_child_header(device_get_parent(child), child);
|
|
printf(" can't assign resources (%s)\n", reason);
|
|
if (bootverbose)
|
|
isa_print_child(device_get_parent(child), child);
|
|
bzero(cfg, sizeof (*cfg));
|
|
if (idev->id_config_cb)
|
|
idev->id_config_cb(idev->id_config_arg, cfg, 0);
|
|
device_disable(child);
|
|
|
|
free(cfg, M_TEMP);
|
|
return (0);
|
|
}
|
|
|
|
/*
|
|
* Claim any unallocated resources to keep other devices from using
|
|
* them.
|
|
*/
|
|
static void
|
|
isa_claim_resources(device_t dev, device_t child)
|
|
{
|
|
struct isa_device *idev = DEVTOISA(child);
|
|
struct resource_list *rl = &idev->id_resources;
|
|
struct resource_list_entry *rle;
|
|
int rid;
|
|
|
|
STAILQ_FOREACH(rle, rl, link) {
|
|
if (!rle->res) {
|
|
rid = rle->rid;
|
|
resource_list_alloc(rl, dev, child, rle->type, &rid,
|
|
0, ~0, 1, 0);
|
|
}
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Called after other devices have initialised to probe for isa devices.
|
|
*/
|
|
void
|
|
isa_probe_children(device_t dev)
|
|
{
|
|
struct isa_device *idev;
|
|
device_t *children, child;
|
|
struct isa_config *cfg;
|
|
int nchildren, i, err;
|
|
|
|
/*
|
|
* Create all the non-hinted children by calling drivers'
|
|
* identify methods.
|
|
*/
|
|
bus_generic_probe(dev);
|
|
|
|
if (device_get_children(dev, &children, &nchildren))
|
|
return;
|
|
|
|
/*
|
|
* First disable all pnp devices so that they don't get
|
|
* matched by legacy probes.
|
|
*/
|
|
if (bootverbose)
|
|
printf("isa_probe_children: disabling PnP devices\n");
|
|
|
|
cfg = malloc(sizeof(*cfg), M_TEMP, M_NOWAIT|M_ZERO);
|
|
if (cfg == NULL) {
|
|
free(children, M_TEMP);
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < nchildren; i++) {
|
|
idev = DEVTOISA(children[i]);
|
|
|
|
bzero(cfg, sizeof(*cfg));
|
|
if (idev->id_config_cb)
|
|
idev->id_config_cb(idev->id_config_arg, cfg, 0);
|
|
}
|
|
|
|
free(cfg, M_TEMP);
|
|
|
|
/*
|
|
* Next, probe all the PnP BIOS devices so they can subsume any
|
|
* hints.
|
|
*/
|
|
for (i = 0; i < nchildren; i++) {
|
|
child = children[i];
|
|
idev = DEVTOISA(child);
|
|
|
|
if (idev->id_order > ISA_ORDER_PNPBIOS)
|
|
continue;
|
|
if (!TAILQ_EMPTY(&idev->id_configs) &&
|
|
!isa_assign_resources(child))
|
|
continue;
|
|
|
|
if (device_probe_and_attach(child) == 0)
|
|
isa_claim_resources(dev, child);
|
|
}
|
|
free(children, M_TEMP);
|
|
|
|
/*
|
|
* Next, enumerate hinted devices and probe all non-pnp devices so
|
|
* that they claim their resources first.
|
|
*/
|
|
bus_enumerate_hinted_children(dev);
|
|
if (device_get_children(dev, &children, &nchildren))
|
|
return;
|
|
if (bootverbose)
|
|
printf("isa_probe_children: probing non-PnP devices\n");
|
|
for (i = 0; i < nchildren; i++) {
|
|
child = children[i];
|
|
idev = DEVTOISA(child);
|
|
|
|
if (device_is_attached(child) ||
|
|
!TAILQ_EMPTY(&idev->id_configs))
|
|
continue;
|
|
|
|
err = device_probe_and_attach(child);
|
|
if (err == 0 && idev->id_vendorid == 0 &&
|
|
strcmp(kern_ident, "GENERIC") == 0 &&
|
|
device_is_attached(child))
|
|
device_printf(child,
|
|
"non-PNP ISA device will be removed from GENERIC in FreeBSD 14.\n");
|
|
}
|
|
|
|
/*
|
|
* Finally assign resource to pnp devices and probe them.
|
|
*/
|
|
if (bootverbose)
|
|
printf("isa_probe_children: probing PnP devices\n");
|
|
for (i = 0; i < nchildren; i++) {
|
|
child = children[i];
|
|
idev = DEVTOISA(child);
|
|
|
|
if (device_is_attached(child) || TAILQ_EMPTY(&idev->id_configs))
|
|
continue;
|
|
|
|
if (isa_assign_resources(child)) {
|
|
device_probe_and_attach(child);
|
|
isa_claim_resources(dev, child);
|
|
}
|
|
}
|
|
|
|
free(children, M_TEMP);
|
|
|
|
isa_running = 1;
|
|
}
|
|
|
|
/*
|
|
* Add a new child with default ivars.
|
|
*/
|
|
static device_t
|
|
isa_add_child(device_t dev, u_int order, const char *name, int unit)
|
|
{
|
|
device_t child;
|
|
struct isa_device *idev;
|
|
|
|
child = device_add_child_ordered(dev, order, name, unit);
|
|
if (child == NULL)
|
|
return (child);
|
|
|
|
idev = malloc(sizeof(struct isa_device), M_ISADEV, M_NOWAIT | M_ZERO);
|
|
if (!idev)
|
|
return (0);
|
|
|
|
resource_list_init(&idev->id_resources);
|
|
TAILQ_INIT(&idev->id_configs);
|
|
idev->id_order = order;
|
|
|
|
device_set_ivars(child, idev);
|
|
|
|
return (child);
|
|
}
|
|
|
|
static int
|
|
isa_print_all_resources(device_t dev)
|
|
{
|
|
struct isa_device *idev = DEVTOISA(dev);
|
|
struct resource_list *rl = &idev->id_resources;
|
|
int retval = 0;
|
|
|
|
if (STAILQ_FIRST(rl) || device_get_flags(dev))
|
|
retval += printf(" at");
|
|
|
|
retval += resource_list_print_type(rl, "port", SYS_RES_IOPORT, "%#jx");
|
|
retval += resource_list_print_type(rl, "iomem", SYS_RES_MEMORY, "%#jx");
|
|
retval += resource_list_print_type(rl, "irq", SYS_RES_IRQ, "%jd");
|
|
retval += resource_list_print_type(rl, "drq", SYS_RES_DRQ, "%jd");
|
|
if (device_get_flags(dev))
|
|
retval += printf(" flags %#x", device_get_flags(dev));
|
|
if (idev->id_vendorid)
|
|
retval += printf(" pnpid %s", pnp_eisaformat(idev->id_vendorid));
|
|
|
|
return (retval);
|
|
}
|
|
|
|
static int
|
|
isa_print_child(device_t bus, device_t dev)
|
|
{
|
|
int retval = 0;
|
|
|
|
retval += bus_print_child_header(bus, dev);
|
|
retval += isa_print_all_resources(dev);
|
|
retval += bus_print_child_footer(bus, dev);
|
|
|
|
return (retval);
|
|
}
|
|
|
|
static void
|
|
isa_probe_nomatch(device_t dev, device_t child)
|
|
{
|
|
if (bootverbose) {
|
|
bus_print_child_header(dev, child);
|
|
printf(" failed to probe");
|
|
isa_print_all_resources(child);
|
|
bus_print_child_footer(dev, child);
|
|
}
|
|
|
|
return;
|
|
}
|
|
|
|
static int
|
|
isa_read_ivar(device_t bus, device_t dev, int index, uintptr_t * result)
|
|
{
|
|
struct isa_device* idev = DEVTOISA(dev);
|
|
struct resource_list *rl = &idev->id_resources;
|
|
struct resource_list_entry *rle;
|
|
|
|
switch (index) {
|
|
case ISA_IVAR_PORT_0:
|
|
rle = resource_list_find(rl, SYS_RES_IOPORT, 0);
|
|
if (rle)
|
|
*result = rle->start;
|
|
else
|
|
*result = -1;
|
|
break;
|
|
|
|
case ISA_IVAR_PORT_1:
|
|
rle = resource_list_find(rl, SYS_RES_IOPORT, 1);
|
|
if (rle)
|
|
*result = rle->start;
|
|
else
|
|
*result = -1;
|
|
break;
|
|
|
|
case ISA_IVAR_PORTSIZE_0:
|
|
rle = resource_list_find(rl, SYS_RES_IOPORT, 0);
|
|
if (rle)
|
|
*result = rle->count;
|
|
else
|
|
*result = 0;
|
|
break;
|
|
|
|
case ISA_IVAR_PORTSIZE_1:
|
|
rle = resource_list_find(rl, SYS_RES_IOPORT, 1);
|
|
if (rle)
|
|
*result = rle->count;
|
|
else
|
|
*result = 0;
|
|
break;
|
|
|
|
case ISA_IVAR_MADDR_0:
|
|
rle = resource_list_find(rl, SYS_RES_MEMORY, 0);
|
|
if (rle)
|
|
*result = rle->start;
|
|
else
|
|
*result = -1;
|
|
break;
|
|
|
|
case ISA_IVAR_MADDR_1:
|
|
rle = resource_list_find(rl, SYS_RES_MEMORY, 1);
|
|
if (rle)
|
|
*result = rle->start;
|
|
else
|
|
*result = -1;
|
|
break;
|
|
|
|
case ISA_IVAR_MEMSIZE_0:
|
|
rle = resource_list_find(rl, SYS_RES_MEMORY, 0);
|
|
if (rle)
|
|
*result = rle->count;
|
|
else
|
|
*result = 0;
|
|
break;
|
|
|
|
case ISA_IVAR_MEMSIZE_1:
|
|
rle = resource_list_find(rl, SYS_RES_MEMORY, 1);
|
|
if (rle)
|
|
*result = rle->count;
|
|
else
|
|
*result = 0;
|
|
break;
|
|
|
|
case ISA_IVAR_IRQ_0:
|
|
rle = resource_list_find(rl, SYS_RES_IRQ, 0);
|
|
if (rle)
|
|
*result = rle->start;
|
|
else
|
|
*result = -1;
|
|
break;
|
|
|
|
case ISA_IVAR_IRQ_1:
|
|
rle = resource_list_find(rl, SYS_RES_IRQ, 1);
|
|
if (rle)
|
|
*result = rle->start;
|
|
else
|
|
*result = -1;
|
|
break;
|
|
|
|
case ISA_IVAR_DRQ_0:
|
|
rle = resource_list_find(rl, SYS_RES_DRQ, 0);
|
|
if (rle)
|
|
*result = rle->start;
|
|
else
|
|
*result = -1;
|
|
break;
|
|
|
|
case ISA_IVAR_DRQ_1:
|
|
rle = resource_list_find(rl, SYS_RES_DRQ, 1);
|
|
if (rle)
|
|
*result = rle->start;
|
|
else
|
|
*result = -1;
|
|
break;
|
|
|
|
case ISA_IVAR_VENDORID:
|
|
*result = idev->id_vendorid;
|
|
break;
|
|
|
|
case ISA_IVAR_SERIAL:
|
|
*result = idev->id_serial;
|
|
break;
|
|
|
|
case ISA_IVAR_LOGICALID:
|
|
*result = idev->id_logicalid;
|
|
break;
|
|
|
|
case ISA_IVAR_COMPATID:
|
|
*result = idev->id_compatid;
|
|
break;
|
|
|
|
case ISA_IVAR_CONFIGATTR:
|
|
*result = idev->id_config_attr;
|
|
break;
|
|
|
|
case ISA_IVAR_PNP_CSN:
|
|
*result = idev->id_pnp_csn;
|
|
break;
|
|
|
|
case ISA_IVAR_PNP_LDN:
|
|
*result = idev->id_pnp_ldn;
|
|
break;
|
|
|
|
case ISA_IVAR_PNPBIOS_HANDLE:
|
|
*result = idev->id_pnpbios_handle;
|
|
break;
|
|
|
|
default:
|
|
return (ENOENT);
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
isa_write_ivar(device_t bus, device_t dev, int index, uintptr_t value)
|
|
{
|
|
struct isa_device* idev = DEVTOISA(dev);
|
|
|
|
switch (index) {
|
|
case ISA_IVAR_PORT_0:
|
|
case ISA_IVAR_PORT_1:
|
|
case ISA_IVAR_PORTSIZE_0:
|
|
case ISA_IVAR_PORTSIZE_1:
|
|
case ISA_IVAR_MADDR_0:
|
|
case ISA_IVAR_MADDR_1:
|
|
case ISA_IVAR_MEMSIZE_0:
|
|
case ISA_IVAR_MEMSIZE_1:
|
|
case ISA_IVAR_IRQ_0:
|
|
case ISA_IVAR_IRQ_1:
|
|
case ISA_IVAR_DRQ_0:
|
|
case ISA_IVAR_DRQ_1:
|
|
return (EINVAL);
|
|
|
|
case ISA_IVAR_VENDORID:
|
|
idev->id_vendorid = value;
|
|
break;
|
|
|
|
case ISA_IVAR_SERIAL:
|
|
idev->id_serial = value;
|
|
break;
|
|
|
|
case ISA_IVAR_LOGICALID:
|
|
idev->id_logicalid = value;
|
|
break;
|
|
|
|
case ISA_IVAR_COMPATID:
|
|
idev->id_compatid = value;
|
|
break;
|
|
|
|
case ISA_IVAR_CONFIGATTR:
|
|
idev->id_config_attr = value;
|
|
break;
|
|
|
|
default:
|
|
return (ENOENT);
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
/*
|
|
* Free any resources which the driver missed or which we were holding for
|
|
* it (see isa_probe_children).
|
|
*/
|
|
static void
|
|
isa_child_detached(device_t dev, device_t child)
|
|
{
|
|
struct isa_device* idev = DEVTOISA(child);
|
|
|
|
if (TAILQ_FIRST(&idev->id_configs))
|
|
isa_claim_resources(dev, child);
|
|
}
|
|
|
|
static void
|
|
isa_driver_added(device_t dev, driver_t *driver)
|
|
{
|
|
device_t *children;
|
|
int nchildren, i;
|
|
|
|
/*
|
|
* Don't do anything if drivers are dynamically
|
|
* added during autoconfiguration (cf. ymf724).
|
|
* since that would end up calling identify
|
|
* twice.
|
|
*/
|
|
if (!isa_running)
|
|
return;
|
|
|
|
DEVICE_IDENTIFY(driver, dev);
|
|
if (device_get_children(dev, &children, &nchildren))
|
|
return;
|
|
|
|
for (i = 0; i < nchildren; i++) {
|
|
device_t child = children[i];
|
|
struct isa_device *idev = DEVTOISA(child);
|
|
struct resource_list *rl = &idev->id_resources;
|
|
struct resource_list_entry *rle;
|
|
|
|
if (device_get_state(child) != DS_NOTPRESENT)
|
|
continue;
|
|
if (!device_is_enabled(child))
|
|
continue;
|
|
|
|
/*
|
|
* Free resources which we were holding on behalf of
|
|
* the device.
|
|
*/
|
|
STAILQ_FOREACH(rle, &idev->id_resources, link) {
|
|
if (rle->res)
|
|
resource_list_release(rl, dev, child,
|
|
rle->type,
|
|
rle->rid,
|
|
rle->res);
|
|
}
|
|
|
|
if (TAILQ_FIRST(&idev->id_configs))
|
|
if (!isa_assign_resources(child))
|
|
continue;
|
|
|
|
device_probe_and_attach(child);
|
|
|
|
if (TAILQ_FIRST(&idev->id_configs))
|
|
isa_claim_resources(dev, child);
|
|
}
|
|
|
|
free(children, M_TEMP);
|
|
}
|
|
|
|
static int
|
|
isa_set_resource(device_t dev, device_t child, int type, int rid,
|
|
rman_res_t start, rman_res_t count)
|
|
{
|
|
struct isa_device* idev = DEVTOISA(child);
|
|
struct resource_list *rl = &idev->id_resources;
|
|
|
|
if (type != SYS_RES_IOPORT && type != SYS_RES_MEMORY
|
|
&& type != SYS_RES_IRQ && type != SYS_RES_DRQ)
|
|
return (EINVAL);
|
|
if (rid < 0)
|
|
return (EINVAL);
|
|
if (type == SYS_RES_IOPORT && rid >= ISA_NPORT)
|
|
return (EINVAL);
|
|
if (type == SYS_RES_MEMORY && rid >= ISA_NMEM)
|
|
return (EINVAL);
|
|
if (type == SYS_RES_IRQ && rid >= ISA_NIRQ)
|
|
return (EINVAL);
|
|
if (type == SYS_RES_DRQ && rid >= ISA_NDRQ)
|
|
return (EINVAL);
|
|
|
|
resource_list_add(rl, type, rid, start, start + count - 1, count);
|
|
|
|
return (0);
|
|
}
|
|
|
|
static struct resource_list *
|
|
isa_get_resource_list (device_t dev, device_t child)
|
|
{
|
|
struct isa_device* idev = DEVTOISA(child);
|
|
struct resource_list *rl = &idev->id_resources;
|
|
|
|
if (!rl)
|
|
return (NULL);
|
|
|
|
return (rl);
|
|
}
|
|
|
|
static int
|
|
isa_add_config(device_t dev, device_t child, int priority,
|
|
struct isa_config *config)
|
|
{
|
|
struct isa_device* idev = DEVTOISA(child);
|
|
struct isa_config_entry *newice, *ice;
|
|
|
|
newice = malloc(sizeof *ice, M_DEVBUF, M_NOWAIT);
|
|
if (!newice)
|
|
return (ENOMEM);
|
|
|
|
newice->ice_priority = priority;
|
|
newice->ice_config = *config;
|
|
|
|
TAILQ_FOREACH(ice, &idev->id_configs, ice_link) {
|
|
if (ice->ice_priority > priority)
|
|
break;
|
|
}
|
|
if (ice)
|
|
TAILQ_INSERT_BEFORE(ice, newice, ice_link);
|
|
else
|
|
TAILQ_INSERT_TAIL(&idev->id_configs, newice, ice_link);
|
|
|
|
return (0);
|
|
}
|
|
|
|
static void
|
|
isa_set_config_callback(device_t dev, device_t child, isa_config_cb *fn,
|
|
void *arg)
|
|
{
|
|
struct isa_device* idev = DEVTOISA(child);
|
|
|
|
idev->id_config_cb = fn;
|
|
idev->id_config_arg = arg;
|
|
}
|
|
|
|
static int
|
|
isa_pnp_probe(device_t dev, device_t child, struct isa_pnp_id *ids)
|
|
{
|
|
struct isa_device* idev = DEVTOISA(child);
|
|
|
|
if (!idev->id_vendorid)
|
|
return (ENOENT);
|
|
|
|
while (ids && ids->ip_id) {
|
|
/*
|
|
* Really ought to support >1 compat id per device.
|
|
*/
|
|
if (idev->id_logicalid == ids->ip_id
|
|
|| idev->id_compatid == ids->ip_id) {
|
|
if (ids->ip_desc)
|
|
device_set_desc(child, ids->ip_desc);
|
|
return (0);
|
|
}
|
|
ids++;
|
|
}
|
|
|
|
return (ENXIO);
|
|
}
|
|
|
|
static int
|
|
isa_child_pnpinfo(device_t bus, device_t child, struct sbuf *sb)
|
|
{
|
|
struct isa_device *idev = DEVTOISA(child);
|
|
|
|
if (idev->id_vendorid)
|
|
sbuf_printf(sb, "pnpid=%s",
|
|
pnp_eisaformat(idev->id_vendorid));
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
isa_child_location(device_t bus, device_t child, struct sbuf *sb)
|
|
{
|
|
#if 0
|
|
/* id_pnphandle isn't there yet */
|
|
struct isa_device *idev = DEVTOISA(child);
|
|
|
|
if (idev->id_vendorid)
|
|
sbuf_printf(sbuf, "pnphandle=%d", idev->id_pnphandle);
|
|
#endif
|
|
return (0);
|
|
}
|
|
|
|
static device_method_t isa_methods[] = {
|
|
/* Device interface */
|
|
DEVMETHOD(device_probe, isa_probe),
|
|
DEVMETHOD(device_attach, isa_attach),
|
|
DEVMETHOD(device_detach, bus_generic_detach),
|
|
DEVMETHOD(device_shutdown, bus_generic_shutdown),
|
|
DEVMETHOD(device_suspend, bus_generic_suspend),
|
|
DEVMETHOD(device_resume, bus_generic_resume),
|
|
|
|
/* Bus interface */
|
|
DEVMETHOD(bus_add_child, isa_add_child),
|
|
DEVMETHOD(bus_print_child, isa_print_child),
|
|
DEVMETHOD(bus_probe_nomatch, isa_probe_nomatch),
|
|
DEVMETHOD(bus_read_ivar, isa_read_ivar),
|
|
DEVMETHOD(bus_write_ivar, isa_write_ivar),
|
|
DEVMETHOD(bus_child_detached, isa_child_detached),
|
|
DEVMETHOD(bus_driver_added, isa_driver_added),
|
|
DEVMETHOD(bus_setup_intr, bus_generic_setup_intr),
|
|
DEVMETHOD(bus_teardown_intr, bus_generic_teardown_intr),
|
|
|
|
DEVMETHOD(bus_get_resource_list,isa_get_resource_list),
|
|
DEVMETHOD(bus_alloc_resource, isa_alloc_resource),
|
|
DEVMETHOD(bus_release_resource, isa_release_resource),
|
|
DEVMETHOD(bus_set_resource, isa_set_resource),
|
|
DEVMETHOD(bus_get_resource, bus_generic_rl_get_resource),
|
|
DEVMETHOD(bus_delete_resource, bus_generic_rl_delete_resource),
|
|
DEVMETHOD(bus_activate_resource, bus_generic_activate_resource),
|
|
DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource),
|
|
DEVMETHOD(bus_child_pnpinfo, isa_child_pnpinfo),
|
|
DEVMETHOD(bus_child_location, isa_child_location),
|
|
DEVMETHOD(bus_hinted_child, isa_hinted_child),
|
|
DEVMETHOD(bus_hint_device_unit, isa_hint_device_unit),
|
|
|
|
/* ISA interface */
|
|
DEVMETHOD(isa_add_config, isa_add_config),
|
|
DEVMETHOD(isa_set_config_callback, isa_set_config_callback),
|
|
DEVMETHOD(isa_pnp_probe, isa_pnp_probe),
|
|
|
|
{ 0, 0 }
|
|
};
|
|
|
|
DEFINE_CLASS_0(isa, isa_driver, isa_methods, 0);
|
|
|
|
devclass_t isa_devclass;
|
|
|
|
/*
|
|
* ISA can be attached to a PCI-ISA bridge, or other locations on some
|
|
* platforms.
|
|
*/
|
|
DRIVER_MODULE(isa, isab, isa_driver, isa_devclass, 0, 0);
|
|
DRIVER_MODULE(isa, eisab, isa_driver, isa_devclass, 0, 0);
|
|
MODULE_VERSION(isa, 1);
|
|
|
|
/*
|
|
* Code common to ISA bridges.
|
|
*/
|
|
|
|
devclass_t isab_devclass;
|
|
|
|
int
|
|
isab_attach(device_t dev)
|
|
{
|
|
device_t child;
|
|
|
|
child = device_add_child(dev, "isa", 0);
|
|
if (child != NULL)
|
|
return (bus_generic_attach(dev));
|
|
return (ENXIO);
|
|
}
|
|
|
|
char *
|
|
pnp_eisaformat(uint32_t id)
|
|
{
|
|
uint8_t *data;
|
|
static char idbuf[8];
|
|
const char hextoascii[] = "0123456789abcdef";
|
|
|
|
id = htole32(id);
|
|
data = (uint8_t *)&id;
|
|
idbuf[0] = '@' + ((data[0] & 0x7c) >> 2);
|
|
idbuf[1] = '@' + (((data[0] & 0x3) << 3) + ((data[1] & 0xe0) >> 5));
|
|
idbuf[2] = '@' + (data[1] & 0x1f);
|
|
idbuf[3] = hextoascii[(data[2] >> 4)];
|
|
idbuf[4] = hextoascii[(data[2] & 0xf)];
|
|
idbuf[5] = hextoascii[(data[3] >> 4)];
|
|
idbuf[6] = hextoascii[(data[3] & 0xf)];
|
|
idbuf[7] = 0;
|
|
return(idbuf);
|
|
}
|