Home | History | Annotate | Line # | Download | only in isa
isabus.c revision 1.24
      1  1.24     lukem /*	$NetBSD: isabus.c,v 1.24 2003/07/15 00:04:47 lukem Exp $	*/
      2   1.6      soda /*	$OpenBSD: isabus.c,v 1.15 1998/03/16 09:38:46 pefo Exp $	*/
      3   1.5      soda /*	NetBSD: isa.c,v 1.33 1995/06/28 04:30:51 cgd Exp 	*/
      4   1.1  jonathan 
      5   1.1  jonathan /*-
      6   1.1  jonathan  * Copyright (c) 1995 Per Fogelstrom
      7   1.3   mycroft  * Copyright (c) 1993, 1994 Charles M. Hannum.
      8   1.1  jonathan  * Copyright (c) 1990 The Regents of the University of California.
      9   1.1  jonathan  * All rights reserved.
     10   1.1  jonathan  *
     11   1.1  jonathan  * This code is derived from software contributed to Berkeley by
     12   1.1  jonathan  * William Jolitz and Don Ahn.
     13   1.1  jonathan  *
     14   1.1  jonathan  * Redistribution and use in source and binary forms, with or without
     15   1.1  jonathan  * modification, are permitted provided that the following conditions
     16   1.1  jonathan  * are met:
     17   1.1  jonathan  * 1. Redistributions of source code must retain the above copyright
     18   1.1  jonathan  *    notice, this list of conditions and the following disclaimer.
     19   1.1  jonathan  * 2. Redistributions in binary form must reproduce the above copyright
     20   1.1  jonathan  *    notice, this list of conditions and the following disclaimer in the
     21   1.1  jonathan  *    documentation and/or other materials provided with the distribution.
     22   1.1  jonathan  * 3. All advertising materials mentioning features or use of this software
     23   1.1  jonathan  *    must display the following acknowledgement:
     24   1.1  jonathan  *	This product includes software developed by the University of
     25   1.1  jonathan  *	California, Berkeley and its contributors.
     26   1.1  jonathan  * 4. Neither the name of the University nor the names of its contributors
     27   1.1  jonathan  *    may be used to endorse or promote products derived from this software
     28   1.1  jonathan  *    without specific prior written permission.
     29   1.1  jonathan  *
     30   1.1  jonathan  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     31   1.1  jonathan  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     32   1.1  jonathan  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     33   1.1  jonathan  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     34   1.1  jonathan  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     35   1.1  jonathan  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     36   1.1  jonathan  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     37   1.1  jonathan  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     38   1.1  jonathan  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     39   1.1  jonathan  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     40   1.1  jonathan  * SUCH DAMAGE.
     41   1.1  jonathan  *
     42   1.1  jonathan  *	@(#)isa.c	7.2 (Berkeley) 5/12/91
     43   1.1  jonathan  */
     44   1.1  jonathan /*
     45   1.1  jonathan  * Mach Operating System
     46   1.1  jonathan  * Copyright (c) 1991,1990,1989 Carnegie Mellon University
     47   1.1  jonathan  * All Rights Reserved.
     48   1.1  jonathan  *
     49   1.1  jonathan  * Permission to use, copy, modify and distribute this software and its
     50   1.1  jonathan  * documentation is hereby granted, provided that both the copyright
     51   1.1  jonathan  * notice and this permission notice appear in all copies of the
     52   1.1  jonathan  * software, derivative works or modified versions, and any portions
     53   1.1  jonathan  * thereof, and that both notices appear in supporting documentation.
     54   1.1  jonathan  *
     55   1.1  jonathan  * CARNEGIE MELLON ALLOWS FREE USE OF THIS SOFTWARE IN ITS "AS IS"
     56   1.1  jonathan  * CONDITION.  CARNEGIE MELLON DISCLAIMS ANY LIABILITY OF ANY KIND FOR
     57   1.1  jonathan  * ANY DAMAGES WHATSOEVER RESULTING FROM THE USE OF THIS SOFTWARE.
     58   1.1  jonathan  *
     59   1.1  jonathan  * Carnegie Mellon requests users of this software to return to
     60   1.1  jonathan  *
     61   1.1  jonathan  *  Software Distribution Coordinator  or  Software.Distribution (at) CS.CMU.EDU
     62   1.1  jonathan  *  School of Computer Science
     63   1.1  jonathan  *  Carnegie Mellon University
     64   1.1  jonathan  *  Pittsburgh PA 15213-3890
     65   1.1  jonathan  *
     66   1.1  jonathan  * any improvements or extensions that they make and grant Carnegie Mellon
     67   1.1  jonathan  * the rights to redistribute these changes.
     68   1.1  jonathan  */
     69   1.1  jonathan /*
     70   1.1  jonathan   Copyright 1988, 1989 by Intel Corporation, Santa Clara, California.
     71   1.1  jonathan 
     72   1.1  jonathan 		All Rights Reserved
     73   1.1  jonathan 
     74   1.1  jonathan Permission to use, copy, modify, and distribute this software and
     75   1.1  jonathan its documentation for any purpose and without fee is hereby
     76   1.1  jonathan granted, provided that the above copyright notice appears in all
     77   1.1  jonathan copies and that both the copyright notice and this permission notice
     78   1.1  jonathan appear in supporting documentation, and that the name of Intel
     79   1.1  jonathan not be used in advertising or publicity pertaining to distribution
     80   1.1  jonathan of the software without specific, written prior permission.
     81   1.1  jonathan 
     82   1.1  jonathan INTEL DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE
     83   1.1  jonathan INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS,
     84   1.1  jonathan IN NO EVENT SHALL INTEL BE LIABLE FOR ANY SPECIAL, INDIRECT, OR
     85   1.1  jonathan CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM
     86   1.1  jonathan LOSS OF USE, DATA OR PROFITS, WHETHER IN ACTION OF CONTRACT,
     87   1.1  jonathan NEGLIGENCE, OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION
     88   1.1  jonathan WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
     89   1.1  jonathan */
     90  1.24     lukem 
     91  1.24     lukem #include <sys/cdefs.h>
     92  1.24     lukem __KERNEL_RCSID(0, "$NetBSD: isabus.c,v 1.24 2003/07/15 00:04:47 lukem Exp $");
     93   1.1  jonathan 
     94   1.1  jonathan #include <sys/param.h>
     95   1.5      soda #include <sys/proc.h>
     96   1.5      soda #include <sys/user.h>
     97   1.1  jonathan #include <sys/systm.h>
     98   1.8   thorpej #include <sys/callout.h>
     99   1.1  jonathan #include <sys/time.h>
    100   1.1  jonathan #include <sys/kernel.h>
    101   1.1  jonathan #include <sys/device.h>
    102   1.5      soda #include <sys/malloc.h>
    103  1.23   tsutsui #include <sys/extent.h>
    104  1.13       mrg 
    105  1.13       mrg #include <uvm/uvm_extern.h>
    106   1.1  jonathan 
    107   1.1  jonathan #include <machine/cpu.h>
    108   1.1  jonathan #include <machine/pio.h>
    109   1.1  jonathan #include <machine/autoconf.h>
    110   1.5      soda #include <machine/intr.h>
    111   1.1  jonathan 
    112  1.15      soda #include <dev/ic/i8253reg.h>
    113   1.1  jonathan #include <dev/isa/isareg.h>
    114   1.1  jonathan #include <dev/isa/isavar.h>
    115  1.15      soda #include <arc/isa/isabrvar.h>
    116   1.5      soda #include <arc/isa/spkrreg.h>
    117   1.5      soda 
    118   1.5      soda static int beeping;
    119   1.8   thorpej static struct callout sysbeep_ch = CALLOUT_INITIALIZER;
    120   1.5      soda 
    121  1.23   tsutsui static long isa_mem_ex_storage[EXTENT_FIXED_STORAGE_SIZE(16) / sizeof(long)];
    122  1.23   tsutsui static long isa_io_ex_storage[EXTENT_FIXED_STORAGE_SIZE(16) / sizeof(long)];
    123  1.23   tsutsui 
    124   1.5      soda #define	IRQ_SLAVE	2
    125   1.5      soda 
    126   1.5      soda /* Definition of the driver for autoconfig. */
    127   1.5      soda int	isabrprint(void *, const char *);
    128   1.5      soda 
    129  1.10      soda extern struct arc_bus_space arc_bus_io, arc_bus_mem;
    130  1.10      soda 
    131  1.11      soda void	isabr_attach_hook __P((struct device *, struct device *,
    132  1.11      soda 			struct isabus_attach_args *));
    133   1.9       cgd const struct evcnt *isabr_intr_evcnt __P((isa_chipset_tag_t, int));
    134   1.5      soda void	*isabr_intr_establish __P((isa_chipset_tag_t, int, int, int,
    135   1.5      soda 			int (*)(void *), void *));
    136   1.5      soda void	isabr_intr_disestablish __P((isa_chipset_tag_t, void*));
    137   1.5      soda int	isabr_iointr __P((unsigned int, struct clockframe *));
    138   1.5      soda void	isabr_initicu __P((void));
    139   1.5      soda void	intr_calculatemasks __P((void));
    140   1.5      soda int	fakeintr __P((void *a));
    141   1.5      soda 
    142  1.15      soda struct isabr_config *isabr_conf = NULL;
    143  1.20   tsutsui u_int32_t imask[_IPL_N];	/* XXX */
    144   1.5      soda 
    145   1.5      soda void
    146  1.15      soda isabrattach(sc)
    147  1.15      soda 	struct isabr_softc *sc;
    148   1.5      soda {
    149   1.5      soda 	struct isabus_attach_args iba;
    150   1.5      soda 
    151  1.15      soda 	if (isabr_conf == NULL)
    152  1.15      soda 		panic("isabr_conf isn't initialized");
    153  1.15      soda 
    154   1.5      soda 	printf("\n");
    155   1.5      soda 
    156   1.5      soda 	/* Initialize interrupt controller */
    157   1.5      soda 	isabr_initicu();
    158   1.5      soda 
    159   1.5      soda /*XXX we may remove the abus part of the softc struct... */
    160   1.5      soda 	sc->sc_bus.ab_dv = (struct device *)sc;
    161   1.5      soda 	sc->sc_bus.ab_type = BUS_ISABR;
    162   1.5      soda 
    163  1.11      soda 	sc->arc_isa_cs.ic_attach_hook = isabr_attach_hook;
    164   1.9       cgd 	sc->arc_isa_cs.ic_intr_evcnt = isabr_intr_evcnt;
    165   1.5      soda 	sc->arc_isa_cs.ic_intr_establish = isabr_intr_establish;
    166   1.5      soda 	sc->arc_isa_cs.ic_intr_disestablish = isabr_intr_disestablish;
    167  1.23   tsutsui 
    168  1.23   tsutsui 	arc_bus_space_init_extent(&arc_bus_mem, (caddr_t)isa_mem_ex_storage,
    169  1.23   tsutsui 	    sizeof(isa_mem_ex_storage));
    170  1.23   tsutsui 	arc_bus_space_init_extent(&arc_bus_io, (caddr_t)isa_io_ex_storage,
    171  1.23   tsutsui 	    sizeof(isa_io_ex_storage));
    172   1.5      soda 
    173   1.5      soda 	iba.iba_busname = "isa";
    174  1.11      soda 	iba.iba_iot = &arc_bus_io;
    175  1.11      soda 	iba.iba_memt = &arc_bus_mem;
    176  1.11      soda 	iba.iba_dmat = &sc->sc_dmat;
    177   1.5      soda 	iba.iba_ic = &sc->arc_isa_cs;
    178  1.15      soda 	config_found(&sc->sc_dev, &iba, isabrprint);
    179   1.5      soda }
    180   1.5      soda 
    181   1.5      soda int
    182   1.5      soda isabrprint(aux, pnp)
    183   1.5      soda 	void *aux;
    184   1.5      soda 	const char *pnp;
    185   1.5      soda {
    186   1.5      soda 	struct confargs *ca = aux;
    187   1.5      soda 
    188   1.5      soda         if (pnp)
    189  1.17   thorpej                 aprint_normal("%s at %s", ca->ca_name, pnp);
    190  1.17   thorpej         aprint_verbose(" isa_io_base 0x%lx isa_mem_base 0x%lx",
    191  1.10      soda 		arc_bus_io.bs_vbase, arc_bus_mem.bs_vbase);
    192   1.5      soda         return (UNCONF);
    193   1.5      soda }
    194   1.5      soda 
    195   1.5      soda 
    196   1.5      soda /*
    197   1.5      soda  *	Interrupt system driver code
    198   1.5      soda  *	============================
    199   1.5      soda  */
    200   1.5      soda #define LEGAL_IRQ(x)    ((x) >= 0 && (x) < ICU_LEN && (x) != 2)
    201   1.5      soda 
    202   1.5      soda int	imen;
    203   1.5      soda int	intrtype[ICU_LEN], intrmask[ICU_LEN], intrlevel[ICU_LEN];
    204   1.5      soda struct intrhand *intrhand[ICU_LEN];
    205   1.5      soda 
    206   1.5      soda int fakeintr(a)
    207   1.5      soda 	void *a;
    208   1.5      soda {
    209   1.5      soda 	return 0;
    210   1.5      soda }
    211   1.5      soda 
    212   1.5      soda /*
    213   1.5      soda  * Recalculate the interrupt masks from scratch.
    214   1.5      soda  * We could code special registry and deregistry versions of this function that
    215   1.5      soda  * would be faster, but the code would be nastier, and we don't expect this to
    216   1.5      soda  * happen very much anyway.
    217   1.5      soda  */
    218   1.5      soda void
    219   1.5      soda intr_calculatemasks()
    220   1.5      soda {
    221   1.5      soda 	int irq, level;
    222   1.5      soda 	struct intrhand *q;
    223   1.5      soda 
    224   1.5      soda 	/* First, figure out which levels each IRQ uses. */
    225   1.5      soda 	for (irq = 0; irq < ICU_LEN; irq++) {
    226  1.19   tsutsui 		int levels = 0;
    227   1.5      soda 		for (q = intrhand[irq]; q; q = q->ih_next)
    228   1.5      soda 			levels |= 1 << q->ih_level;
    229   1.5      soda 		intrlevel[irq] = levels;
    230   1.5      soda 	}
    231   1.5      soda 
    232   1.5      soda 	/* Then figure out which IRQs use each level. */
    233  1.20   tsutsui 	for (level = 0; level < _IPL_N; level++) {
    234  1.19   tsutsui 		int irqs = 0;
    235   1.5      soda 		for (irq = 0; irq < ICU_LEN; irq++)
    236   1.5      soda 			if (intrlevel[irq] & (1 << level))
    237   1.5      soda 				irqs |= 1 << irq;
    238  1.20   tsutsui 		imask[level] = irqs;
    239   1.5      soda 	}
    240   1.5      soda 
    241  1.20   tsutsui 	imask[IPL_NONE] = 0;
    242  1.20   tsutsui 
    243  1.20   tsutsui 	imask[IPL_SOFT] |= imask[IPL_NONE];
    244  1.20   tsutsui 	imask[IPL_SOFTCLOCK] |= imask[IPL_SOFT];
    245  1.20   tsutsui 	imask[IPL_SOFTNET] |= imask[IPL_SOFTCLOCK];
    246  1.20   tsutsui 	imask[IPL_SOFTSERIAL] |= imask[IPL_SOFTNET];
    247   1.5      soda 
    248   1.5      soda 	/*
    249   1.5      soda 	 * Enforce a hierarchy that gives slow devices a better chance at not
    250   1.5      soda 	 * dropping data.
    251   1.5      soda 	 */
    252  1.20   tsutsui 	imask[IPL_BIO] |= imask[IPL_SOFTSERIAL];
    253   1.5      soda 	imask[IPL_NET] |= imask[IPL_BIO];
    254  1.20   tsutsui 	imask[IPL_TTY] |= imask[IPL_NET];
    255  1.20   tsutsui 
    256  1.20   tsutsui 	/*
    257  1.20   tsutsui 	 * Since run queues may be manipulated by both the statclock and tty,
    258  1.20   tsutsui 	 * network, and diskdrivers, clock > tty.
    259  1.20   tsutsui 	 */
    260  1.20   tsutsui 	imask[IPL_CLOCK] |= imask[IPL_TTY];
    261  1.20   tsutsui 	imask[IPL_STATCLOCK] |= imask[IPL_CLOCK];
    262   1.5      soda 
    263   1.5      soda 	/*
    264  1.20   tsutsui 	 * IPL_HIGH must block everything that can manipulate a run queue.
    265   1.5      soda 	 */
    266  1.20   tsutsui 	imask[IPL_HIGH] |= imask[IPL_STATCLOCK];
    267   1.5      soda 
    268   1.5      soda 	/* And eventually calculate the complete masks. */
    269   1.5      soda 	for (irq = 0; irq < ICU_LEN; irq++) {
    270  1.19   tsutsui 		int irqs = 1 << irq;
    271   1.5      soda 		for (q = intrhand[irq]; q; q = q->ih_next)
    272   1.5      soda 			irqs |= imask[q->ih_level];
    273  1.20   tsutsui 		intrmask[irq] = irqs;
    274   1.5      soda 	}
    275   1.5      soda 
    276   1.5      soda 	/* Lastly, determine which IRQs are actually in use. */
    277   1.5      soda 	{
    278  1.19   tsutsui 		int irqs = 0;
    279   1.5      soda 		for (irq = 0; irq < ICU_LEN; irq++)
    280   1.5      soda 			if (intrhand[irq])
    281   1.5      soda 				irqs |= 1 << irq;
    282   1.5      soda 		if (irqs >= 0x100) /* any IRQs >= 8 in use */
    283   1.5      soda 			irqs |= 1 << IRQ_SLAVE;
    284   1.5      soda 		imen = ~irqs;
    285   1.5      soda 		isa_outb(IO_ICU1 + 1, imen);
    286   1.5      soda 		isa_outb(IO_ICU2 + 1, imen >> 8);
    287   1.5      soda 	}
    288  1.11      soda }
    289  1.11      soda 
    290  1.11      soda void
    291  1.11      soda isabr_attach_hook(parent, self, iba)
    292  1.11      soda 	struct device *parent, *self;
    293  1.11      soda 	struct isabus_attach_args *iba;
    294  1.11      soda {
    295  1.11      soda 
    296  1.11      soda 	/* Nothing to do. */
    297   1.9       cgd }
    298   1.9       cgd 
    299  1.10      soda const struct evcnt *
    300  1.10      soda isabr_intr_evcnt(ic, irq)
    301  1.10      soda 	isa_chipset_tag_t ic;
    302  1.10      soda 	int irq;
    303   1.9       cgd {
    304   1.9       cgd 
    305   1.9       cgd 	/* XXX for now, no evcnt parent reported */
    306   1.9       cgd 	return NULL;
    307   1.5      soda }
    308   1.5      soda 
    309   1.5      soda /*
    310   1.5      soda  *	Establish a ISA bus interrupt.
    311   1.5      soda  */
    312  1.18   tsutsui void *
    313   1.5      soda isabr_intr_establish(ic, irq, type, level, ih_fun, ih_arg)
    314   1.5      soda         isa_chipset_tag_t ic;
    315   1.5      soda         int irq;
    316   1.5      soda         int type;
    317   1.5      soda         int level;
    318   1.5      soda         int (*ih_fun) __P((void *));
    319   1.5      soda         void *ih_arg;
    320   1.5      soda {
    321   1.5      soda 	struct intrhand **p, *q, *ih;
    322   1.5      soda 	static struct intrhand fakehand = {NULL, fakeintr};
    323   1.5      soda 
    324   1.5      soda 	/* no point in sleeping unless someone can free memory. */
    325   1.5      soda 	ih = malloc(sizeof *ih, M_DEVBUF, cold ? M_NOWAIT : M_WAITOK);
    326   1.5      soda 	if (ih == NULL)
    327   1.5      soda 		panic("isa_intr_establish: can't malloc handler info");
    328   1.5      soda 
    329   1.5      soda 	if (!LEGAL_IRQ(irq) || type == IST_NONE)
    330   1.5      soda 		panic("intr_establish: bogus irq or type");
    331   1.5      soda 
    332   1.5      soda 	switch (intrtype[irq]) {
    333  1.22   tsutsui 	case IST_NONE:
    334  1.22   tsutsui 		intrtype[irq] = type;
    335  1.22   tsutsui 		break;
    336   1.5      soda 	case IST_EDGE:
    337   1.5      soda 	case IST_LEVEL:
    338   1.5      soda 		if (type == intrtype[irq])
    339   1.5      soda 			break;
    340   1.5      soda 	case IST_PULSE:
    341   1.5      soda 		if (type != IST_NONE)
    342   1.5      soda 			panic("intr_establish: can't share %s with %s",
    343   1.5      soda 			    isa_intr_typename(intrtype[irq]),
    344   1.5      soda 			    isa_intr_typename(type));
    345   1.5      soda 		break;
    346   1.5      soda 	}
    347   1.5      soda 
    348   1.5      soda 	/*
    349   1.5      soda 	 * Figure out where to put the handler.
    350   1.5      soda 	 * This is O(N^2), but we want to preserve the order, and N is
    351   1.5      soda 	 * generally small.
    352   1.5      soda 	 */
    353   1.5      soda 	for (p = &intrhand[irq]; (q = *p) != NULL; p = &q->ih_next)
    354   1.5      soda 		;
    355   1.5      soda 
    356   1.5      soda 	/*
    357   1.5      soda 	 * Actually install a fake handler momentarily, since we might be doing
    358   1.5      soda 	 * this with interrupts enabled and don't want the real routine called
    359   1.5      soda 	 * until masking is set up.
    360   1.5      soda 	 */
    361   1.5      soda 	fakehand.ih_level = level;
    362   1.5      soda 	*p = &fakehand;
    363   1.5      soda 
    364   1.5      soda 	intr_calculatemasks();
    365   1.5      soda 
    366   1.5      soda 	/*
    367   1.5      soda 	 * Poke the real handler in now.
    368   1.5      soda 	 */
    369   1.5      soda 	ih->ih_fun = ih_fun;
    370   1.5      soda 	ih->ih_arg = ih_arg;
    371   1.5      soda 	ih->ih_count = 0;
    372   1.5      soda 	ih->ih_next = NULL;
    373   1.5      soda 	ih->ih_level = level;
    374   1.5      soda 	ih->ih_irq = irq;
    375   1.5      soda 	ih->ih_what = ""; /* XXX - should be eliminated */
    376   1.5      soda 	*p = ih;
    377   1.5      soda 
    378   1.5      soda 	return (ih);
    379   1.5      soda }
    380   1.5      soda 
    381  1.18   tsutsui void
    382   1.5      soda isabr_intr_disestablish(ic, arg)
    383   1.5      soda         isa_chipset_tag_t ic;
    384  1.18   tsutsui         void *arg;
    385  1.18   tsutsui {
    386   1.5      soda 
    387   1.5      soda }
    388   1.5      soda 
    389   1.5      soda /*
    390   1.5      soda  *	Process an interrupt from the ISA bus.
    391   1.5      soda  */
    392   1.5      soda int
    393   1.5      soda isabr_iointr(mask, cf)
    394   1.5      soda         unsigned mask;
    395   1.5      soda         struct clockframe *cf;
    396   1.5      soda {
    397   1.5      soda 	struct intrhand *ih;
    398   1.5      soda 	int isa_vector;
    399   1.5      soda 	int o_imen;
    400   1.7      soda 
    401  1.15      soda 	isa_vector = (*isabr_conf->ic_intr_status)();
    402  1.15      soda 	if (isa_vector < 0)
    403  1.15      soda 		return (~0);
    404   1.5      soda 
    405   1.5      soda 	o_imen = imen;
    406   1.5      soda 	imen |= 1 << (isa_vector & (ICU_LEN - 1));
    407   1.5      soda 	if(isa_vector & 0x08) {
    408   1.5      soda 		isa_inb(IO_ICU2 + 1);
    409   1.5      soda 		isa_outb(IO_ICU2 + 1, imen >> 8);
    410   1.5      soda 		isa_outb(IO_ICU2, 0x60 + (isa_vector & 7));
    411   1.5      soda 		isa_outb(IO_ICU1, 0x60 + IRQ_SLAVE);
    412   1.5      soda 	}
    413   1.5      soda 	else {
    414   1.5      soda 		isa_inb(IO_ICU1 + 1);
    415   1.5      soda 		isa_outb(IO_ICU1 + 1, imen);
    416   1.5      soda 		isa_outb(IO_ICU1, 0x60 + isa_vector);
    417   1.5      soda 	}
    418   1.5      soda 	ih = intrhand[isa_vector];
    419   1.5      soda 	if(isa_vector == 0) {	/* Clock */	/*XXX*/
    420   1.5      soda 		(*ih->ih_fun)(cf);
    421   1.5      soda 		ih = ih->ih_next;
    422   1.5      soda 	}
    423   1.5      soda 	while(ih) {
    424   1.5      soda 		(*ih->ih_fun)(ih->ih_arg);
    425   1.5      soda 		ih = ih->ih_next;
    426   1.5      soda 	}
    427   1.5      soda 	imen = o_imen;
    428   1.5      soda 	isa_inb(IO_ICU1 + 1);
    429   1.5      soda 	isa_inb(IO_ICU2 + 1);
    430   1.5      soda 	isa_outb(IO_ICU1 + 1, imen);
    431   1.5      soda 	isa_outb(IO_ICU2 + 1, imen >> 8);
    432   1.5      soda 
    433   1.5      soda 	return(~0);  /* Dont reenable */
    434   1.5      soda }
    435   1.5      soda 
    436   1.5      soda 
    437  1.18   tsutsui /*
    438   1.5      soda  * Initialize the Interrupt controller logic.
    439   1.5      soda  */
    440   1.5      soda void
    441   1.5      soda isabr_initicu()
    442  1.18   tsutsui {
    443  1.22   tsutsui 
    444  1.22   tsutsui 	int i;
    445  1.22   tsutsui 
    446  1.22   tsutsui 	for (i = 0; i < ICU_LEN; i++) {
    447  1.22   tsutsui 		switch (i) {
    448  1.22   tsutsui 		case 2:
    449  1.22   tsutsui 		case 8:
    450  1.22   tsutsui 			intrtype[i] = IST_EDGE;
    451  1.22   tsutsui 			break;
    452  1.22   tsutsui 		default:
    453  1.22   tsutsui 			intrtype[i] = IST_NONE;
    454  1.22   tsutsui 			break;
    455  1.22   tsutsui 		}
    456  1.22   tsutsui 	}
    457   1.5      soda 
    458   1.5      soda 	isa_outb(IO_ICU1, 0x11);		/* reset; program device, four bytes */
    459   1.5      soda 	isa_outb(IO_ICU1+1, 0);			/* starting at this vector index */
    460   1.5      soda 	isa_outb(IO_ICU1+1, 1 << IRQ_SLAVE);	/* slave on line 2 */
    461   1.5      soda 	isa_outb(IO_ICU1+1, 1);			/* 8086 mode */
    462   1.5      soda 	isa_outb(IO_ICU1+1, 0xff);		/* leave interrupts masked */
    463   1.5      soda 	isa_outb(IO_ICU1, 0x68);		/* special mask mode (if available) */
    464   1.5      soda 	isa_outb(IO_ICU1, 0x0a);		/* Read IRR by default. */
    465  1.18   tsutsui #ifdef REORDER_IRQ
    466   1.5      soda 	isa_outb(IO_ICU1, 0xc0 | (3 - 1));	/* pri order 3-7, 0-2 (com2 first) */
    467   1.2  jonathan #endif
    468   1.1  jonathan 
    469   1.5      soda 	isa_outb(IO_ICU2, 0x11);		/* reset; program device, four bytes */
    470   1.5      soda 	isa_outb(IO_ICU2+1, 8);			/* staring at this vector index */
    471   1.5      soda 	isa_outb(IO_ICU2+1, IRQ_SLAVE);
    472   1.5      soda 	isa_outb(IO_ICU2+1, 1);			/* 8086 mode */
    473   1.5      soda 	isa_outb(IO_ICU2+1, 0xff);		/* leave interrupts masked */
    474   1.5      soda 	isa_outb(IO_ICU2, 0x68);		/* special mask mode (if available) */
    475   1.5      soda 	isa_outb(IO_ICU2, 0x0a);		/* Read IRR by default. */
    476  1.18   tsutsui }
    477   1.1  jonathan 
    478   1.1  jonathan 
    479   1.5      soda /*
    480   1.5      soda  *	SPEAKER BEEPER...
    481   1.5      soda  */
    482   1.1  jonathan void
    483   1.1  jonathan sysbeepstop(arg)
    484   1.1  jonathan 	void *arg;
    485   1.1  jonathan {
    486   1.1  jonathan 	int s;
    487   1.1  jonathan 
    488   1.1  jonathan 	/* disable counter 2 */
    489   1.1  jonathan 	s = splhigh();
    490   1.1  jonathan 	isa_outb(PITAUX_PORT, isa_inb(PITAUX_PORT) & ~PIT_SPKR);
    491   1.1  jonathan 	splx(s);
    492   1.1  jonathan 	beeping = 0;
    493   1.1  jonathan }
    494   1.1  jonathan 
    495   1.1  jonathan void
    496   1.1  jonathan sysbeep(pitch, period)
    497   1.1  jonathan 	int pitch, period;
    498   1.1  jonathan {
    499   1.1  jonathan 	static int last_pitch, last_period;
    500   1.1  jonathan 	int s;
    501   1.5      soda 
    502   1.5      soda 	if (cold)
    503   1.5      soda 		return;		/* Can't beep yet. */
    504   1.1  jonathan 
    505   1.1  jonathan 	if (beeping)
    506   1.8   thorpej 		callout_stop(&sysbeep_ch);
    507   1.1  jonathan 	if (!beeping || last_pitch != pitch) {
    508   1.1  jonathan 		s = splhigh();
    509   1.5      soda 		isa_outb(IO_TIMER1 + TIMER_MODE,
    510   1.5      soda 		    TIMER_SEL2 | TIMER_16BIT | TIMER_SQWAVE);
    511   1.5      soda 		isa_outb(IO_TIMER1 + TIMER_CNTR2, TIMER_DIV(pitch) % 256);
    512   1.5      soda 		isa_outb(IO_TIMER1 + TIMER_CNTR2, TIMER_DIV(pitch) / 256);
    513   1.1  jonathan 		isa_outb(PITAUX_PORT, isa_inb(PITAUX_PORT) | PIT_SPKR);
    514   1.1  jonathan 		splx(s);
    515   1.1  jonathan 	}
    516   1.1  jonathan 	last_pitch = pitch;
    517   1.1  jonathan 	beeping = last_period = period;
    518   1.8   thorpej 	callout_reset(&sysbeep_ch, period, sysbeepstop, NULL);
    519  1.21   tsutsui }
    520  1.21   tsutsui 
    521  1.21   tsutsui int
    522  1.21   tsutsui isa_intr_alloc(isa_chipset_tag_t c, int mask, int type, int *irq_p)
    523  1.21   tsutsui {
    524  1.21   tsutsui 	int irq;
    525  1.21   tsutsui 	int maybe_irq = -1;
    526  1.21   tsutsui 	int shared_depth = 0;
    527  1.21   tsutsui 	mask &= 0x8b28; /* choose from 3, 5, 8, 9, 11, 15 XXX */
    528  1.21   tsutsui 	for (irq = 0; mask != 0; mask >>= 1, irq++) {
    529  1.21   tsutsui 		if ((mask & 1) == 0)
    530  1.21   tsutsui 			continue;
    531  1.21   tsutsui 		if (intrtype[irq] == IST_NONE) {
    532  1.21   tsutsui 			*irq_p = irq;
    533  1.21   tsutsui 			return 0;
    534  1.21   tsutsui 		}
    535  1.21   tsutsui 		/* Level interrupts can be shared */
    536  1.21   tsutsui 		if (type == IST_LEVEL && intrtype[irq] == IST_LEVEL) {
    537  1.21   tsutsui 			struct intrhand *ih = intrhand[irq];
    538  1.21   tsutsui 			int depth;
    539  1.21   tsutsui 			if (maybe_irq == -1) {
    540  1.21   tsutsui  				maybe_irq = irq;
    541  1.21   tsutsui 				continue;
    542  1.21   tsutsui 			}
    543  1.21   tsutsui 			for (depth = 0; ih != NULL; ih = ih->ih_next)
    544  1.21   tsutsui 				depth++;
    545  1.21   tsutsui 			if (depth < shared_depth) {
    546  1.21   tsutsui 				maybe_irq = irq;
    547  1.21   tsutsui 				shared_depth = depth;
    548  1.21   tsutsui 			}
    549  1.21   tsutsui 		}
    550  1.21   tsutsui 	}
    551  1.21   tsutsui 	if (maybe_irq != -1) {
    552  1.21   tsutsui 		*irq_p = maybe_irq;
    553  1.21   tsutsui 		return 0;
    554  1.21   tsutsui 	}
    555  1.21   tsutsui 	return 1;
    556   1.1  jonathan }
    557