hd6446xintc.c revision 1.1.8.2 1 1.1.8.2 jdolecek /* $NetBSD: hd6446xintc.c,v 1.1.8.2 2002/06/23 17:37:01 jdolecek Exp $ */
2 1.1.8.2 jdolecek
3 1.1.8.2 jdolecek /*-
4 1.1.8.2 jdolecek * Copyright (c) 2002 The NetBSD Foundation, Inc.
5 1.1.8.2 jdolecek * All rights reserved.
6 1.1.8.2 jdolecek *
7 1.1.8.2 jdolecek * This code is derived from software contributed to The NetBSD Foundation
8 1.1.8.2 jdolecek * by UCHIYAMA Yasushi.
9 1.1.8.2 jdolecek *
10 1.1.8.2 jdolecek * Redistribution and use in source and binary forms, with or without
11 1.1.8.2 jdolecek * modification, are permitted provided that the following conditions
12 1.1.8.2 jdolecek * are met:
13 1.1.8.2 jdolecek * 1. Redistributions of source code must retain the above copyright
14 1.1.8.2 jdolecek * notice, this list of conditions and the following disclaimer.
15 1.1.8.2 jdolecek * 2. Redistributions in binary form must reproduce the above copyright
16 1.1.8.2 jdolecek * notice, this list of conditions and the following disclaimer in the
17 1.1.8.2 jdolecek * documentation and/or other materials provided with the distribution.
18 1.1.8.2 jdolecek * 3. All advertising materials mentioning features or use of this software
19 1.1.8.2 jdolecek * must display the following acknowledgement:
20 1.1.8.2 jdolecek * This product includes software developed by the NetBSD
21 1.1.8.2 jdolecek * Foundation, Inc. and its contributors.
22 1.1.8.2 jdolecek * 4. Neither the name of The NetBSD Foundation nor the names of its
23 1.1.8.2 jdolecek * contributors may be used to endorse or promote products derived
24 1.1.8.2 jdolecek * from this software without specific prior written permission.
25 1.1.8.2 jdolecek *
26 1.1.8.2 jdolecek * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
27 1.1.8.2 jdolecek * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
28 1.1.8.2 jdolecek * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
29 1.1.8.2 jdolecek * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
30 1.1.8.2 jdolecek * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
31 1.1.8.2 jdolecek * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
32 1.1.8.2 jdolecek * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
33 1.1.8.2 jdolecek * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
34 1.1.8.2 jdolecek * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
35 1.1.8.2 jdolecek * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
36 1.1.8.2 jdolecek * POSSIBILITY OF SUCH DAMAGE.
37 1.1.8.2 jdolecek */
38 1.1.8.2 jdolecek
39 1.1.8.2 jdolecek #include <sys/param.h>
40 1.1.8.2 jdolecek #include <sys/systm.h>
41 1.1.8.2 jdolecek
42 1.1.8.2 jdolecek #include <sh3/devreg.h>
43 1.1.8.2 jdolecek #include <hpcsh/dev/hd6446x/hd6446xintcvar.h>
44 1.1.8.2 jdolecek #include <hpcsh/dev/hd6446x/hd6446xintcreg.h>
45 1.1.8.2 jdolecek
46 1.1.8.2 jdolecek struct hd6446x_intrhand hd6446x_intrhand[_HD6446X_INTR_N];
47 1.1.8.2 jdolecek u_int16_t hd6446x_imask[_IPL_N];
48 1.1.8.2 jdolecek u_int16_t hd6446x_ienable;
49 1.1.8.2 jdolecek void hd6446x_intr_priority_update(void);
50 1.1.8.2 jdolecek
51 1.1.8.2 jdolecek void
52 1.1.8.2 jdolecek hd6446x_intr_init()
53 1.1.8.2 jdolecek {
54 1.1.8.2 jdolecek
55 1.1.8.2 jdolecek /* Initialize interrupt priority masks. */
56 1.1.8.2 jdolecek hd6446x_intr_priority_update();
57 1.1.8.2 jdolecek }
58 1.1.8.2 jdolecek
59 1.1.8.2 jdolecek void *
60 1.1.8.2 jdolecek hd6446x_intr_establish(int irq, int mode, int level,
61 1.1.8.2 jdolecek int (*func)(void *), void *arg)
62 1.1.8.2 jdolecek {
63 1.1.8.2 jdolecek struct hd6446x_intrhand *hh = &hd6446x_intrhand[ffs(irq) - 1];
64 1.1.8.2 jdolecek u_int16_t r;
65 1.1.8.2 jdolecek int s;
66 1.1.8.2 jdolecek
67 1.1.8.2 jdolecek s = splhigh();
68 1.1.8.2 jdolecek
69 1.1.8.2 jdolecek /* Register interrupt handler */
70 1.1.8.2 jdolecek hh->hh_func = func;
71 1.1.8.2 jdolecek hh->hh_arg = arg;
72 1.1.8.2 jdolecek hh->hh_ipl = level << 4;
73 1.1.8.2 jdolecek hh->hh_imask = irq;
74 1.1.8.2 jdolecek hd6446x_ienable |= hh->hh_imask;
75 1.1.8.2 jdolecek
76 1.1.8.2 jdolecek /* Update interrupt priority masks. */
77 1.1.8.2 jdolecek hd6446x_intr_priority_update();
78 1.1.8.2 jdolecek
79 1.1.8.2 jdolecek /* Enable interrupt */
80 1.1.8.2 jdolecek r = _reg_read_2(HD6446X_NIMR);
81 1.1.8.2 jdolecek r &= ~hh->hh_imask;
82 1.1.8.2 jdolecek _reg_write_2(HD6446X_NIMR, r);
83 1.1.8.2 jdolecek
84 1.1.8.2 jdolecek splx(s);
85 1.1.8.2 jdolecek
86 1.1.8.2 jdolecek return (hh);
87 1.1.8.2 jdolecek }
88 1.1.8.2 jdolecek
89 1.1.8.2 jdolecek void
90 1.1.8.2 jdolecek hd6446x_intr_disestablish(void *handle)
91 1.1.8.2 jdolecek {
92 1.1.8.2 jdolecek struct hd6446x_intrhand *hh = handle;
93 1.1.8.2 jdolecek u_int16_t r;
94 1.1.8.2 jdolecek int s;
95 1.1.8.2 jdolecek
96 1.1.8.2 jdolecek s = splhigh();
97 1.1.8.2 jdolecek
98 1.1.8.2 jdolecek /* Disable interrupt */
99 1.1.8.2 jdolecek r = _reg_read_2(HD6446X_NIMR);
100 1.1.8.2 jdolecek r |= hh->hh_imask;
101 1.1.8.2 jdolecek _reg_write_2(HD6446X_NIMR, r);
102 1.1.8.2 jdolecek
103 1.1.8.2 jdolecek /* Update interrupt priority masks */
104 1.1.8.2 jdolecek hd6446x_ienable &= ~hh->hh_imask;
105 1.1.8.2 jdolecek memset(hh, 0, sizeof(*hh));
106 1.1.8.2 jdolecek hd6446x_intr_priority_update();
107 1.1.8.2 jdolecek
108 1.1.8.2 jdolecek splx(s);
109 1.1.8.2 jdolecek }
110 1.1.8.2 jdolecek
111 1.1.8.2 jdolecek void
112 1.1.8.2 jdolecek hd6446x_intr_priority(int irq, int level)
113 1.1.8.2 jdolecek {
114 1.1.8.2 jdolecek struct hd6446x_intrhand *hh = &hd6446x_intrhand[ffs(irq) - 1];
115 1.1.8.2 jdolecek int s;
116 1.1.8.2 jdolecek
117 1.1.8.2 jdolecek KDASSERT(hh->hh_func != NULL);
118 1.1.8.2 jdolecek s = splhigh();
119 1.1.8.2 jdolecek hh->hh_ipl = level << 4;
120 1.1.8.2 jdolecek hd6446x_intr_priority_update();
121 1.1.8.2 jdolecek splx(s);
122 1.1.8.2 jdolecek }
123 1.1.8.2 jdolecek
124 1.1.8.2 jdolecek void
125 1.1.8.2 jdolecek hd6446x_intr_priority_update()
126 1.1.8.2 jdolecek {
127 1.1.8.2 jdolecek struct hd6446x_intrhand *hh;
128 1.1.8.2 jdolecek int irq, ipl;
129 1.1.8.2 jdolecek u_int16_t mask;
130 1.1.8.2 jdolecek
131 1.1.8.2 jdolecek /* I assume interrupt level is splhigh */
132 1.1.8.2 jdolecek for (ipl = 0; ipl < _IPL_N; ipl++) {
133 1.1.8.2 jdolecek hh = hd6446x_intrhand;
134 1.1.8.2 jdolecek mask = 0;
135 1.1.8.2 jdolecek for (irq = 0; irq < _HD6446X_INTR_N; irq++, hh++) {
136 1.1.8.2 jdolecek if (hh->hh_func == NULL)
137 1.1.8.2 jdolecek continue;
138 1.1.8.2 jdolecek if (hh->hh_ipl == (ipl << 4))
139 1.1.8.2 jdolecek mask |= 1 << irq;
140 1.1.8.2 jdolecek }
141 1.1.8.2 jdolecek hd6446x_imask[ipl] = mask | ~hd6446x_ienable;
142 1.1.8.2 jdolecek }
143 1.1.8.2 jdolecek
144 1.1.8.2 jdolecek for (ipl = 1; ipl < _IPL_N; ipl++)
145 1.1.8.2 jdolecek hd6446x_imask[ipl] |= hd6446x_imask[ipl - 1];
146 1.1.8.2 jdolecek }
147