Expand PMF_FN_* macros.
[netbsd-mini2440.git] / sys / arch / powerpc / pic / pic_distopenpic.c
blob06c989738568d1833356efd5e369ad06c454b44d
1 /* $NetBSD: pic_distopenpic.c,v 1.2 2008/04/08 02:33:03 garbled Exp $ */
3 /*-
4 * Copyright (c) 2008 Tim Rightnour
5 * All rights reserved.
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 * 3. Neither the name of The NetBSD Foundation nor the names of its
16 * contributors may be used to endorse or promote products derived
17 * from this software without specific prior written permission.
19 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 * POSSIBILITY OF SUCH DAMAGE.
32 #include <sys/cdefs.h>
33 __KERNEL_RCSID(0, "$NetBSD: pic_distopenpic.c,v 1.2 2008/04/08 02:33:03 garbled Exp $");
35 #include <sys/param.h>
36 #include <sys/malloc.h>
37 #include <sys/kernel.h>
39 #include <uvm/uvm_extern.h>
41 #include <machine/pio.h>
42 #include <powerpc/openpic.h>
44 #include <arch/powerpc/pic/picvar.h>
46 #include "opt_interrupt.h"
48 /* distributed stuff */
49 static int opic_isu_from_irq(struct openpic_ops *, int, int *);
50 static u_int distopic_read(struct openpic_ops *, int, int);
51 static void distopic_write(struct openpic_ops *, int, int, u_int);
52 static void distopic_establish_irq(struct pic_ops *, int, int, int);
53 static void distopic_enable_irq(struct pic_ops *, int, int);
54 static void distopic_disable_irq(struct pic_ops *, int);
55 static void distopic_finish_setup(struct pic_ops *);
57 struct pic_ops *
58 setup_distributed_openpic(void *addr, int nrofisus, void **isu, int *maps)
60 struct openpic_ops *opicops;
61 struct pic_ops *pic;
62 int irq, i;
63 u_int x;
65 openpic_base = (void *)addr;
66 opicops = malloc(sizeof(struct openpic_ops), M_DEVBUF, M_NOWAIT);
67 KASSERT(opicops != NULL);
68 pic = &opicops->pic;
70 x = openpic_read(OPENPIC_FEATURE);
71 if (((x & 0x07ff0000) >> 16) != 0)
72 panic("Can't handle a distributed openpic with internal ISU");
74 opicops->nrofisus = nrofisus;
75 opicops->isu = malloc(sizeof(volatile unsigned char *) * nrofisus,
76 M_DEVBUF, M_NOWAIT);
77 KASSERT(opicops->isu != NULL);
78 opicops->irq_per = malloc(sizeof(uint8_t) * nrofisus,
79 M_DEVBUF, M_NOWAIT);
80 KASSERT(opicops->irq_per != NULL);
82 for (irq=0, i=0; i < nrofisus ; i++) {
83 opicops->isu[i] = (void *)isu[i];
84 opicops->irq_per[i] = maps[i]/0x20;
85 irq += maps[i]/0x20;
86 aprint_debug("%d: irqtotal=%d, added %d\n", i, irq,
87 maps[i]/0x20);
89 aprint_normal("OpenPIC Version 1.%d: "
90 "Supports %d CPUs and %d interrupt sources.\n",
91 x & 0xff, ((x & 0x1f00) >> 8) + 1, irq);
92 pic->pic_numintrs = irq;
93 pic->pic_cookie = addr;
94 pic->pic_enable_irq = distopic_enable_irq;
95 pic->pic_reenable_irq = distopic_enable_irq;
96 pic->pic_disable_irq = distopic_disable_irq;
97 pic->pic_get_irq = opic_get_irq;
98 pic->pic_ack_irq = opic_ack_irq;
99 pic->pic_establish_irq = distopic_establish_irq;
100 pic->pic_finish_setup = distopic_finish_setup;
101 opicops->flags = OPENPIC_FLAG_DIST;
102 strcpy(pic->pic_name, "openpic");
103 pic_add(pic);
105 openpic_set_priority(0, 15);
107 for (i=0; i < nrofisus; i++) {
108 for (irq = 0; irq < opicops->irq_per[i]; irq++) {
109 /* make sure to keep disabled */
110 distopic_write(opicops, i,
111 OPENPIC_DSRC_VECTOR_OFFSET(irq), OPENPIC_IMASK);
112 /* send all interrupts to CPU 0 */
113 distopic_write(opicops, i,
114 OPENPIC_DSRC_IDEST_OFFSET(irq), 1 << 0);
118 x = openpic_read(OPENPIC_CONFIG);
119 x |= OPENPIC_CONFIG_8259_PASSTHRU_DISABLE;
120 openpic_write(OPENPIC_CONFIG, x);
122 openpic_write(OPENPIC_SPURIOUS_VECTOR, 0xff);
124 openpic_set_priority(0, 0);
126 /* clear all pending interrunts */
127 for (irq = 0; irq < pic->pic_numintrs; irq++) {
128 openpic_read_irq(0);
129 openpic_eoi(0);
132 #if 0
133 printf("timebase freq=%d\n", openpic_read(0x10f0));
134 #endif
135 return pic;
139 /* Begin distributed openpic code */
141 static int
142 opic_isu_from_irq(struct openpic_ops *opic, int irq, int *realirq)
144 int i;
146 for (i=0; i < opic->nrofisus; i++) {
147 if (irq < opic->irq_per[i]) {
148 *realirq = irq;
149 return i;
150 } else
151 irq -= opic->irq_per[i];
153 return -1;
156 static u_int
157 distopic_read(struct openpic_ops *opic, int isu, int offset)
159 volatile unsigned char *addr = opic->isu[isu] + offset;
161 return in32rb(addr);
164 static void
165 distopic_write(struct openpic_ops *opic, int isu, int offset, u_int val)
167 volatile unsigned char *addr = opic->isu[isu] + offset;
169 out32rb(addr, val);
172 static void
173 distopic_establish_irq(struct pic_ops *pic, int irq, int type, int pri)
175 struct openpic_ops *opic = (struct openpic_ops *)pic;
176 int isu, realirq, realpri = max(1, min(15, pri));
177 uint32_t x;
179 isu = opic_isu_from_irq(opic, irq, &realirq);
180 KASSERT(isu != -1);
182 x = irq;
183 x |= OPENPIC_IMASK;
184 x |= (realirq == 0 && isu == 0) ?
185 OPENPIC_POLARITY_POSITIVE : OPENPIC_POLARITY_NEGATIVE;
186 x |= (type == IST_EDGE) ? OPENPIC_SENSE_EDGE : OPENPIC_SENSE_LEVEL;
187 x |= realpri << OPENPIC_PRIORITY_SHIFT;
188 distopic_write(opic, isu, OPENPIC_DSRC_VECTOR_OFFSET(realirq), x);
190 aprint_debug("%s: setting IRQ %d to priority %d 0x%x\n", __func__,
191 irq, realpri, x);
194 static void
195 distopic_enable_irq(struct pic_ops *pic, int irq, int type)
197 struct openpic_ops *opic = (struct openpic_ops *)pic;
198 int isu, realirq;
199 u_int x;
201 isu = opic_isu_from_irq(opic, irq, &realirq);
202 KASSERT(isu != -1);
203 x = distopic_read(opic, isu, OPENPIC_DSRC_VECTOR_OFFSET(realirq));
204 x &= ~OPENPIC_IMASK;
205 distopic_write(opic, isu, OPENPIC_DSRC_VECTOR_OFFSET(realirq), x);
208 static void
209 distopic_disable_irq(struct pic_ops *pic, int irq)
211 struct openpic_ops *opic = (struct openpic_ops *)pic;
212 int isu, realirq;
213 u_int x;
215 isu = opic_isu_from_irq(opic, irq, &realirq);
216 KASSERT(isu != -1);
217 x = distopic_read(opic, isu, OPENPIC_DSRC_VECTOR_OFFSET(realirq));
218 x |= OPENPIC_IMASK;
219 distopic_write(opic, isu, OPENPIC_DSRC_VECTOR_OFFSET(realirq), x);
222 static void
223 distopic_finish_setup(struct pic_ops *pic)
225 struct openpic_ops *opic = (struct openpic_ops *)pic;
226 uint32_t cpumask = 0;
227 int i, irq;
229 #ifdef OPENPIC_DISTRIBUTE
230 for (i = 0; i < ncpu; i++)
231 cpumask |= (1 << cpu_info[i].ci_index);
232 #else
233 cpumask = 1;
234 #endif
235 for (i=0; i < opic->nrofisus; i++) {
236 for (irq = 0; irq < opic->irq_per[i]; irq++) {
237 distopic_write(opic, i, OPENPIC_DSRC_IDEST_OFFSET(irq),
238 cpumask);