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