Home | History | Annotate | Line # | Download | only in isa
isa.c revision 1.28.2.10
      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.10  mycroft  *	$Id: isa.c,v 1.28.2.10 1993/10/15 03:50:03 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.10  mycroft 		irr = inb(IO_ICU1) & ~IRQ_SLAVE;
    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.10  mycroft 			time -= 0x10000 - (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