Home | History | Annotate | Line # | Download | only in isa
isa.c revision 1.28.2.9
      1       1.1      cgd /*-
      2  1.28.2.7  mycroft  * Copyright (c) 1993 Charles Hannum.
      3       1.1      cgd  * Copyright (c) 1991 The Regents of the University of California.
      4       1.1      cgd  * All rights reserved.
      5       1.1      cgd  *
      6       1.1      cgd  * This code is derived from software contributed to Berkeley by
      7       1.1      cgd  * William Jolitz.
      8       1.1      cgd  *
      9       1.1      cgd  * Redistribution and use in source and binary forms, with or without
     10       1.1      cgd  * modification, are permitted provided that the following conditions
     11       1.1      cgd  * are met:
     12       1.1      cgd  * 1. Redistributions of source code must retain the above copyright
     13       1.1      cgd  *    notice, this list of conditions and the following disclaimer.
     14       1.1      cgd  * 2. Redistributions in binary form must reproduce the above copyright
     15       1.1      cgd  *    notice, this list of conditions and the following disclaimer in the
     16       1.1      cgd  *    documentation and/or other materials provided with the distribution.
     17       1.1      cgd  * 3. All advertising materials mentioning features or use of this software
     18       1.1      cgd  *    must display the following acknowledgement:
     19       1.1      cgd  *	This product includes software developed by the University of
     20       1.1      cgd  *	California, Berkeley and its contributors.
     21       1.1      cgd  * 4. Neither the name of the University nor the names of its contributors
     22       1.1      cgd  *    may be used to endorse or promote products derived from this software
     23       1.1      cgd  *    without specific prior written permission.
     24       1.1      cgd  *
     25       1.1      cgd  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     26       1.1      cgd  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     27       1.1      cgd  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     28       1.1      cgd  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     29       1.1      cgd  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     30       1.1      cgd  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     31       1.1      cgd  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     32       1.1      cgd  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     33       1.1      cgd  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     34       1.1      cgd  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     35       1.1      cgd  * SUCH DAMAGE.
     36       1.1      cgd  *
     37      1.13      cgd  *	from: @(#)isa.c	7.2 (Berkeley) 5/13/91
     38  1.28.2.9  mycroft  *	$Id: isa.c,v 1.28.2.9 1993/10/15 03:16:19 mycroft Exp $
     39       1.1      cgd  */
     40       1.1      cgd 
     41       1.1      cgd /*
     42       1.1      cgd  * code to manage AT bus
     43       1.1      cgd  */
     44       1.1      cgd 
     45       1.1      cgd #include "param.h"
     46       1.1      cgd #include "systm.h"
     47       1.1      cgd #include "conf.h"
     48       1.1      cgd #include "file.h"
     49       1.1      cgd #include "syslog.h"
     50  1.28.2.2  mycroft #include "machine/cpu.h"
     51  1.28.2.6  mycroft #include "machine/pio.h"
     52  1.28.2.1  mycroft #include "sys/device.h"
     53       1.1      cgd #include "vm/vm.h"
     54       1.1      cgd #include "i386/isa/isa.h"
     55  1.28.2.1  mycroft #include "i386/isa/isavar.h"
     56       1.1      cgd #include "i386/isa/icu.h"
     57      1.16  mycroft #include "i386/isa/timerreg.h"
     58      1.28   brezak #include "i386/isa/spkr_reg.h"
     59      1.14  deraadt 
     60  1.28.2.1  mycroft isa_type isa_bustype;				/* type of bus */
     61       1.1      cgd 
     62  1.28.2.1  mycroft static int isaprobe __P((struct device *, struct cfdata *, void *));
     63  1.28.2.2  mycroft static void isaattach __P((struct device *, struct device *, void *));
     64  1.28.2.2  mycroft static int isasubmatch __P((struct device *, struct cfdata *, void *));
     65  1.28.2.1  mycroft 
     66  1.28.2.1  mycroft struct cfdriver isacd =
     67  1.28.2.2  mycroft     { NULL, "isa", isaprobe, isaattach, DV_DULL, sizeof(struct isa_softc) };
     68  1.28.2.1  mycroft 
     69  1.28.2.9  mycroft static void isa_defaultirq __P((void));
     70  1.28.2.2  mycroft static int isaprint __P((void *, char *));
     71  1.28.2.9  mycroft static void isa_flushintrs __P((void));
     72  1.28.2.2  mycroft 
     73  1.28.2.2  mycroft /*
     74  1.28.2.2  mycroft  * We think there might be an ISA bus here.  Check it out.
     75  1.28.2.2  mycroft  */
     76  1.28.2.2  mycroft static int
     77  1.28.2.1  mycroft isaprobe(parent, cf, aux)
     78  1.28.2.1  mycroft 	struct device *parent;
     79  1.28.2.1  mycroft 	struct cfdata *cf;
     80  1.28.2.1  mycroft 	void *aux;
     81  1.28.2.1  mycroft {
     82  1.28.2.1  mycroft 
     83  1.28.2.1  mycroft 	/* XXX should do a real probe */
     84  1.28.2.1  mycroft 	isa_bustype = BUS_ISA;
     85  1.28.2.1  mycroft 	return 1;
     86  1.28.2.1  mycroft }
     87  1.28.2.1  mycroft 
     88  1.28.2.2  mycroft /*
     89  1.28.2.2  mycroft  * Probe succeeded, someone called config_attach.  Now we have to
     90  1.28.2.2  mycroft  * probe the ISA bus itself in our turn.
     91  1.28.2.2  mycroft  */
     92  1.28.2.2  mycroft static void
     93  1.28.2.2  mycroft isaattach(parent, self, aux)
     94  1.28.2.2  mycroft 	struct device *parent, *self;
     95  1.28.2.2  mycroft 	void *aux;
     96  1.28.2.2  mycroft {
     97  1.28.2.2  mycroft 
     98  1.28.2.7  mycroft 	/* XXX should print ISA/EISA & bus clock frequency and anything else
     99  1.28.2.2  mycroft 	   we can figure out? */
    100  1.28.2.2  mycroft 	printf("\n");
    101  1.28.2.2  mycroft 
    102  1.28.2.2  mycroft 	isa_defaultirq();
    103  1.28.2.9  mycroft 	disable_intr();
    104  1.28.2.2  mycroft 	intr_enable(IRQ_SLAVE);
    105  1.28.2.2  mycroft 
    106  1.28.2.2  mycroft 	/* Iterate ``isasubmatch'' over all devices configured here. */
    107  1.28.2.2  mycroft 	(void)config_search(isasubmatch, self, (void *)NULL);
    108  1.28.2.2  mycroft 
    109  1.28.2.5  mycroft 	printf("biomask %x ttymask %x netmask %x impmask %x astmask %s\n",
    110  1.28.2.5  mycroft 	       biomask, ttymask, netmask, impmask, astmask);
    111  1.28.2.9  mycroft 
    112  1.28.2.9  mycroft 	isa_flushintrs();
    113  1.28.2.9  mycroft 	enable_intr();
    114  1.28.2.2  mycroft 	splnone();
    115  1.28.2.2  mycroft }
    116  1.28.2.2  mycroft 
    117  1.28.2.2  mycroft /*
    118  1.28.2.2  mycroft  * isaattach (above) iterates this function over all the sub-devices that
    119  1.28.2.2  mycroft  * were configured at the ``isa'' device.  Our job is to provide defaults
    120  1.28.2.2  mycroft  * and do some internal/external representation conversion (some of which
    121  1.28.2.2  mycroft  * is scheduled to get cleaned up later), then call the device's probe
    122  1.28.2.2  mycroft  * function.  If this says the device is there, we try to reserve ISA
    123  1.28.2.2  mycroft  * bus memory and ports for the device, and attach it.
    124  1.28.2.2  mycroft  *
    125  1.28.2.2  mycroft  * Note that we always return 0, but our ultimate caller (isaattach)
    126  1.28.2.2  mycroft  * does not care that we never `match' anything.  (In fact, our return
    127  1.28.2.2  mycroft  * value is entirely irrelevant; this function is run entirely for its
    128  1.28.2.2  mycroft  * side effects.)
    129  1.28.2.2  mycroft  */
    130  1.28.2.1  mycroft static int
    131  1.28.2.2  mycroft isasubmatch(isa, cf, aux)
    132  1.28.2.2  mycroft 	struct device *isa;
    133  1.28.2.1  mycroft 	struct cfdata *cf;
    134  1.28.2.1  mycroft 	void *aux;
    135  1.28.2.1  mycroft {
    136  1.28.2.2  mycroft 	struct isa_attach_args ia;
    137  1.28.2.1  mycroft 
    138  1.28.2.1  mycroft #ifdef DIAGNOSTIC
    139  1.28.2.2  mycroft 	if (cf->cf_driver->cd_match == NULL) {
    140  1.28.2.2  mycroft 		/* we really ought to add printf formats to panic(). */
    141  1.28.2.1  mycroft 		printf("isasubmatch: no match function for `%s' device\n",
    142  1.28.2.1  mycroft 			cf->cf_driver->cd_name);
    143  1.28.2.1  mycroft 		panic("isasubmatch: no match function\n");
    144  1.28.2.1  mycroft 	}
    145  1.28.2.1  mycroft #endif
    146  1.28.2.1  mycroft 
    147  1.28.2.2  mycroft 	/* Init the info needed in the device probe routine. */
    148  1.28.2.2  mycroft 	ia.ia_iobase = cf->cf_iobase;
    149  1.28.2.2  mycroft 	ia.ia_iosize = cf->cf_iosize;
    150  1.28.2.2  mycroft 	if (cf->cf_irq == -1)
    151  1.28.2.2  mycroft 		ia.ia_irq = IRQUNK;
    152  1.28.2.2  mycroft 	else
    153  1.28.2.2  mycroft 		ia.ia_irq = 1 << cf->cf_irq;
    154  1.28.2.2  mycroft 	ia.ia_drq = cf->cf_drq;
    155  1.28.2.2  mycroft 	ia.ia_maddr = (caddr_t)cf->cf_maddr;
    156  1.28.2.2  mycroft 	ia.ia_msize = cf->cf_msize;
    157  1.28.2.1  mycroft 
    158  1.28.2.2  mycroft 	/* If driver says it's not there, believe it. */
    159  1.28.2.2  mycroft 	if (!cf->cf_driver->cd_match(isa, cf, &ia))
    160  1.28.2.1  mycroft 		return 0;
    161  1.28.2.1  mycroft 
    162  1.28.2.2  mycroft 	/* Driver says it is there.  Try to reserve ports and memory. */
    163  1.28.2.2  mycroft 	if (isa_reserveports(ia.ia_iobase, ia.ia_iosize)) {
    164  1.28.2.2  mycroft 		if (isa_reservemem(ia.ia_maddr, ia.ia_msize))
    165  1.28.2.2  mycroft 			config_attach(isa, cf, &ia, isaprint);	/* victory! */
    166  1.28.2.2  mycroft 		else
    167  1.28.2.2  mycroft 			isa_unreserveports(ia.ia_iobase, ia.ia_iosize);
    168  1.28.2.1  mycroft 	}
    169  1.28.2.1  mycroft 
    170  1.28.2.2  mycroft 	/* In any case, move on to next config entry. */
    171  1.28.2.2  mycroft 	return 0;
    172  1.28.2.1  mycroft }
    173  1.28.2.1  mycroft 
    174  1.28.2.2  mycroft /*
    175  1.28.2.2  mycroft  * Called indirectly via config_attach (see above).  Config has already
    176  1.28.2.2  mycroft  * printed, e.g., "wdc0 at isa0".  We can ignore our ``isaname'' arg
    177  1.28.2.2  mycroft  * (it is always NULL, by definition) and just extend the line with
    178  1.28.2.2  mycroft  * the standard info (port(s), irq, drq, and iomem).
    179  1.28.2.2  mycroft  */
    180  1.28.2.2  mycroft static int
    181  1.28.2.1  mycroft isaprint(aux, isaname)
    182  1.28.2.1  mycroft 	void *aux;
    183  1.28.2.1  mycroft 	char *isaname;
    184  1.28.2.1  mycroft {
    185  1.28.2.1  mycroft 	struct isa_attach_args *ia = aux;
    186  1.28.2.1  mycroft 
    187  1.28.2.1  mycroft 	if (ia->ia_iosize)
    188  1.28.2.1  mycroft 		printf(" port 0x%x", ia->ia_iobase);
    189  1.28.2.1  mycroft 	if (ia->ia_iosize > 1)
    190  1.28.2.1  mycroft 		printf("-0x%x", ia->ia_iobase + ia->ia_iosize - 1);
    191  1.28.2.3  mycroft #ifdef DIAGNOSTIC
    192  1.28.2.3  mycroft 	if (ia->ia_irq == IRQUNK)
    193  1.28.2.4  mycroft 		printf(" THIS IS A BUG ->");
    194  1.28.2.3  mycroft #endif
    195  1.28.2.3  mycroft 	if (ia->ia_irq != IRQNONE)
    196  1.28.2.1  mycroft 		printf(" irq %d", ffs(ia->ia_irq) - 1);
    197  1.28.2.1  mycroft 	if (ia->ia_drq != DRQUNK)
    198  1.28.2.1  mycroft 		printf(" drq %d", ia->ia_drq);
    199  1.28.2.1  mycroft 	if (ia->ia_msize)
    200  1.28.2.1  mycroft 		printf(" iomem 0x%x", ia->ia_maddr);
    201  1.28.2.1  mycroft 	if (ia->ia_msize > 1)
    202  1.28.2.1  mycroft 		printf("-0x%x", ia->ia_maddr + ia->ia_msize - 1);
    203  1.28.2.7  mycroft 	/* XXXX print flags */
    204  1.28.2.2  mycroft 	return QUIET;	/* actually, our return value is irrelevant. */
    205       1.1      cgd }
    206       1.1      cgd 
    207       1.1      cgd 
    208       1.1      cgd #define	IDTVEC(name)	__CONCAT(X,name)
    209       1.1      cgd /* default interrupt vector table entries */
    210  1.28.2.7  mycroft extern	*IDTVEC(intr)[NIRQ];
    211       1.1      cgd /* out of range default interrupt vector gate entry */
    212  1.28.2.7  mycroft extern	IDTVEC(stray);
    213      1.15      cgd 
    214       1.1      cgd /*
    215  1.28.2.1  mycroft  * Fill in default interrupt table, and mask all interrupts.
    216       1.1      cgd  */
    217  1.28.2.9  mycroft static void
    218  1.28.2.1  mycroft isa_defaultirq()
    219  1.28.2.1  mycroft {
    220       1.1      cgd 	int i;
    221       1.1      cgd 
    222       1.1      cgd 	/* icu vectors */
    223  1.28.2.1  mycroft 	for (i = ICU_OFFSET; i < ICU_OFFSET + ICU_LEN ; i++)
    224  1.28.2.7  mycroft 		setidt(i, IDTVEC(intr)[i],  SDT_SYS386IGT, SEL_KPL);
    225      1.15      cgd 
    226       1.1      cgd 	/* out of range vectors */
    227  1.28.2.1  mycroft 	for (; i < NIDT; i++)
    228  1.28.2.7  mycroft 		setidt(i, &IDTVEC(stray), SDT_SYS386IGT, SEL_KPL);
    229       1.1      cgd 
    230       1.1      cgd 	/* initialize 8259's */
    231       1.1      cgd 	outb(IO_ICU1, 0x11);		/* reset; program device, four bytes */
    232  1.28.2.1  mycroft 	outb(IO_ICU1+1, ICU_OFFSET);	/* starting at this vector index */
    233  1.28.2.1  mycroft 	outb(IO_ICU1+1, IRQ_SLAVE);
    234      1.15      cgd #ifdef AUTO_EOI_1
    235      1.15      cgd 	outb(IO_ICU1+1, 2 | 1);		/* auto EOI, 8086 mode */
    236      1.15      cgd #else
    237       1.1      cgd 	outb(IO_ICU1+1, 1);		/* 8086 mode */
    238      1.15      cgd #endif
    239       1.1      cgd 	outb(IO_ICU1+1, 0xff);		/* leave interrupts masked */
    240  1.28.2.8  mycroft 	outb(IO_ICU1, 0x0a);		/* default to IRR on read */
    241      1.21   andrew #ifdef REORDER_IRQ
    242      1.15      cgd 	outb(IO_ICU1, 0xc0 | (3 - 1));	/* pri order 3-7, 0-2 (com2 first) */
    243      1.21   andrew #endif
    244       1.1      cgd 
    245       1.1      cgd 	outb(IO_ICU2, 0x11);		/* reset; program device, four bytes */
    246  1.28.2.1  mycroft 	outb(IO_ICU2+1, ICU_OFFSET+8);	/* staring at this vector index */
    247  1.28.2.1  mycroft 	outb(IO_ICU2+1, ffs(IRQ_SLAVE)-1);
    248      1.15      cgd #ifdef AUTO_EOI_2
    249      1.15      cgd 	outb(IO_ICU2+1, 2 | 1);		/* auto EOI, 8086 mode */
    250      1.15      cgd #else
    251  1.28.2.1  mycroft 	outb(IO_ICU2+1, 1);		/* 8086 mode */
    252      1.15      cgd #endif
    253       1.1      cgd 	outb(IO_ICU2+1, 0xff);		/* leave interrupts masked */
    254      1.15      cgd 	outb(IO_ICU2, 0x0a);		/* default to IRR on read */
    255  1.28.2.8  mycroft }
    256  1.28.2.8  mycroft 
    257  1.28.2.8  mycroft /*
    258  1.28.2.9  mycroft  * Flush any pending interrupts.
    259  1.28.2.9  mycroft  */
    260  1.28.2.9  mycroft static void
    261  1.28.2.9  mycroft isa_flushintrs()
    262  1.28.2.9  mycroft {
    263  1.28.2.9  mycroft 	register int i;
    264  1.28.2.9  mycroft 
    265  1.28.2.9  mycroft 	/* clear any pending interrupts */
    266  1.28.2.9  mycroft 	for (i = 0; i < 8; i++) {
    267  1.28.2.9  mycroft 		outb(IO_ICU1, ICU_EOI);
    268  1.28.2.9  mycroft 		outb(IO_ICU2, ICU_EOI);
    269  1.28.2.9  mycroft 	}
    270  1.28.2.9  mycroft }
    271  1.28.2.9  mycroft 
    272  1.28.2.9  mycroft /*
    273  1.28.2.8  mycroft  * Determine what IRQ a device is using by trying to force it to generate an
    274  1.28.2.8  mycroft  * interrupt and seeing which IRQ line goes high.  It is not safe to call
    275  1.28.2.8  mycroft  * this function after autoconfig.
    276  1.28.2.8  mycroft  */
    277  1.28.2.8  mycroft u_short
    278  1.28.2.8  mycroft isa_discoverintr(force, aux)
    279  1.28.2.8  mycroft 	void (*force)();
    280  1.28.2.8  mycroft {
    281  1.28.2.8  mycroft 	int time = TIMER_FREQ * 1;	/* wait up to 1 second */
    282  1.28.2.8  mycroft 	u_int last, now;
    283  1.28.2.8  mycroft 	u_short iobase = IO_TIMER1;
    284  1.28.2.8  mycroft 
    285  1.28.2.9  mycroft 	isa_flushintrs();
    286  1.28.2.8  mycroft 	/* attempt to force interrupt */
    287  1.28.2.8  mycroft 	force(aux);
    288  1.28.2.8  mycroft 	/* set timer 2 to a known state */
    289  1.28.2.8  mycroft 	outb(iobase + TIMER_MODE, TIMER_SEL2|TIMER_RATEGEN|TIMER_16BIT);
    290  1.28.2.8  mycroft 	outb(iobase + TIMER_CNTR2, 0xff);
    291  1.28.2.8  mycroft 	outb(iobase + TIMER_CNTR2, 0xff);
    292  1.28.2.8  mycroft 	last = 0xffff;
    293  1.28.2.8  mycroft 	while (time > 0) {
    294  1.28.2.8  mycroft 		register u_char irr, lo, hi;
    295  1.28.2.8  mycroft 		irr = inb(IO_ICU1);
    296  1.28.2.8  mycroft 		if (irr)
    297  1.28.2.8  mycroft 			return 1 << (ffs(irr) - 1);
    298  1.28.2.8  mycroft 		irr = inb(IO_ICU2);
    299  1.28.2.8  mycroft 		if (irr)
    300  1.28.2.8  mycroft 			return 1 << (ffs(irr) + 7);
    301  1.28.2.8  mycroft 		outb(iobase + TIMER_MODE, TIMER_SEL2|TIMER_LATCH);
    302  1.28.2.8  mycroft 		lo = inb(iobase + TIMER_CNTR2);
    303  1.28.2.8  mycroft 		hi = inb(iobase + TIMER_CNTR2);
    304  1.28.2.8  mycroft 		now = (hi << 8) | lo;
    305  1.28.2.8  mycroft 		if (now <= last)
    306  1.28.2.8  mycroft 			time -= (last - now);
    307  1.28.2.8  mycroft 		else
    308  1.28.2.8  mycroft 			time -= 0xffff - (now - last);
    309  1.28.2.8  mycroft 		last = now;
    310  1.28.2.8  mycroft 	}
    311  1.28.2.8  mycroft 	return IRQNONE;
    312       1.1      cgd }
    313       1.1      cgd 
    314       1.1      cgd /*
    315       1.1      cgd  * Handle a NMI, possibly a machine check.
    316       1.1      cgd  * return true to panic system, false to ignore.
    317  1.28.2.7  mycroft  *
    318  1.28.2.7  mycroft  * This implementation is hist[oe]rical.
    319       1.1      cgd  */
    320      1.21   andrew int
    321  1.28.2.7  mycroft isa_nmi()
    322  1.28.2.7  mycroft {
    323       1.1      cgd 
    324  1.28.2.7  mycroft 	log(LOG_CRIT, "NMI port 61 %x, port 70 %x\n", inb(0x61), inb(0x70));
    325  1.28.2.7  mycroft 	return 0;
    326       1.1      cgd }
    327       1.1      cgd 
    328       1.1      cgd /*
    329       1.1      cgd  * Caught a stray interrupt, notify
    330       1.1      cgd  */
    331      1.21   andrew void
    332  1.28.2.1  mycroft isa_strayintr(d)
    333  1.28.2.1  mycroft 	int d;
    334  1.28.2.1  mycroft {
    335  1.28.2.7  mycroft 	extern u_long intrcnt_stray;
    336       1.1      cgd 
    337       1.4      cgd 	/*
    338  1.28.2.1  mycroft 	 * Stray level 7 interrupts occur when someone raises an interrupt
    339  1.28.2.1  mycroft 	 * and then drops it before the CPU acknowledges it.  This means
    340  1.28.2.7  mycroft 	 * either the device is screwed or something is cli'ing too long
    341  1.28.2.7  mycroft 	 * and it's timing out.
    342  1.28.2.7  mycroft 	 *
    343  1.28.2.7  mycroft 	 * -1 is passed by the generic handler for out of range exceptions,
    344  1.28.2.7  mycroft 	 * since we don't really want 208 little vectors.  (It wouldn't be
    345  1.28.2.7  mycroft 	 * all that much code, but why bother?)
    346       1.4      cgd 	 */
    347  1.28.2.7  mycroft 	if (intrcnt_stray++ < 5)
    348  1.28.2.7  mycroft 		if (d == -1)
    349  1.28.2.7  mycroft 			log(LOG_ERR, "wild interrupt\n");
    350  1.28.2.7  mycroft 		else
    351  1.28.2.7  mycroft 			log(LOG_ERR, "stray interrupt %d\n", d);
    352      1.15      cgd 	if (intrcnt_stray == 5)
    353  1.28.2.7  mycroft 		log(LOG_ERR, "too many stray interrupts; stopped logging\n");
    354       1.1      cgd }
    355       1.1      cgd 
    356  1.28.2.7  mycroft static int beeping;
    357  1.28.2.7  mycroft 
    358      1.21   andrew static void
    359      1.21   andrew sysbeepstop(int f)
    360       1.1      cgd {
    361      1.16  mycroft 
    362       1.1      cgd 	/* disable counter 2 */
    363      1.16  mycroft 	disable_intr();
    364      1.28   brezak 	outb(PITAUX_PORT, inb(PITAUX_PORT) & ~PIT_SPKR);
    365      1.16  mycroft 	enable_intr();
    366       1.1      cgd 	if (f)
    367      1.24  deraadt 		timeout((timeout_t)sysbeepstop, (caddr_t)0, f);
    368       1.1      cgd 	else
    369       1.1      cgd 		beeping = 0;
    370       1.1      cgd }
    371       1.1      cgd 
    372      1.21   andrew void
    373      1.21   andrew sysbeep(int pitch, int period)
    374       1.1      cgd {
    375      1.16  mycroft 	static int last_pitch, last_period;
    376       1.1      cgd 
    377      1.16  mycroft 	if (beeping) {
    378      1.24  deraadt 		untimeout((timeout_t)sysbeepstop, (caddr_t)(last_period/2));
    379      1.24  deraadt 		untimeout((timeout_t)sysbeepstop, (caddr_t)0);
    380       1.1      cgd 	}
    381      1.16  mycroft 	if (!beeping || last_pitch != pitch) {
    382      1.16  mycroft 		/*
    383  1.28.2.7  mycroft 		 * XXX - move timer stuff to clock.c.
    384  1.28.2.7  mycroft 		 */
    385      1.16  mycroft 		disable_intr();
    386      1.16  mycroft 		outb(TIMER_MODE, TIMER_SEL2|TIMER_16BIT|TIMER_SQWAVE);
    387  1.28.2.7  mycroft 		outb(TIMER_CNTR2, TIMER_DIV(pitch));
    388  1.28.2.7  mycroft 		outb(TIMER_CNTR2, TIMER_DIV(pitch)>>8);
    389      1.28   brezak 		outb(PITAUX_PORT, inb(PITAUX_PORT) | PIT_SPKR);	/* enable counter 2 */
    390      1.16  mycroft 		enable_intr();
    391      1.16  mycroft 	}
    392      1.16  mycroft 	last_pitch = pitch;
    393      1.16  mycroft 	beeping = last_period = period;
    394      1.24  deraadt 	timeout((timeout_t)sysbeepstop, (caddr_t)(period/2), period);
    395       1.1      cgd }
    396