1 /* $NetBSD: vbus.c,v 1.9 2022/01/22 11:49:17 thorpej Exp $ */
2 /* $OpenBSD: vbus.c,v 1.8 2015/09/27 11:29:20 kettenis Exp $ */
3 /*
4 * Copyright (c) 2008 Mark Kettenis
5 *
6 * Permission to use, copy, modify, and distribute this software for any
7 * purpose with or without fee is hereby granted, provided that the above
8 * copyright notice and this permission notice appear in all copies.
9 *
10 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
11 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
12 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
13 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
14 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
15 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
16 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
17 */
18
19 #include <sys/param.h>
20 #include <sys/device.h>
21 #include <sys/malloc.h>
22 #include <sys/kmem.h>
23 #include <sys/systm.h>
24
25 #include <machine/autoconf.h>
26 #include <machine/hypervisor.h>
27 #include <machine/openfirm.h>
28
29 #include <sparc64/dev/vbusvar.h>
30
31 #include <sparc64/dev/iommureg.h>
32
33 #include <dev/clock_subr.h>
34 extern todr_chip_handle_t todr_handle;
35
36 #ifdef DEBUG
37 #define VBUS_INTR 0x01
38 int vbus_debug = 0x00|VBUS_INTR;
39 #define DPRINTF(l, s) do { if (vbus_debug & l) printf s; } while (0)
40 #else
41 #define DPRINTF(l, s)
42 #endif
43
44 struct vbus_softc {
45 device_t sc_dv;
46 bus_space_tag_t sc_bustag;
47 bus_dma_tag_t sc_dmatag;
48 };
49 int vbus_cmp_cells(int *, int *, int *, int);
50 int vbus_match(device_t, cfdata_t, void *);
51 void vbus_attach(device_t, device_t, void *);
52 int vbus_print(void *, const char *);
53
54 CFATTACH_DECL_NEW(vbus, sizeof(struct vbus_softc),
55 vbus_match, vbus_attach, NULL, NULL);
56
57 void *vbus_intr_establish(bus_space_tag_t, int, int,
58 int (*)(void *), void *, void (*)(void));
59 void vbus_intr_ack(struct intrhand *);
60 bus_space_tag_t vbus_alloc_bus_tag(struct vbus_softc *, bus_space_tag_t);
61
62 int
vbus_match(device_t parent,cfdata_t match,void * aux)63 vbus_match(device_t parent, cfdata_t match, void *aux)
64 {
65 struct mainbus_attach_args *ma = aux;
66
67 if (strcmp(ma->ma_name, "virtual-devices") == 0)
68 return (1);
69
70 return (0);
71 }
72
73 void
vbus_attach(device_t parent,device_t self,void * aux)74 vbus_attach(device_t parent, device_t self, void *aux)
75 {
76 struct vbus_softc *sc = device_private(self);
77 struct mainbus_attach_args *ma = aux;
78 int node;
79
80 sc->sc_bustag = vbus_alloc_bus_tag(sc, ma->ma_bustag);
81 sc->sc_dmatag = ma->ma_dmatag;
82 printf("\n");
83
84 devhandle_t selfh = device_handle(self);
85 for (node = OF_child(ma->ma_node); node; node = OF_peer(node)) {
86 struct vbus_attach_args va;
87 char buf[32];
88
89 bzero(&va, sizeof(va));
90 va.va_node = node;
91 if (OF_getprop(node, "name", buf, sizeof(buf)) <= 0)
92 continue;
93 va.va_name = buf;
94 va.va_bustag = sc->sc_bustag;
95 va.va_dmatag = sc->sc_dmatag;
96 prom_getprop(node, "reg", sizeof(*va.va_reg),
97 &va.va_nreg, (void **)&va.va_reg);
98 prom_getprop(node, "interrupts", sizeof(*va.va_intr),
99 &va.va_nintr, (void **)&va.va_intr);
100 config_found(self, &va, vbus_print,
101 CFARGS(.devhandle = prom_node_to_devhandle(selfh,
102 va.va_node)));
103 }
104
105 struct vbus_attach_args va;
106 bzero(&va, sizeof(va));
107 va.va_name = "rtc";
108 config_found(self, &va, vbus_print, CFARGS_NONE);
109
110 }
111
112 int
vbus_print(void * aux,const char * name)113 vbus_print(void *aux, const char *name)
114 {
115 struct vbus_attach_args *va = aux;
116
117 if (name)
118 printf("\"%s\" at %s", va->va_name, name);
119 return (UNCONF);
120 }
121
122 /*
123 * Compare a sequence of cells with a mask, return 1 if they match and
124 * 0 if they don't.
125 */
126 int
vbus_cmp_cells(int * cell1,int * cell2,int * mask,int ncells)127 vbus_cmp_cells(int *cell1, int *cell2, int *mask, int ncells)
128 {
129 int i;
130
131 for (i = 0; i < ncells; i++) {
132 if (((cell1[i] ^ cell2[i]) & mask[i]) != 0)
133 return (0);
134 }
135 return (1);
136 }
137
138 int
vbus_intr_map(int node,int ino,uint64_t * sysino)139 vbus_intr_map(int node, int ino, uint64_t *sysino)
140 {
141 int *imap = NULL, nimap;
142 int *reg = NULL, nreg;
143 int *imap_mask;
144 int parent;
145 int address_cells, interrupt_cells;
146 uint64_t devhandle;
147 uint64_t devino;
148 int len;
149 int err;
150
151 DPRINTF(VBUS_INTR, ("vbus_intr_map(): ino 0x%x\n", ino));
152
153 parent = OF_parent(node);
154
155 address_cells = prom_getpropint(parent, "#address-cells", 2);
156 interrupt_cells = prom_getpropint(parent, "#interrupt-cells", 1);
157 KASSERT(interrupt_cells == 1);
158
159 len = OF_getproplen(parent, "interrupt-map-mask");
160 if (len < (address_cells + interrupt_cells) * sizeof(int))
161 return (-1);
162 imap_mask = malloc(len, M_DEVBUF, M_WAITOK);
163 if (OF_getprop(parent, "interrupt-map-mask", imap_mask, len) != len)
164 goto out;
165
166 if (prom_getprop(parent, "interrupt-map", sizeof(int), &nimap, (void **)&imap))
167 panic("vbus: can't get interrupt-map");
168
169 if (prom_getprop(node, "reg", sizeof(*reg), &nreg, (void **)®))
170 panic("vbus: can't get reg");
171 if (nreg < address_cells)
172 goto out;
173
174 while (nimap >= address_cells + interrupt_cells + 2) {
175 if (vbus_cmp_cells(imap, reg, imap_mask, address_cells) &&
176 vbus_cmp_cells(&imap[address_cells], &ino,
177 &imap_mask[address_cells], interrupt_cells)) {
178 node = imap[address_cells + interrupt_cells];
179 devino = imap[address_cells + interrupt_cells + 1];
180
181 free(reg, M_DEVBUF);
182 reg = NULL;
183
184 if (prom_getprop(node, "reg", sizeof(*reg), &nreg, (void **)®))
185 panic("vbus: can't get reg");
186
187 devhandle = reg[0] & 0x0fffffff;
188
189 err = hv_intr_devino_to_sysino(devhandle, devino, sysino);
190 if (err != H_EOK)
191 goto out;
192
193 KASSERT(*sysino == INTVEC(*sysino));
194 free(imap_mask, M_DEVBUF);
195 return (0);
196 }
197 imap += address_cells + interrupt_cells + 2;
198 nimap -= address_cells + interrupt_cells + 2;
199 }
200
201 out:
202 free(imap_mask, M_DEVBUF);
203 return (-1);
204 }
205
206 void *
vbus_intr_establish(bus_space_tag_t t,int ihandle,int level,int (* handler)(void *),void * arg,void (* fastvec)(void))207 vbus_intr_establish(bus_space_tag_t t, int ihandle, int level,
208 int (*handler)(void *), void *arg, void (*fastvec)(void) /* ignored */)
209 {
210 uint64_t sysino = INTVEC(ihandle);
211 struct intrhand *ih;
212 int ino;
213 int err;
214
215 DPRINTF(VBUS_INTR, ("vbus_intr_establish()\n"));
216
217 ino = INTINO(ihandle);
218
219 ih = intrhand_alloc();
220
221 ih->ih_ivec = ihandle;
222 ih->ih_fun = handler;
223 ih->ih_arg = arg;
224 ih->ih_pil = level;
225 ih->ih_number = ino;
226 ih->ih_pending = 0;
227
228 intr_establish(ih->ih_pil, level != IPL_VM, ih);
229 ih->ih_ack = vbus_intr_ack;
230
231 err = hv_intr_settarget(sysino, cpus->ci_cpuid);
232 if (err != H_EOK) {
233 printf("hv_intr_settarget(%lu, %u) failed - err = %d\n",
234 (long unsigned int)sysino, cpus->ci_cpuid, err);
235 return (NULL);
236 }
237
238 /* Clear pending interrupts. */
239 err = hv_intr_setstate(sysino, INTR_IDLE);
240 if (err != H_EOK) {
241 printf("hv_intr_setstate(%lu, INTR_IDLE) failed - err = %d\n",
242 (long unsigned int)sysino, err);
243 return (NULL);
244 }
245
246 err = hv_intr_setenabled(sysino, INTR_ENABLED);
247 if (err != H_EOK) {
248 printf("hv_intr_setenabled(%lu) failed - err = %d\n",
249 (long unsigned int)sysino, err);
250 return (NULL);
251 }
252
253 return (ih);
254 }
255
256 void
vbus_intr_ack(struct intrhand * ih)257 vbus_intr_ack(struct intrhand *ih)
258 {
259 DPRINTF(VBUS_INTR, ("vbus_intr_ack()\n"));
260 hv_intr_setstate(ih->ih_number, INTR_IDLE);
261 }
262
263 bus_space_tag_t
vbus_alloc_bus_tag(struct vbus_softc * sc,bus_space_tag_t parent)264 vbus_alloc_bus_tag(struct vbus_softc *sc, bus_space_tag_t parent)
265 {
266 struct sparc_bus_space_tag *bt;
267
268 bt = kmem_zalloc(sizeof(*bt), KM_SLEEP);
269 bt->cookie = sc;
270 bt->parent = parent;
271 bt->sparc_bus_map = parent->sparc_bus_map;
272 bt->sparc_intr_establish = vbus_intr_establish;
273
274 return (bt);
275 }
276