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