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