1*d65a6a67Schs /* $NetBSD: pic_discovery.c,v 1.8 2017/06/01 02:45:07 chs Exp $ */
2d974db0aSgarbled
3d974db0aSgarbled /*
4d974db0aSgarbled * Copyright (c) 2002 Allegro Networks, Inc., Wasabi Systems, Inc.
5d974db0aSgarbled * All rights reserved.
6d974db0aSgarbled *
7d974db0aSgarbled * Redistribution and use in source and binary forms, with or without
8d974db0aSgarbled * modification, are permitted provided that the following conditions
9d974db0aSgarbled * are met:
10d974db0aSgarbled * 1. Redistributions of source code must retain the above copyright
11d974db0aSgarbled * notice, this list of conditions and the following disclaimer.
12d974db0aSgarbled * 2. Redistributions in binary form must reproduce the above copyright
13d974db0aSgarbled * notice, this list of conditions and the following disclaimer in the
14d974db0aSgarbled * documentation and/or other materials provided with the distribution.
15d974db0aSgarbled * 3. All advertising materials mentioning features or use of this software
16d974db0aSgarbled * must display the following acknowledgement:
17d974db0aSgarbled * This product includes software developed for the NetBSD Project by
18d974db0aSgarbled * Allegro Networks, Inc., and Wasabi Systems, Inc.
19d974db0aSgarbled * 4. The name of Allegro Networks, Inc. may not be used to endorse
20d974db0aSgarbled * or promote products derived from this software without specific prior
21d974db0aSgarbled * written permission.
22d974db0aSgarbled * 5. The name of Wasabi Systems, Inc. may not be used to endorse
23d974db0aSgarbled * or promote products derived from this software without specific prior
24d974db0aSgarbled * written permission.
25d974db0aSgarbled *
26d974db0aSgarbled * THIS SOFTWARE IS PROVIDED BY ALLEGRO NETWORKS, INC. AND
27d974db0aSgarbled * WASABI SYSTEMS, INC. ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES,
28d974db0aSgarbled * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY
29d974db0aSgarbled * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
30d974db0aSgarbled * IN NO EVENT SHALL EITHER ALLEGRO NETWORKS, INC. OR WASABI SYSTEMS, INC.
31d974db0aSgarbled * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
32d974db0aSgarbled * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
33d974db0aSgarbled * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
34d974db0aSgarbled * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
35d974db0aSgarbled * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
36d974db0aSgarbled * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
37d974db0aSgarbled * POSSIBILITY OF SUCH DAMAGE.
38d974db0aSgarbled */
39d974db0aSgarbled
40d974db0aSgarbled #include <sys/cdefs.h>
41*d65a6a67Schs __KERNEL_RCSID(0, "$NetBSD: pic_discovery.c,v 1.8 2017/06/01 02:45:07 chs Exp $");
42d974db0aSgarbled
43d974db0aSgarbled #include <sys/param.h>
44a748aedcSkiyohara #include <sys/bus.h>
4549067be8Smatt #include <sys/kmem.h>
46bae29c7dSmatt #include <sys/intr.h>
47a748aedcSkiyohara
48d974db0aSgarbled #include <powerpc/pic/picvar.h>
49a748aedcSkiyohara
50d974db0aSgarbled #include <dev/marvell/gtvar.h>
51d974db0aSgarbled #include <dev/marvell/gtintrreg.h>
52a748aedcSkiyohara #include <dev/marvell/gtintrvar.h>
53d974db0aSgarbled
54d974db0aSgarbled
55a61d9896Smatt __CTASSERT(sizeof(imask_t) == sizeof(uint64_t));
56a61d9896Smatt
57a748aedcSkiyohara struct discovery_gpp_pic_ops;
58d974db0aSgarbled
59d974db0aSgarbled struct discovery_pic_ops {
60a748aedcSkiyohara struct pic_ops pic;
61a748aedcSkiyohara union {
62a748aedcSkiyohara uint64_t mask64;
63a748aedcSkiyohara uint32_t mask32[2];
64a748aedcSkiyohara } _mask;
65a748aedcSkiyohara #define enable_mask _mask.mask64
66a748aedcSkiyohara #define enable_mask_high _mask.mask32[1]
67a748aedcSkiyohara #define enable_mask_low _mask.mask32[0]
68a748aedcSkiyohara };
69a748aedcSkiyohara struct discovery_gpp_pic_ops {
70a748aedcSkiyohara struct pic_ops pic;
71a748aedcSkiyohara
72a748aedcSkiyohara int gpp_base;
73d974db0aSgarbled };
74d974db0aSgarbled
75d974db0aSgarbled
76a748aedcSkiyohara static void discovery_enable_irq(struct pic_ops *, int, int);
77a748aedcSkiyohara static void discovery_disable_irq(struct pic_ops *, int);
78a748aedcSkiyohara static int discovery_get_irq(struct pic_ops *, int);
79a748aedcSkiyohara static void discovery_ack_irq(struct pic_ops *, int);
80a748aedcSkiyohara
81a748aedcSkiyohara static void discovery_gpp_enable_irq(struct pic_ops *, int, int);
82a748aedcSkiyohara static void discovery_gpp_disable_irq(struct pic_ops *, int);
83a748aedcSkiyohara static int discovery_gpp_get_irq(struct pic_ops *, int);
84a748aedcSkiyohara static void discovery_gpp_ack_irq(struct pic_ops *, int);
85a748aedcSkiyohara
86a748aedcSkiyohara
87a748aedcSkiyohara struct pic_ops *
setup_discovery_pic(void)88bd09a862Smatt setup_discovery_pic(void)
89d974db0aSgarbled {
90a748aedcSkiyohara struct discovery_pic_ops *discovery;
91a748aedcSkiyohara struct pic_ops *pic;
92d974db0aSgarbled
9349067be8Smatt discovery = kmem_alloc(sizeof(*discovery), KM_SLEEP);
94d974db0aSgarbled
95a748aedcSkiyohara pic = &discovery->pic;
96a748aedcSkiyohara pic->pic_numintrs = 64;
97a748aedcSkiyohara pic->pic_cookie = (void *)NULL; /* set later */
98a748aedcSkiyohara pic->pic_enable_irq = discovery_enable_irq;
99a748aedcSkiyohara pic->pic_reenable_irq = discovery_enable_irq;
100a748aedcSkiyohara pic->pic_disable_irq = discovery_disable_irq;
101a748aedcSkiyohara pic->pic_get_irq = discovery_get_irq;
102a748aedcSkiyohara pic->pic_ack_irq = discovery_ack_irq;
103a748aedcSkiyohara pic->pic_establish_irq = dummy_pic_establish_intr;
104a748aedcSkiyohara pic->pic_finish_setup = NULL;
105a748aedcSkiyohara strcpy(pic->pic_name, "discovery");
106a748aedcSkiyohara pic_add(pic);
107d974db0aSgarbled
108a748aedcSkiyohara discovery->enable_mask = 0;
109d974db0aSgarbled
110a748aedcSkiyohara return pic;
111d974db0aSgarbled }
112d974db0aSgarbled
113d974db0aSgarbled static void
discovery_enable_irq(struct pic_ops * pic,int irq,int type)114d974db0aSgarbled discovery_enable_irq(struct pic_ops *pic, int irq, int type)
115d974db0aSgarbled {
116a748aedcSkiyohara struct discovery_pic_ops *discovery = (struct discovery_pic_ops *)pic;
117d974db0aSgarbled
118a748aedcSkiyohara discovery->enable_mask |= (1 << irq);
119a748aedcSkiyohara discovery_enable_intr(pic->pic_cookie, irq);
120d974db0aSgarbled }
121d974db0aSgarbled
122d974db0aSgarbled static void
discovery_disable_irq(struct pic_ops * pic,int irq)123d974db0aSgarbled discovery_disable_irq(struct pic_ops *pic, int irq)
124d974db0aSgarbled {
125a748aedcSkiyohara struct discovery_pic_ops *discovery = (struct discovery_pic_ops *)pic;
126d974db0aSgarbled
127a748aedcSkiyohara discovery->enable_mask &= ~(1 << irq);
128a748aedcSkiyohara discovery_disable_intr(pic->pic_cookie, irq);
129d974db0aSgarbled }
130a748aedcSkiyohara
131a748aedcSkiyohara static int
discovery_get_irq(struct pic_ops * pic,int mode)132a748aedcSkiyohara discovery_get_irq(struct pic_ops *pic, int mode)
133a748aedcSkiyohara {
134a748aedcSkiyohara struct discovery_pic_ops *discovery = (struct discovery_pic_ops *)pic;
135a748aedcSkiyohara uint32_t cause;
136a748aedcSkiyohara int irq, base, msk;
137a748aedcSkiyohara
138a748aedcSkiyohara cause = discovery_mic_low(pic->pic_cookie) & discovery->enable_mask_low;
139a748aedcSkiyohara if (cause)
140a748aedcSkiyohara base = 0;
141a748aedcSkiyohara else {
142a748aedcSkiyohara cause = discovery_mic_high(pic->pic_cookie);
143a748aedcSkiyohara cause &= discovery->enable_mask_high;
144a748aedcSkiyohara if (!cause)
145a748aedcSkiyohara return 255;
146a748aedcSkiyohara base = 32;
147a748aedcSkiyohara }
148a748aedcSkiyohara for (irq = base, msk = 0x00000001; !(cause & msk); irq++, msk <<= 1);
149a748aedcSkiyohara
150a748aedcSkiyohara return irq;
151d974db0aSgarbled }
152d974db0aSgarbled
153d974db0aSgarbled static void
discovery_ack_irq(struct pic_ops * pic,int irq)154d974db0aSgarbled discovery_ack_irq(struct pic_ops *pic, int irq)
155d974db0aSgarbled {
156a748aedcSkiyohara
157a748aedcSkiyohara /* nothing */
158d974db0aSgarbled }
159d974db0aSgarbled
160a748aedcSkiyohara
161a748aedcSkiyohara struct pic_ops *
setup_discovery_gpp_pic(void * discovery,int gpp_base)162a748aedcSkiyohara setup_discovery_gpp_pic(void *discovery, int gpp_base)
163d974db0aSgarbled {
164a748aedcSkiyohara struct discovery_gpp_pic_ops *discovery_gpp;
165a748aedcSkiyohara struct pic_ops *pic;
166d974db0aSgarbled
16749067be8Smatt discovery_gpp = kmem_alloc(sizeof(*discovery_gpp), KM_SLEEP);
168d974db0aSgarbled
169a748aedcSkiyohara pic = &discovery_gpp->pic;
170a748aedcSkiyohara pic->pic_numintrs = 32;
171a748aedcSkiyohara pic->pic_cookie = discovery;
172a748aedcSkiyohara pic->pic_enable_irq = discovery_gpp_enable_irq;
173a748aedcSkiyohara pic->pic_reenable_irq = discovery_gpp_enable_irq;
174a748aedcSkiyohara pic->pic_disable_irq = discovery_gpp_disable_irq;
175a748aedcSkiyohara pic->pic_get_irq = discovery_gpp_get_irq;
176a748aedcSkiyohara pic->pic_ack_irq = discovery_gpp_ack_irq;
177a748aedcSkiyohara pic->pic_establish_irq = dummy_pic_establish_intr;
178a748aedcSkiyohara pic->pic_finish_setup = NULL;
179a748aedcSkiyohara strcpy(pic->pic_name, "discovery_gpp");
180a748aedcSkiyohara pic_add(pic);
181d974db0aSgarbled
182a748aedcSkiyohara discovery_gpp->gpp_base = gpp_base;
183d974db0aSgarbled
184a748aedcSkiyohara return pic;
185a748aedcSkiyohara }
186a748aedcSkiyohara
187a748aedcSkiyohara static void
discovery_gpp_enable_irq(struct pic_ops * pic,int irq,int type)188a748aedcSkiyohara discovery_gpp_enable_irq(struct pic_ops *pic, int irq, int type)
189a748aedcSkiyohara {
190a748aedcSkiyohara struct discovery_gpp_pic_ops *discovery_gpp =
191a748aedcSkiyohara (struct discovery_gpp_pic_ops *)pic;
192a748aedcSkiyohara struct discovery_pic_ops *discovery = discovery_gpp->pic.pic_cookie;
193a748aedcSkiyohara
194a748aedcSkiyohara discovery_gpp_enable_intr(discovery->pic.pic_cookie,
195a748aedcSkiyohara discovery_gpp->gpp_base + irq);
196a748aedcSkiyohara }
197a748aedcSkiyohara
198a748aedcSkiyohara static void
discovery_gpp_disable_irq(struct pic_ops * pic,int irq)199a748aedcSkiyohara discovery_gpp_disable_irq(struct pic_ops *pic, int irq)
200a748aedcSkiyohara {
201a748aedcSkiyohara struct discovery_gpp_pic_ops *discovery_gpp =
202a748aedcSkiyohara (struct discovery_gpp_pic_ops *)pic;
203a748aedcSkiyohara struct discovery_pic_ops *discovery = discovery_gpp->pic.pic_cookie;
204a748aedcSkiyohara
205a748aedcSkiyohara discovery_gpp_disable_intr(discovery->pic.pic_cookie,
206a748aedcSkiyohara discovery_gpp->gpp_base + irq);
207a748aedcSkiyohara }
208a748aedcSkiyohara
209a748aedcSkiyohara static int
discovery_gpp_get_irq(struct pic_ops * pic,int mode)210a748aedcSkiyohara discovery_gpp_get_irq(struct pic_ops *pic, int mode)
211a748aedcSkiyohara {
212a748aedcSkiyohara struct discovery_gpp_pic_ops *discovery_gpp =
213a748aedcSkiyohara (struct discovery_gpp_pic_ops *)pic;
214a748aedcSkiyohara struct discovery_pic_ops *discovery = discovery_gpp->pic.pic_cookie;
215a748aedcSkiyohara uint32_t cause, mask;
216a748aedcSkiyohara int irq, msk, base;
217a748aedcSkiyohara
218a748aedcSkiyohara cause = discovery_gpp_cause(discovery->pic.pic_cookie);
219a748aedcSkiyohara mask = discovery_gpp_mask(discovery->pic.pic_cookie);
220a748aedcSkiyohara
221a748aedcSkiyohara base = discovery_gpp->gpp_base;
222a748aedcSkiyohara cause &= (mask & (0xff << base));
223a748aedcSkiyohara if (!cause)
224a748aedcSkiyohara return 255;
225a748aedcSkiyohara
226a748aedcSkiyohara for (irq = base, msk = (1 << base); !(cause & msk); irq++, msk <<= 1);
227a748aedcSkiyohara
228a748aedcSkiyohara return irq;
229a748aedcSkiyohara }
230a748aedcSkiyohara
231a748aedcSkiyohara static void
discovery_gpp_ack_irq(struct pic_ops * pic,int irq)232a748aedcSkiyohara discovery_gpp_ack_irq(struct pic_ops *pic, int irq)
233a748aedcSkiyohara {
234a748aedcSkiyohara struct discovery_gpp_pic_ops *discovery_gpp =
235a748aedcSkiyohara (struct discovery_gpp_pic_ops *)pic;
236a748aedcSkiyohara struct discovery_pic_ops *discovery = discovery_gpp->pic.pic_cookie;
237a748aedcSkiyohara
238a748aedcSkiyohara discovery_gpp_clear_cause(discovery->pic.pic_cookie,
239a748aedcSkiyohara discovery_gpp->gpp_base + irq);
240d974db0aSgarbled }
241