isabus.c revision 1.13 1 1.13 mrg /* $NetBSD: isabus.c,v 1.13 2000/06/29 08:34:11 mrg 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.13 mrg
101 1.13 mrg #include <uvm/uvm_extern.h>
102 1.1 jonathan
103 1.1 jonathan #include <machine/cpu.h>
104 1.1 jonathan #include <machine/pio.h>
105 1.1 jonathan #include <machine/autoconf.h>
106 1.5 soda #include <machine/intr.h>
107 1.1 jonathan
108 1.5 soda #include <arc/arc/arctype.h>
109 1.5 soda #include <arc/pica/pica.h>
110 1.7 soda #include <arc/pica/rd94.h>
111 1.1 jonathan
112 1.1 jonathan #include <dev/isa/isareg.h>
113 1.1 jonathan #include <dev/isa/isavar.h>
114 1.5 soda #include <arc/isa/timerreg.h>
115 1.5 soda #include <arc/isa/spkrreg.h>
116 1.5 soda #include <machine/isa_machdep.h>
117 1.5 soda
118 1.5 soda static int beeping;
119 1.8 thorpej static struct callout sysbeep_ch = CALLOUT_INITIALIZER;
120 1.5 soda
121 1.5 soda #define IRQ_SLAVE 2
122 1.5 soda #define ICU_LEN 16
123 1.5 soda
124 1.5 soda struct isabr_softc {
125 1.5 soda struct device sc_dv;
126 1.5 soda struct arc_isa_bus arc_isa_cs;
127 1.5 soda struct abus sc_bus;
128 1.11 soda struct arc_bus_dma_tag sc_dmat;
129 1.5 soda };
130 1.5 soda
131 1.5 soda /* Definition of the driver for autoconfig. */
132 1.5 soda int isabrmatch(struct device *, struct cfdata *, void *);
133 1.5 soda void isabrattach(struct device *, struct device *, void *);
134 1.5 soda int isabrprint(void *, const char *);
135 1.5 soda
136 1.5 soda struct cfattach isabr_ca = {
137 1.5 soda sizeof(struct isabr_softc), isabrmatch, isabrattach
138 1.5 soda };
139 1.5 soda extern struct cfdriver isabr_cd;
140 1.5 soda
141 1.10 soda extern struct arc_bus_space arc_bus_io, arc_bus_mem;
142 1.10 soda
143 1.11 soda void isabr_attach_hook __P((struct device *, struct device *,
144 1.11 soda struct isabus_attach_args *));
145 1.9 cgd const struct evcnt *isabr_intr_evcnt __P((isa_chipset_tag_t, int));
146 1.5 soda void *isabr_intr_establish __P((isa_chipset_tag_t, int, int, int,
147 1.5 soda int (*)(void *), void *));
148 1.5 soda void isabr_intr_disestablish __P((isa_chipset_tag_t, void*));
149 1.5 soda int isabr_iointr __P((unsigned int, struct clockframe *));
150 1.5 soda void isabr_initicu __P((void));
151 1.5 soda void intr_calculatemasks __P((void));
152 1.5 soda int fakeintr __P((void *a));
153 1.5 soda
154 1.5 soda int
155 1.5 soda isabrmatch(parent, match, aux)
156 1.5 soda struct device *parent;
157 1.5 soda struct cfdata *match;
158 1.5 soda void *aux;
159 1.5 soda {
160 1.5 soda struct confargs *ca = aux;
161 1.5 soda
162 1.5 soda /* Make sure that we're looking for a ISABR. */
163 1.5 soda if (strcmp(ca->ca_name, isabr_cd.cd_name) != 0)
164 1.5 soda return (0);
165 1.5 soda
166 1.5 soda return (1);
167 1.5 soda }
168 1.5 soda
169 1.5 soda void
170 1.5 soda isabrattach(parent, self, aux)
171 1.5 soda struct device *parent;
172 1.5 soda struct device *self;
173 1.5 soda void *aux;
174 1.5 soda {
175 1.5 soda struct isabr_softc *sc = (struct isabr_softc *)self;
176 1.5 soda struct isabus_attach_args iba;
177 1.5 soda
178 1.5 soda printf("\n");
179 1.5 soda
180 1.5 soda /* Initialize interrupt controller */
181 1.5 soda isabr_initicu();
182 1.5 soda
183 1.5 soda /* set up interrupt handlers */
184 1.5 soda switch(cputype) {
185 1.5 soda case ACER_PICA_61:
186 1.5 soda case MAGNUM:
187 1.10 soda case NEC_R94:
188 1.10 soda case NEC_R96:
189 1.11 soda jazz_bus_dma_tag_init(&sc->sc_dmat);
190 1.5 soda set_intr(MIPS_INT_MASK_2, isabr_iointr, 3);
191 1.5 soda break;
192 1.5 soda case DESKSTATION_TYNE:
193 1.11 soda _bus_dma_tag_init(&sc->sc_dmat); /* XXX dedicated bounce mem */
194 1.5 soda set_intr(MIPS_INT_MASK_2, isabr_iointr, 2);
195 1.5 soda break;
196 1.5 soda case DESKSTATION_RPC44:
197 1.12 soda isadma_bounce_tag_init(&sc->sc_dmat);
198 1.5 soda set_intr(MIPS_INT_MASK_2, isabr_iointr, 2);
199 1.5 soda break;
200 1.5 soda default:
201 1.5 soda panic("isabrattach: unkown cputype!");
202 1.5 soda }
203 1.5 soda
204 1.5 soda /*XXX we may remove the abus part of the softc struct... */
205 1.5 soda sc->sc_bus.ab_dv = (struct device *)sc;
206 1.5 soda sc->sc_bus.ab_type = BUS_ISABR;
207 1.5 soda
208 1.11 soda sc->arc_isa_cs.ic_attach_hook = isabr_attach_hook;
209 1.9 cgd sc->arc_isa_cs.ic_intr_evcnt = isabr_intr_evcnt;
210 1.5 soda sc->arc_isa_cs.ic_intr_establish = isabr_intr_establish;
211 1.5 soda sc->arc_isa_cs.ic_intr_disestablish = isabr_intr_disestablish;
212 1.5 soda
213 1.5 soda iba.iba_busname = "isa";
214 1.11 soda iba.iba_iot = &arc_bus_io;
215 1.11 soda iba.iba_memt = &arc_bus_mem;
216 1.11 soda iba.iba_dmat = &sc->sc_dmat;
217 1.5 soda iba.iba_ic = &sc->arc_isa_cs;
218 1.5 soda config_found(self, &iba, isabrprint);
219 1.5 soda }
220 1.5 soda
221 1.5 soda int
222 1.5 soda isabrprint(aux, pnp)
223 1.5 soda void *aux;
224 1.5 soda const char *pnp;
225 1.5 soda {
226 1.5 soda struct confargs *ca = aux;
227 1.5 soda
228 1.5 soda if (pnp)
229 1.5 soda printf("%s at %s", ca->ca_name, pnp);
230 1.10 soda printf(" isa_io_base 0x%lx isa_mem_base 0x%lx",
231 1.10 soda arc_bus_io.bs_vbase, arc_bus_mem.bs_vbase);
232 1.5 soda return (UNCONF);
233 1.5 soda }
234 1.5 soda
235 1.5 soda
236 1.5 soda /*
237 1.5 soda * Interrupt system driver code
238 1.5 soda * ============================
239 1.5 soda */
240 1.5 soda #define LEGAL_IRQ(x) ((x) >= 0 && (x) < ICU_LEN && (x) != 2)
241 1.5 soda
242 1.5 soda int imen;
243 1.5 soda int intrtype[ICU_LEN], intrmask[ICU_LEN], intrlevel[ICU_LEN];
244 1.5 soda struct intrhand *intrhand[ICU_LEN];
245 1.5 soda
246 1.5 soda int fakeintr(a)
247 1.5 soda void *a;
248 1.5 soda {
249 1.5 soda return 0;
250 1.5 soda }
251 1.5 soda
252 1.5 soda /*
253 1.5 soda * Recalculate the interrupt masks from scratch.
254 1.5 soda * We could code special registry and deregistry versions of this function that
255 1.5 soda * would be faster, but the code would be nastier, and we don't expect this to
256 1.5 soda * happen very much anyway.
257 1.5 soda */
258 1.5 soda void
259 1.5 soda intr_calculatemasks()
260 1.5 soda {
261 1.5 soda int irq, level;
262 1.5 soda struct intrhand *q;
263 1.5 soda
264 1.5 soda /* First, figure out which levels each IRQ uses. */
265 1.5 soda for (irq = 0; irq < ICU_LEN; irq++) {
266 1.5 soda register int levels = 0;
267 1.5 soda for (q = intrhand[irq]; q; q = q->ih_next)
268 1.5 soda levels |= 1 << q->ih_level;
269 1.5 soda intrlevel[irq] = levels;
270 1.5 soda }
271 1.5 soda
272 1.5 soda /* Then figure out which IRQs use each level. */
273 1.5 soda for (level = 0; level < 5; level++) {
274 1.5 soda register int irqs = 0;
275 1.5 soda for (irq = 0; irq < ICU_LEN; irq++)
276 1.5 soda if (intrlevel[irq] & (1 << level))
277 1.5 soda irqs |= 1 << irq;
278 1.5 soda imask[level] = irqs | SIR_ALLMASK;
279 1.5 soda }
280 1.5 soda
281 1.5 soda /*
282 1.5 soda * There are tty, network and disk drivers that use free() at interrupt
283 1.5 soda * time, so imp > (tty | net | bio).
284 1.5 soda */
285 1.5 soda imask[IPL_IMP] |= imask[IPL_TTY] | imask[IPL_NET] | imask[IPL_BIO];
286 1.5 soda
287 1.5 soda /*
288 1.5 soda * Enforce a hierarchy that gives slow devices a better chance at not
289 1.5 soda * dropping data.
290 1.5 soda */
291 1.5 soda imask[IPL_TTY] |= imask[IPL_NET] | imask[IPL_BIO];
292 1.5 soda imask[IPL_NET] |= imask[IPL_BIO];
293 1.5 soda
294 1.5 soda /*
295 1.5 soda * These are pseudo-levels.
296 1.5 soda */
297 1.5 soda imask[IPL_NONE] = 0x00000000;
298 1.5 soda imask[IPL_HIGH] = 0xffffffff;
299 1.5 soda
300 1.5 soda /* And eventually calculate the complete masks. */
301 1.5 soda for (irq = 0; irq < ICU_LEN; irq++) {
302 1.5 soda register int irqs = 1 << irq;
303 1.5 soda for (q = intrhand[irq]; q; q = q->ih_next)
304 1.5 soda irqs |= imask[q->ih_level];
305 1.5 soda intrmask[irq] = irqs | SIR_ALLMASK;
306 1.5 soda }
307 1.5 soda
308 1.5 soda /* Lastly, determine which IRQs are actually in use. */
309 1.5 soda {
310 1.5 soda register int irqs = 0;
311 1.5 soda for (irq = 0; irq < ICU_LEN; irq++)
312 1.5 soda if (intrhand[irq])
313 1.5 soda irqs |= 1 << irq;
314 1.5 soda if (irqs >= 0x100) /* any IRQs >= 8 in use */
315 1.5 soda irqs |= 1 << IRQ_SLAVE;
316 1.5 soda imen = ~irqs;
317 1.5 soda isa_outb(IO_ICU1 + 1, imen);
318 1.5 soda isa_outb(IO_ICU2 + 1, imen >> 8);
319 1.5 soda }
320 1.11 soda }
321 1.11 soda
322 1.11 soda void
323 1.11 soda isabr_attach_hook(parent, self, iba)
324 1.11 soda struct device *parent, *self;
325 1.11 soda struct isabus_attach_args *iba;
326 1.11 soda {
327 1.11 soda
328 1.11 soda /* Nothing to do. */
329 1.9 cgd }
330 1.9 cgd
331 1.10 soda const struct evcnt *
332 1.10 soda isabr_intr_evcnt(ic, irq)
333 1.10 soda isa_chipset_tag_t ic;
334 1.10 soda int irq;
335 1.9 cgd {
336 1.9 cgd
337 1.9 cgd /* XXX for now, no evcnt parent reported */
338 1.9 cgd return NULL;
339 1.5 soda }
340 1.5 soda
341 1.5 soda /*
342 1.5 soda * Establish a ISA bus interrupt.
343 1.5 soda */
344 1.5 soda void *
345 1.5 soda isabr_intr_establish(ic, irq, type, level, ih_fun, ih_arg)
346 1.5 soda isa_chipset_tag_t ic;
347 1.5 soda int irq;
348 1.5 soda int type;
349 1.5 soda int level;
350 1.5 soda int (*ih_fun) __P((void *));
351 1.5 soda void *ih_arg;
352 1.5 soda {
353 1.5 soda struct intrhand **p, *q, *ih;
354 1.5 soda static struct intrhand fakehand = {NULL, fakeintr};
355 1.5 soda extern int cold;
356 1.5 soda
357 1.5 soda /* no point in sleeping unless someone can free memory. */
358 1.5 soda ih = malloc(sizeof *ih, M_DEVBUF, cold ? M_NOWAIT : M_WAITOK);
359 1.5 soda if (ih == NULL)
360 1.5 soda panic("isa_intr_establish: can't malloc handler info");
361 1.5 soda
362 1.5 soda if (!LEGAL_IRQ(irq) || type == IST_NONE)
363 1.5 soda panic("intr_establish: bogus irq or type");
364 1.5 soda
365 1.5 soda switch (intrtype[irq]) {
366 1.5 soda case IST_EDGE:
367 1.5 soda case IST_LEVEL:
368 1.5 soda if (type == intrtype[irq])
369 1.5 soda break;
370 1.5 soda case IST_PULSE:
371 1.5 soda if (type != IST_NONE)
372 1.5 soda panic("intr_establish: can't share %s with %s",
373 1.5 soda isa_intr_typename(intrtype[irq]),
374 1.5 soda isa_intr_typename(type));
375 1.5 soda break;
376 1.5 soda }
377 1.5 soda
378 1.5 soda /*
379 1.5 soda * Figure out where to put the handler.
380 1.5 soda * This is O(N^2), but we want to preserve the order, and N is
381 1.5 soda * generally small.
382 1.5 soda */
383 1.5 soda for (p = &intrhand[irq]; (q = *p) != NULL; p = &q->ih_next)
384 1.5 soda ;
385 1.5 soda
386 1.5 soda /*
387 1.5 soda * Actually install a fake handler momentarily, since we might be doing
388 1.5 soda * this with interrupts enabled and don't want the real routine called
389 1.5 soda * until masking is set up.
390 1.5 soda */
391 1.5 soda fakehand.ih_level = level;
392 1.5 soda *p = &fakehand;
393 1.5 soda
394 1.5 soda intr_calculatemasks();
395 1.5 soda
396 1.5 soda /*
397 1.5 soda * Poke the real handler in now.
398 1.5 soda */
399 1.5 soda ih->ih_fun = ih_fun;
400 1.5 soda ih->ih_arg = ih_arg;
401 1.5 soda ih->ih_count = 0;
402 1.5 soda ih->ih_next = NULL;
403 1.5 soda ih->ih_level = level;
404 1.5 soda ih->ih_irq = irq;
405 1.5 soda ih->ih_what = ""; /* XXX - should be eliminated */
406 1.5 soda *p = ih;
407 1.5 soda
408 1.5 soda return (ih);
409 1.5 soda }
410 1.5 soda
411 1.5 soda void
412 1.5 soda isabr_intr_disestablish(ic, arg)
413 1.5 soda isa_chipset_tag_t ic;
414 1.5 soda void *arg;
415 1.5 soda {
416 1.5 soda
417 1.5 soda }
418 1.5 soda
419 1.5 soda /*
420 1.5 soda * Process an interrupt from the ISA bus.
421 1.5 soda */
422 1.5 soda int
423 1.5 soda isabr_iointr(mask, cf)
424 1.5 soda unsigned mask;
425 1.5 soda struct clockframe *cf;
426 1.5 soda {
427 1.5 soda struct intrhand *ih;
428 1.5 soda int isa_vector;
429 1.5 soda int o_imen;
430 1.5 soda char vector;
431 1.5 soda
432 1.5 soda (void) &isa_vector; /* shut off gcc unused-variable warnings */
433 1.5 soda
434 1.5 soda switch(cputype) {
435 1.5 soda case ACER_PICA_61:
436 1.5 soda case MAGNUM:
437 1.5 soda isa_vector = in32(R4030_SYS_ISA_VECTOR) & (ICU_LEN - 1);
438 1.7 soda break;
439 1.7 soda
440 1.10 soda case NEC_R94:
441 1.10 soda case NEC_R96:
442 1.7 soda isa_vector = in32(RD94_SYS_INTSTAT2) & (ICU_LEN - 1);
443 1.5 soda break;
444 1.5 soda
445 1.5 soda case DESKSTATION_TYNE:
446 1.5 soda isa_outb(IO_ICU1, 0x0f); /* Poll */
447 1.5 soda vector = isa_inb(IO_ICU1);
448 1.5 soda if(vector > 0 || (isa_vector = vector & 7) == 2) {
449 1.5 soda isa_outb(IO_ICU2, 0x0f);
450 1.5 soda vector = isa_inb(IO_ICU2);
451 1.5 soda if(vector > 0) {
452 1.5 soda printf("isa: spurious interrupt.\n");
453 1.5 soda return(~0);
454 1.5 soda }
455 1.5 soda isa_vector = (vector & 7) | 8;
456 1.5 soda }
457 1.5 soda break;
458 1.5 soda
459 1.5 soda case DESKSTATION_RPC44:
460 1.5 soda isa_outb(IO_ICU1, 0x0f); /* Poll */
461 1.5 soda vector = isa_inb(IO_ICU1);
462 1.5 soda if(vector > 0 || (isa_vector = vector & 7) == 2) {
463 1.5 soda isa_outb(IO_ICU2, 0x0f);
464 1.5 soda vector = isa_inb(IO_ICU2);
465 1.5 soda if(vector > 0) {
466 1.5 soda printf("isa: spurious interrupt.\n");
467 1.5 soda return(~0);
468 1.5 soda }
469 1.5 soda isa_vector = (vector & 7) | 8;
470 1.5 soda }
471 1.5 soda break;
472 1.5 soda }
473 1.5 soda
474 1.5 soda o_imen = imen;
475 1.5 soda imen |= 1 << (isa_vector & (ICU_LEN - 1));
476 1.5 soda if(isa_vector & 0x08) {
477 1.5 soda isa_inb(IO_ICU2 + 1);
478 1.5 soda isa_outb(IO_ICU2 + 1, imen >> 8);
479 1.5 soda isa_outb(IO_ICU2, 0x60 + (isa_vector & 7));
480 1.5 soda isa_outb(IO_ICU1, 0x60 + IRQ_SLAVE);
481 1.5 soda }
482 1.5 soda else {
483 1.5 soda isa_inb(IO_ICU1 + 1);
484 1.5 soda isa_outb(IO_ICU1 + 1, imen);
485 1.5 soda isa_outb(IO_ICU1, 0x60 + isa_vector);
486 1.5 soda }
487 1.5 soda ih = intrhand[isa_vector];
488 1.5 soda if(isa_vector == 0) { /* Clock */ /*XXX*/
489 1.5 soda (*ih->ih_fun)(cf);
490 1.5 soda ih = ih->ih_next;
491 1.5 soda }
492 1.5 soda while(ih) {
493 1.5 soda (*ih->ih_fun)(ih->ih_arg);
494 1.5 soda ih = ih->ih_next;
495 1.5 soda }
496 1.5 soda imen = o_imen;
497 1.5 soda isa_inb(IO_ICU1 + 1);
498 1.5 soda isa_inb(IO_ICU2 + 1);
499 1.5 soda isa_outb(IO_ICU1 + 1, imen);
500 1.5 soda isa_outb(IO_ICU2 + 1, imen >> 8);
501 1.5 soda
502 1.5 soda return(~0); /* Dont reenable */
503 1.5 soda }
504 1.5 soda
505 1.5 soda
506 1.5 soda /*
507 1.5 soda * Initialize the Interrupt controller logic.
508 1.5 soda */
509 1.5 soda void
510 1.5 soda isabr_initicu()
511 1.5 soda {
512 1.5 soda
513 1.5 soda isa_outb(IO_ICU1, 0x11); /* reset; program device, four bytes */
514 1.5 soda isa_outb(IO_ICU1+1, 0); /* starting at this vector index */
515 1.5 soda isa_outb(IO_ICU1+1, 1 << IRQ_SLAVE); /* slave on line 2 */
516 1.5 soda isa_outb(IO_ICU1+1, 1); /* 8086 mode */
517 1.5 soda isa_outb(IO_ICU1+1, 0xff); /* leave interrupts masked */
518 1.5 soda isa_outb(IO_ICU1, 0x68); /* special mask mode (if available) */
519 1.5 soda isa_outb(IO_ICU1, 0x0a); /* Read IRR by default. */
520 1.5 soda #ifdef REORDER_IRQ
521 1.5 soda isa_outb(IO_ICU1, 0xc0 | (3 - 1)); /* pri order 3-7, 0-2 (com2 first) */
522 1.2 jonathan #endif
523 1.1 jonathan
524 1.5 soda isa_outb(IO_ICU2, 0x11); /* reset; program device, four bytes */
525 1.5 soda isa_outb(IO_ICU2+1, 8); /* staring at this vector index */
526 1.5 soda isa_outb(IO_ICU2+1, IRQ_SLAVE);
527 1.5 soda isa_outb(IO_ICU2+1, 1); /* 8086 mode */
528 1.5 soda isa_outb(IO_ICU2+1, 0xff); /* leave interrupts masked */
529 1.5 soda isa_outb(IO_ICU2, 0x68); /* special mask mode (if available) */
530 1.5 soda isa_outb(IO_ICU2, 0x0a); /* Read IRR by default. */
531 1.5 soda }
532 1.1 jonathan
533 1.1 jonathan
534 1.5 soda /*
535 1.5 soda * SPEAKER BEEPER...
536 1.5 soda */
537 1.1 jonathan void
538 1.1 jonathan sysbeepstop(arg)
539 1.1 jonathan void *arg;
540 1.1 jonathan {
541 1.1 jonathan int s;
542 1.1 jonathan
543 1.1 jonathan /* disable counter 2 */
544 1.1 jonathan s = splhigh();
545 1.1 jonathan isa_outb(PITAUX_PORT, isa_inb(PITAUX_PORT) & ~PIT_SPKR);
546 1.1 jonathan splx(s);
547 1.1 jonathan beeping = 0;
548 1.1 jonathan }
549 1.1 jonathan
550 1.1 jonathan void
551 1.1 jonathan sysbeep(pitch, period)
552 1.1 jonathan int pitch, period;
553 1.1 jonathan {
554 1.1 jonathan static int last_pitch, last_period;
555 1.1 jonathan int s;
556 1.5 soda extern int cold;
557 1.5 soda
558 1.5 soda if (cold)
559 1.5 soda return; /* Can't beep yet. */
560 1.1 jonathan
561 1.1 jonathan if (beeping)
562 1.8 thorpej callout_stop(&sysbeep_ch);
563 1.1 jonathan if (!beeping || last_pitch != pitch) {
564 1.1 jonathan s = splhigh();
565 1.5 soda isa_outb(IO_TIMER1 + TIMER_MODE,
566 1.5 soda TIMER_SEL2 | TIMER_16BIT | TIMER_SQWAVE);
567 1.5 soda isa_outb(IO_TIMER1 + TIMER_CNTR2, TIMER_DIV(pitch) % 256);
568 1.5 soda isa_outb(IO_TIMER1 + TIMER_CNTR2, TIMER_DIV(pitch) / 256);
569 1.1 jonathan isa_outb(PITAUX_PORT, isa_inb(PITAUX_PORT) | PIT_SPKR);
570 1.1 jonathan splx(s);
571 1.1 jonathan }
572 1.1 jonathan last_pitch = pitch;
573 1.1 jonathan beeping = last_period = period;
574 1.8 thorpej callout_reset(&sysbeep_ch, period, sysbeepstop, NULL);
575 1.1 jonathan }
576