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