123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179 |
- /*-
- * SPDX-License-Identifier: BSD-2-Clause
- *
- * 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.
- */
- #include <sys/param.h>
- #include <sys/systm.h>
- #include <sys/kernel.h>
- #include <sys/bus.h>
- #include <sys/module.h>
- #include <isa/isavar.h>
- #include <isa/isa_common.h>
- #include <machine/resource.h>
- void
- isa_hinted_child(device_t parent, const char *name, int unit)
- {
- device_t child;
- int sensitive, start, count;
- int order;
- /* device-specific flag overrides any wildcard */
- sensitive = 0;
- if (resource_int_value(name, unit, "sensitive", &sensitive) != 0)
- resource_int_value(name, -1, "sensitive", &sensitive);
- if (sensitive)
- order = ISA_ORDER_SENSITIVE;
- else
- order = ISA_ORDER_SPECULATIVE;
- child = BUS_ADD_CHILD(parent, order, name, unit);
- if (child == 0)
- return;
- start = 0;
- count = 0;
- resource_int_value(name, unit, "port", &start);
- resource_int_value(name, unit, "portsize", &count);
- if (start > 0 || count > 0)
- bus_set_resource(child, SYS_RES_IOPORT, 0, start, count);
- start = 0;
- count = 0;
- resource_int_value(name, unit, "maddr", &start);
- resource_int_value(name, unit, "msize", &count);
- if (start > 0 || count > 0)
- bus_set_resource(child, SYS_RES_MEMORY, 0, start, count);
- if (resource_int_value(name, unit, "irq", &start) == 0 && start > 0)
- bus_set_resource(child, SYS_RES_IRQ, 0, start, 1);
- if (resource_int_value(name, unit, "drq", &start) == 0 && start >= 0)
- bus_set_resource(child, SYS_RES_DRQ, 0, start, 1);
- if (resource_disabled(name, unit))
- device_disable(child);
- isa_set_configattr(child, (isa_get_configattr(child)|ISACFGATTR_HINTS));
- }
- static int
- isa_match_resource_hint(device_t dev, int type, long value)
- {
- struct isa_device* idev = DEVTOISA(dev);
- struct resource_list *rl = &idev->id_resources;
- struct resource_list_entry *rle;
- STAILQ_FOREACH(rle, rl, link) {
- if (rle->type != type)
- continue;
- if (rle->start <= value && rle->end >= value)
- return (1);
- }
- return (0);
- }
- void
- isa_hint_device_unit(device_t bus, device_t child, const char *name, int *unitp)
- {
- const char *s;
- long value;
- int line, matches, unit;
- line = 0;
- for (;;) {
- if (resource_find_dev(&line, name, &unit, "at", NULL) != 0)
- break;
- /* Must have an "at" for isa. */
- resource_string_value(name, unit, "at", &s);
- if (!(strcmp(s, device_get_nameunit(bus)) == 0 ||
- strcmp(s, device_get_name(bus)) == 0))
- continue;
- /*
- * Check for matching resources. We must have at
- * least one match. Since I/O and memory resources
- * cannot be shared, if we get a match on either of
- * those, ignore any mismatches in IRQs or DRQs.
- *
- * XXX: We may want to revisit this to be more lenient
- * and wire as long as it gets one match.
- */
- matches = 0;
- if (resource_long_value(name, unit, "port", &value) == 0) {
- /*
- * Floppy drive controllers are notorious for
- * having a wide variety of resources not all
- * of which include the first port that is
- * specified by the hint (typically 0x3f0)
- * (see the comment above
- * fdc_isa_alloc_resources() in fdc_isa.c).
- * However, they do all seem to include port +
- * 2 (e.g. 0x3f2) so for a floppy device, look
- * for 'value + 2' in the port resources
- * instead of the hint value.
- */
- if (strcmp(name, "fdc") == 0)
- value += 2;
- if (isa_match_resource_hint(child, SYS_RES_IOPORT,
- value))
- matches++;
- else
- continue;
- }
- if (resource_long_value(name, unit, "maddr", &value) == 0) {
- if (isa_match_resource_hint(child, SYS_RES_MEMORY,
- value))
- matches++;
- else
- continue;
- }
- if (matches > 0)
- goto matched;
- if (resource_long_value(name, unit, "irq", &value) == 0) {
- if (isa_match_resource_hint(child, SYS_RES_IRQ, value))
- matches++;
- else
- continue;
- }
- if (resource_long_value(name, unit, "drq", &value) == 0) {
- if (isa_match_resource_hint(child, SYS_RES_DRQ, value))
- matches++;
- else
- continue;
- }
- matched:
- if (matches > 0) {
- /* We have a winner! */
- *unitp = unit;
- break;
- }
- }
- }
|