mirror of
https://git.FreeBSD.org/src.git
synced 2024-12-18 10:35:55 +00:00
e63149c330
Submitted by: Hidetoshi Shimokawa <simokawa@sat.t.u-tokyo.ac.jp> Obtained from: NetBSD
685 lines
16 KiB
C
685 lines
16 KiB
C
/*-
|
|
* Copyright (c) 1998 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.
|
|
*
|
|
* $Id: isa.c,v 1.7 1998/11/18 23:53:11 dfr Exp $
|
|
*/
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/module.h>
|
|
#include <sys/bus.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/rman.h>
|
|
|
|
#include <isa/isareg.h>
|
|
#include <isa/isavar.h>
|
|
#include <machine/intr.h>
|
|
#include <machine/intrcnt.h>
|
|
#include <machine/resource.h>
|
|
|
|
MALLOC_DEFINE(M_ISADEV, "isadev", "ISA device");
|
|
|
|
/*
|
|
* The structure used to attach devices to the Isa.
|
|
*/
|
|
struct isa_device {
|
|
u_short id_port[ISA_NPORT_IVARS];
|
|
u_short id_portsize[ISA_NPORT_IVARS];
|
|
vm_offset_t id_maddr[ISA_NMEM_IVARS];
|
|
vm_size_t id_msize[ISA_NMEM_IVARS];
|
|
int id_irq[ISA_NIRQ_IVARS];
|
|
int id_drq[ISA_NDRQ_IVARS];
|
|
int id_flags;
|
|
struct resource *id_portres[ISA_NPORT_IVARS];
|
|
struct resource *id_memres[ISA_NMEM_IVARS];
|
|
struct resource *id_irqres[ISA_NIRQ_IVARS];
|
|
struct resource *id_drqres[ISA_NDRQ_IVARS];
|
|
};
|
|
|
|
#define DEVTOISA(dev) ((struct isa_device*) device_get_ivars(dev))
|
|
|
|
static devclass_t isa_devclass;
|
|
static struct rman isa_irq_rman;
|
|
|
|
/*
|
|
* Device methods
|
|
*/
|
|
static int isa_probe(device_t dev);
|
|
static int isa_attach(device_t dev);
|
|
static void isa_print_child(device_t dev, device_t child);
|
|
static int isa_read_ivar(device_t dev, device_t child, int which, u_long *result);
|
|
static int isa_write_ivar(device_t dev, device_t child, int which, u_long result);
|
|
static struct resource *isa_alloc_resource(device_t bus, device_t child,
|
|
int type, int *rid,
|
|
u_long start, u_long end,
|
|
u_long count, u_int flags);
|
|
static int isa_release_resource(device_t bus, device_t child,
|
|
int type, int rid, struct resource *r);
|
|
static int isa_setup_intr(device_t dev, device_t child, struct resource *irq,
|
|
driver_intr_t *intr, void *arg, void **cookiep);
|
|
static int isa_teardown_intr(device_t dev, device_t child,
|
|
struct resource *irq, void *cookie);
|
|
|
|
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),
|
|
|
|
/* Bus interface */
|
|
DEVMETHOD(bus_print_child, isa_print_child),
|
|
DEVMETHOD(bus_read_ivar, isa_read_ivar),
|
|
DEVMETHOD(bus_write_ivar, isa_write_ivar),
|
|
DEVMETHOD(bus_alloc_resource, isa_alloc_resource),
|
|
DEVMETHOD(bus_release_resource, isa_release_resource),
|
|
DEVMETHOD(bus_activate_resource, bus_generic_activate_resource),
|
|
DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource),
|
|
DEVMETHOD(bus_setup_intr, isa_setup_intr),
|
|
DEVMETHOD(bus_teardown_intr, isa_teardown_intr),
|
|
|
|
{ 0, 0 }
|
|
};
|
|
|
|
static driver_t isa_driver = {
|
|
"isa",
|
|
isa_methods,
|
|
DRIVER_TYPE_MISC,
|
|
1, /* no softc */
|
|
};
|
|
|
|
static void
|
|
isa_add_device(device_t dev, const char *name, int unit)
|
|
{
|
|
struct isa_device *idev;
|
|
device_t child;
|
|
int sensitive, t;
|
|
static device_t last_sensitive;
|
|
|
|
if (resource_int_value(name, unit, "sensitive", &sensitive) != 0)
|
|
sensitive = 0;
|
|
|
|
idev = malloc(sizeof(struct isa_device), M_ISADEV, M_NOWAIT);
|
|
if (!idev)
|
|
return;
|
|
bzero(idev, sizeof *idev);
|
|
|
|
if (resource_int_value(name, unit, "port", &t) == 0)
|
|
idev->id_port[0] = t;
|
|
else
|
|
idev->id_port[0] = 0;
|
|
idev->id_port[1] = 0;
|
|
|
|
if (resource_int_value(name, unit, "portsize", &t) == 0)
|
|
idev->id_portsize[0] = t;
|
|
else
|
|
idev->id_portsize[0] = 0;
|
|
idev->id_portsize[1] = 0;
|
|
|
|
if (resource_int_value(name, unit, "iomem", &t) == 0)
|
|
idev->id_maddr[0] = t;
|
|
else
|
|
idev->id_maddr[0] = 0;
|
|
idev->id_maddr[1] = 0;
|
|
|
|
if (resource_int_value(name, unit, "msize", &t) == 0)
|
|
idev->id_msize[0] = t;
|
|
else
|
|
idev->id_msize[0] = 0;
|
|
idev->id_msize[1] = 0;
|
|
|
|
if (resource_int_value(name, unit, "flags", &t) == 0)
|
|
idev->id_flags = t;
|
|
else
|
|
idev->id_flags = 0;
|
|
|
|
if (resource_int_value(name, unit, "irq", &t) == 0)
|
|
idev->id_irq[0] = t;
|
|
else
|
|
idev->id_irq[0] = -1;
|
|
idev->id_irq[1] = -1;
|
|
|
|
if (resource_int_value(name, unit, "drq", &t) == 0)
|
|
idev->id_drq[0] = t;
|
|
else
|
|
idev->id_drq[0] = -1;
|
|
idev->id_drq[1] = -1;
|
|
|
|
if (sensitive)
|
|
child = device_add_child_after(dev, last_sensitive, name,
|
|
unit, idev);
|
|
else
|
|
child = device_add_child(dev, name, unit, idev);
|
|
if (child == 0)
|
|
return;
|
|
else if (sensitive)
|
|
last_sensitive = child;
|
|
|
|
if (resource_int_value(name, unit, "disabled", &t) == 0 && t != 0)
|
|
device_disable(child);
|
|
}
|
|
|
|
static void
|
|
isa_intr_enable(int irq)
|
|
{
|
|
int s = splhigh();
|
|
if (irq < 8)
|
|
outb(IO_ICU1+1, inb(IO_ICU1+1) & ~(1 << irq));
|
|
else
|
|
outb(IO_ICU2+1, inb(IO_ICU2+1) & ~(1 << (irq - 8)));
|
|
splx(s);
|
|
}
|
|
|
|
static void
|
|
isa_intr_disable(int irq)
|
|
{
|
|
int s = splhigh();
|
|
if (irq < 8)
|
|
outb(IO_ICU1+1, inb(IO_ICU1+1) | (1 << irq));
|
|
else
|
|
outb(IO_ICU2+1, inb(IO_ICU2+1) | (1 << (irq - 8)));
|
|
splx(s);
|
|
}
|
|
|
|
int
|
|
isa_irq_pending(void)
|
|
{
|
|
u_char irr1;
|
|
u_char irr2;
|
|
|
|
irr1 = inb(IO_ICU1);
|
|
irr2 = inb(IO_ICU2);
|
|
return ((irr2 << 8) | irr1);
|
|
}
|
|
|
|
int
|
|
isa_irq_mask(void)
|
|
{
|
|
u_char irr1;
|
|
u_char irr2;
|
|
|
|
irr1 = inb(IO_ICU1+1);
|
|
irr2 = inb(IO_ICU2+1);
|
|
return ((irr2 << 8) | irr1);
|
|
}
|
|
|
|
/*
|
|
* 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)
|
|
{
|
|
int i;
|
|
|
|
/*
|
|
* Add all devices configured to be attached to isa0.
|
|
*/
|
|
for (i = resource_query_string(-1, "at", "isa0");
|
|
i != -1;
|
|
i = resource_query_string(i, "at", "isa0")) {
|
|
isa_add_device(dev, resource_query_name(i),
|
|
resource_query_unit(i));
|
|
}
|
|
|
|
isa_irq_rman.rm_start = 0;
|
|
isa_irq_rman.rm_end = 15;
|
|
isa_irq_rman.rm_type = RMAN_ARRAY;
|
|
isa_irq_rman.rm_descr = "ISA Interrupt request lines";
|
|
if (rman_init(&isa_irq_rman)
|
|
|| rman_manage_region(&isa_irq_rman, 0, 1)
|
|
|| rman_manage_region(&isa_irq_rman, 3, 15))
|
|
panic("isa_probe isa_irq_rman");
|
|
|
|
return 0;
|
|
}
|
|
|
|
extern device_t isa_bus_device;
|
|
|
|
static int
|
|
isa_attach(device_t dev)
|
|
{
|
|
if (bootverbose)
|
|
printf("isa_attach: mask=%04x\n", isa_irq_mask());
|
|
|
|
/* mask all isa interrupts */
|
|
outb(IO_ICU1+1, 0xff);
|
|
outb(IO_ICU2+1, 0xff);
|
|
|
|
/* make sure chaining irq is enabled */
|
|
isa_intr_enable(2);
|
|
|
|
/*
|
|
* Arrange for bus_generic_attach(dev) to be called later.
|
|
*/
|
|
isa_bus_device = dev;
|
|
return 0;
|
|
}
|
|
|
|
static void
|
|
isa_print_child(device_t bus, device_t dev)
|
|
{
|
|
struct isa_device *id = DEVTOISA(dev);
|
|
|
|
if (id->id_port[0] > 0 || id->id_port[1]
|
|
|| id->id_maddr[0] > 0 || id->id_maddr[1]
|
|
|| id->id_irq[0] >= 0 || id->id_irq[1] >= 0
|
|
|| id->id_drq[0] >= 0 || id->id_drq[1] >= 0)
|
|
printf(" at");
|
|
if (id->id_port[0] && id->id_port[1]) {
|
|
printf(" ports %#x", (u_int)id->id_port[0]);
|
|
if (id->id_portsize[0])
|
|
printf("-%#x", (u_int)(id->id_port[0]
|
|
+ id->id_portsize[0] - 1));
|
|
printf(" and %#x", (u_int)id->id_port[1]);
|
|
if (id->id_portsize[1])
|
|
printf("-%#x", (u_int)(id->id_port[1]
|
|
+ id->id_portsize[1] - 1));
|
|
} else if (id->id_port[0]) {
|
|
printf(" port %#x", (u_int)id->id_port[0]);
|
|
if (id->id_portsize[0])
|
|
printf("-%#x", (u_int)(id->id_port[0]
|
|
+ id->id_portsize[0] - 1));
|
|
} else if (id->id_port[1]) {
|
|
printf(" port %#x", (u_int)id->id_port[1]);
|
|
if (id->id_portsize[1])
|
|
printf("-%#x", (u_int)(id->id_port[1]
|
|
+ id->id_portsize[1] - 1));
|
|
}
|
|
if (id->id_maddr[0] && id->id_maddr[1]) {
|
|
printf(" iomem %#x", (u_int)id->id_maddr[0]);
|
|
if (id->id_msize[0])
|
|
printf("-%#x", (u_int)(id->id_maddr[0]
|
|
+ id->id_msize[0] - 1));
|
|
printf(" and %#x", (u_int)id->id_maddr[1]);
|
|
if (id->id_msize[1])
|
|
printf("-%#x", (u_int)(id->id_maddr[1]
|
|
+ id->id_msize[1] - 1));
|
|
} else if (id->id_maddr[0]) {
|
|
printf(" iomem %#x", (u_int)id->id_maddr[0]);
|
|
if (id->id_msize[0])
|
|
printf("-%#x", (u_int)(id->id_maddr[0]
|
|
+ id->id_msize[0] - 1));
|
|
} else if (id->id_maddr[1]) {
|
|
printf(" iomem %#x", (u_int)id->id_maddr[1]);
|
|
if (id->id_msize[1])
|
|
printf("-%#x", (u_int)(id->id_maddr[1]
|
|
+ id->id_msize[1] - 1));
|
|
}
|
|
if (id->id_irq[0] >= 0 && id->id_irq[1] >= 0)
|
|
printf(" irqs %d and %d", id->id_irq[0], id->id_irq[1]);
|
|
else if (id->id_irq[0] >= 0)
|
|
printf(" irq %d", id->id_irq[0]);
|
|
else if (id->id_irq[1] >= 0)
|
|
printf(" irq %d", id->id_irq[1]);
|
|
if (id->id_drq[0] >= 0 && id->id_drq[1] >= 0)
|
|
printf(" drqs %d and %d", id->id_drq[0], id->id_drq[1]);
|
|
else if (id->id_drq[0] >= 0)
|
|
printf(" drq %d", id->id_drq[0]);
|
|
else if (id->id_drq[1] >= 0)
|
|
printf(" drq %d", id->id_drq[1]);
|
|
|
|
if (id->id_flags)
|
|
printf(" flags %#x", id->id_flags);
|
|
|
|
printf(" on %s%d",
|
|
device_get_name(bus), device_get_unit(bus));
|
|
}
|
|
|
|
static int
|
|
isa_read_ivar(device_t bus, device_t dev,
|
|
int index, u_long* result)
|
|
{
|
|
struct isa_device* idev = DEVTOISA(dev);
|
|
|
|
switch (index) {
|
|
case ISA_IVAR_PORT_0:
|
|
*result = idev->id_port[0];
|
|
break;
|
|
case ISA_IVAR_PORT_1:
|
|
*result = idev->id_port[1];
|
|
break;
|
|
case ISA_IVAR_PORTSIZE_0:
|
|
*result = idev->id_portsize[0];
|
|
break;
|
|
case ISA_IVAR_PORTSIZE_1:
|
|
*result = idev->id_portsize[1];
|
|
break;
|
|
case ISA_IVAR_MADDR_0:
|
|
*result = idev->id_maddr[0];
|
|
break;
|
|
case ISA_IVAR_MADDR_1:
|
|
*result = idev->id_maddr[1];
|
|
break;
|
|
case ISA_IVAR_MSIZE_0:
|
|
*result = idev->id_msize[0];
|
|
break;
|
|
case ISA_IVAR_MSIZE_1:
|
|
*result = idev->id_msize[1];
|
|
break;
|
|
case ISA_IVAR_IRQ_0:
|
|
*result = idev->id_irq[0];
|
|
break;
|
|
case ISA_IVAR_IRQ_1:
|
|
*result = idev->id_irq[1];
|
|
break;
|
|
case ISA_IVAR_DRQ_0:
|
|
*result = idev->id_drq[0];
|
|
break;
|
|
case ISA_IVAR_DRQ_1:
|
|
*result = idev->id_drq[1];
|
|
break;
|
|
case ISA_IVAR_FLAGS:
|
|
*result = idev->id_flags;
|
|
break;
|
|
}
|
|
return ENOENT;
|
|
}
|
|
|
|
static int
|
|
isa_write_ivar(device_t bus, device_t dev,
|
|
int index, u_long value)
|
|
{
|
|
struct isa_device* idev = DEVTOISA(dev);
|
|
|
|
switch (index) {
|
|
case ISA_IVAR_PORT_0:
|
|
idev->id_port[0] = value;
|
|
break;
|
|
case ISA_IVAR_PORT_1:
|
|
idev->id_port[1] = value;
|
|
break;
|
|
case ISA_IVAR_PORTSIZE_0:
|
|
idev->id_portsize[0] = value;
|
|
break;
|
|
case ISA_IVAR_PORTSIZE_1:
|
|
idev->id_portsize[1] = value;
|
|
break;
|
|
case ISA_IVAR_MADDR_0:
|
|
idev->id_maddr[0] = value;
|
|
break;
|
|
case ISA_IVAR_MADDR_1:
|
|
idev->id_maddr[1] = value;
|
|
break;
|
|
case ISA_IVAR_MSIZE_0:
|
|
idev->id_msize[0] = value;
|
|
break;
|
|
case ISA_IVAR_MSIZE_1:
|
|
idev->id_msize[1] = value;
|
|
break;
|
|
case ISA_IVAR_IRQ_0:
|
|
idev->id_irq[0] = value;
|
|
break;
|
|
case ISA_IVAR_IRQ_1:
|
|
idev->id_irq[1] = value;
|
|
break;
|
|
case ISA_IVAR_DRQ_0:
|
|
idev->id_drq[0] = value;
|
|
break;
|
|
case ISA_IVAR_DRQ_1:
|
|
idev->id_drq[1] = value;
|
|
break;
|
|
case ISA_IVAR_FLAGS:
|
|
idev->id_flags = value;
|
|
break;
|
|
default:
|
|
return (ENOENT);
|
|
}
|
|
return (0);
|
|
}
|
|
|
|
/*
|
|
* This implementation simply passes the request up to the parent
|
|
* bus, which in our case is the pci chipset device, substituting any
|
|
* configured values if the caller defaulted. We can get away with
|
|
* this because there is no special mapping for ISA resources on this
|
|
* platform. When porting this code to another architecture, it may be
|
|
* necessary to interpose a mapping layer here.
|
|
*
|
|
* We manage our own interrupt resources since ISA interrupts go through
|
|
* the ISA PIC, not the PCI interrupt controller.
|
|
*/
|
|
static struct resource *
|
|
isa_alloc_resource(device_t bus, device_t child, int type, int *rid,
|
|
u_long start, u_long end, u_long count, u_int flags)
|
|
{
|
|
int isdefault;
|
|
struct resource *rv, **rvp;
|
|
struct isa_device *id;
|
|
|
|
if (child)
|
|
id = DEVTOISA(child);
|
|
else
|
|
id = NULL;
|
|
isdefault = (start == 0UL && end == ~0UL && *rid == 0);
|
|
if (*rid > 1)
|
|
return 0;
|
|
|
|
switch (type) {
|
|
case SYS_RES_IRQ:
|
|
/*
|
|
* The hack implementation of intr_create() passes a
|
|
* NULL child device.
|
|
*/
|
|
if (isdefault && (id == NULL || id->id_irq[0] >= 0)) {
|
|
start = id->id_irq[0];
|
|
end = id->id_irq[0];
|
|
count = 1;
|
|
}
|
|
rv = rman_reserve_resource(&isa_irq_rman,
|
|
start, end, count,
|
|
0, child);
|
|
if (!rv)
|
|
return 0;
|
|
if (id) {
|
|
id->id_irqres[*rid] = rv;
|
|
id->id_irq[*rid] = rv->r_start;
|
|
}
|
|
return rv;
|
|
|
|
case SYS_RES_MEMORY:
|
|
if (isdefault && id->id_maddr[0]) {
|
|
start = id->id_maddr[0];
|
|
count = max(count, (u_long)id->id_msize[0]);
|
|
end = id->id_maddr[0] + count;
|
|
}
|
|
rvp = &id->id_memres[*rid];
|
|
break;
|
|
|
|
case SYS_RES_IOPORT:
|
|
if (isdefault && id->id_port[0]) {
|
|
start = id->id_port[0];
|
|
count = max(count, (u_long)id->id_portsize[0]);
|
|
end = id->id_port[0] + count;
|
|
}
|
|
rvp = &id->id_portres[*rid];
|
|
break;
|
|
|
|
default:
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* If the client attempts to reallocate a resource without
|
|
* releasing what was there previously, die horribly so that
|
|
* he knows how he !@#$ed up.
|
|
*/
|
|
if (*rvp != 0)
|
|
panic("%s%d: (%d, %d) not free for %s%d\n",
|
|
device_get_name(bus), device_get_unit(bus),
|
|
type, *rid,
|
|
device_get_name(child), device_get_unit(child));
|
|
|
|
/*
|
|
* nexus_alloc_resource had better not change *rid...
|
|
*/
|
|
rv = BUS_ALLOC_RESOURCE(device_get_parent(bus), child, type, rid,
|
|
start, end, count, flags);
|
|
if ((*rvp = rv) != 0) {
|
|
switch (type) {
|
|
case SYS_RES_MEMORY:
|
|
id->id_maddr[*rid] = rv->r_start;
|
|
id->id_msize[*rid] = count;
|
|
break;
|
|
case SYS_RES_IOPORT:
|
|
id->id_port[*rid] = rv->r_start;
|
|
id->id_portsize[*rid] = count;
|
|
break;
|
|
}
|
|
}
|
|
return rv;
|
|
}
|
|
|
|
static int
|
|
isa_release_resource(device_t bus, device_t child, int type, int rid,
|
|
struct resource *r)
|
|
{
|
|
int rv;
|
|
struct resource **rp;
|
|
struct isa_device *id = DEVTOISA(child);
|
|
|
|
if (rid > 1)
|
|
return EINVAL;
|
|
|
|
switch (type) {
|
|
case SYS_RES_IRQ:
|
|
return (rman_release_resource(r));
|
|
case SYS_RES_DRQ:
|
|
case SYS_RES_IOPORT:
|
|
case SYS_RES_MEMORY:
|
|
break;
|
|
default:
|
|
return (ENOENT);
|
|
}
|
|
|
|
rv = BUS_RELEASE_RESOURCE(device_get_parent(bus), child, type, rid, r);
|
|
|
|
if (rv) {
|
|
switch (type) {
|
|
case SYS_RES_IRQ:
|
|
id->id_irqres[rid] = 0;
|
|
id->id_irq[rid] = -1;
|
|
break;
|
|
|
|
case SYS_RES_DRQ:
|
|
id->id_drqres[rid] = 0;
|
|
id->id_drq[rid] = -1;
|
|
break;
|
|
|
|
case SYS_RES_MEMORY:
|
|
id->id_memres[rid] = 0;
|
|
id->id_maddr[rid] = 0;
|
|
id->id_msize[rid] = 0;
|
|
break;
|
|
|
|
case SYS_RES_IOPORT:
|
|
id->id_portres[rid] = 0;
|
|
id->id_port[rid] = 0;
|
|
id->id_portsize[rid] = 0;
|
|
break;
|
|
|
|
default:
|
|
return ENOENT;
|
|
}
|
|
}
|
|
|
|
return rv;
|
|
}
|
|
|
|
struct isa_intr {
|
|
void *ih;
|
|
driver_intr_t *intr;
|
|
void *arg;
|
|
int irq;
|
|
};
|
|
|
|
/*
|
|
* Wrap ISA interrupt routines so that we can feed non-specific
|
|
* EOI to the PICs.
|
|
*/
|
|
|
|
static void
|
|
isa_handle_intr(void *arg)
|
|
{
|
|
struct isa_intr *ii = arg;
|
|
int irq = ii->irq;
|
|
|
|
ii->intr(ii->arg);
|
|
|
|
if (ii->irq > 7)
|
|
outb(IO_ICU2, 0x20 | (irq & 7));
|
|
outb(IO_ICU1, 0x20 | (irq > 7 ? 2 : irq));
|
|
}
|
|
|
|
static int
|
|
isa_setup_intr(device_t dev, device_t child,
|
|
struct resource *irq,
|
|
driver_intr_t *intr, void *arg, void **cookiep)
|
|
{
|
|
struct isa_intr *ii;
|
|
int error;
|
|
|
|
error = rman_activate_resource(irq);
|
|
if (error)
|
|
return error;
|
|
|
|
ii = malloc(sizeof(struct isa_intr), M_DEVBUF, M_NOWAIT);
|
|
if (!ii)
|
|
return ENOMEM;
|
|
ii->intr = intr;
|
|
ii->arg = arg;
|
|
ii->irq = irq->r_start;
|
|
|
|
error = alpha_setup_intr(0x800 + (irq->r_start << 4),
|
|
isa_handle_intr, ii, &ii->ih,
|
|
&intrcnt[INTRCNT_ISA_IRQ + irq->r_start]);
|
|
if (error) {
|
|
free(ii, M_DEVBUF);
|
|
return error;
|
|
}
|
|
isa_intr_enable(irq->r_start);
|
|
|
|
*cookiep = ii;
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
isa_teardown_intr(device_t dev, device_t child,
|
|
struct resource *irq, void *cookie)
|
|
{
|
|
struct isa_intr *ii = cookie;
|
|
|
|
alpha_teardown_intr(ii->ih);
|
|
isa_intr_disable(irq->r_start);
|
|
|
|
return 0;
|
|
}
|
|
|
|
DRIVER_MODULE(isa, cia, isa_driver, isa_devclass, 0, 0);
|
|
DRIVER_MODULE(isa, apecs, isa_driver, isa_devclass, 0, 0);
|
|
DRIVER_MODULE(isa, lca, isa_driver, isa_devclass, 0, 0);
|