1 /* $NetBSD: pic_distopenpic.c,v 1.2 2008/04/08 02:33:03 garbled Exp $ */
4 * Copyright (c) 2008 Tim Rightnour
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
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
*);
58 setup_distributed_openpic(void *addr
, int nrofisus
, void **isu
, int *maps
)
60 struct openpic_ops
*opicops
;
65 openpic_base
= (void *)addr
;
66 opicops
= malloc(sizeof(struct openpic_ops
), M_DEVBUF
, M_NOWAIT
);
67 KASSERT(opicops
!= NULL
);
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
,
77 KASSERT(opicops
->isu
!= NULL
);
78 opicops
->irq_per
= malloc(sizeof(uint8_t) * nrofisus
,
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;
86 aprint_debug("%d: irqtotal=%d, added %d\n", i
, irq
,
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");
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
++) {
133 printf("timebase freq=%d\n", openpic_read(0x10f0));
139 /* Begin distributed openpic code */
142 opic_isu_from_irq(struct openpic_ops
*opic
, int irq
, int *realirq
)
146 for (i
=0; i
< opic
->nrofisus
; i
++) {
147 if (irq
< opic
->irq_per
[i
]) {
151 irq
-= opic
->irq_per
[i
];
157 distopic_read(struct openpic_ops
*opic
, int isu
, int offset
)
159 volatile unsigned char *addr
= opic
->isu
[isu
] + offset
;
165 distopic_write(struct openpic_ops
*opic
, int isu
, int offset
, u_int val
)
167 volatile unsigned char *addr
= opic
->isu
[isu
] + offset
;
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
));
179 isu
= opic_isu_from_irq(opic
, irq
, &realirq
);
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__
,
195 distopic_enable_irq(struct pic_ops
*pic
, int irq
, int type
)
197 struct openpic_ops
*opic
= (struct openpic_ops
*)pic
;
201 isu
= opic_isu_from_irq(opic
, irq
, &realirq
);
203 x
= distopic_read(opic
, isu
, OPENPIC_DSRC_VECTOR_OFFSET(realirq
));
205 distopic_write(opic
, isu
, OPENPIC_DSRC_VECTOR_OFFSET(realirq
), x
);
209 distopic_disable_irq(struct pic_ops
*pic
, int irq
)
211 struct openpic_ops
*opic
= (struct openpic_ops
*)pic
;
215 isu
= opic_isu_from_irq(opic
, irq
, &realirq
);
217 x
= distopic_read(opic
, isu
, OPENPIC_DSRC_VECTOR_OFFSET(realirq
));
219 distopic_write(opic
, isu
, OPENPIC_DSRC_VECTOR_OFFSET(realirq
), x
);
223 distopic_finish_setup(struct pic_ops
*pic
)
225 struct openpic_ops
*opic
= (struct openpic_ops
*)pic
;
226 uint32_t cpumask
= 0;
229 #ifdef OPENPIC_DISTRIBUTE
230 for (i
= 0; i
< ncpu
; i
++)
231 cpumask
|= (1 << cpu_info
[i
].ci_index
);
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
),