sbus.c revision 1.16 1 1.16 eeh /* $NetBSD: sbus.c,v 1.16 1999/05/31 00:14:00 eeh Exp $ */
2 1.1 eeh
3 1.1 eeh /*-
4 1.1 eeh * Copyright (c) 1998 The NetBSD Foundation, Inc.
5 1.1 eeh * All rights reserved.
6 1.1 eeh *
7 1.1 eeh * This code is derived from software contributed to The NetBSD Foundation
8 1.1 eeh * by Paul Kranenburg.
9 1.1 eeh *
10 1.1 eeh * Redistribution and use in source and binary forms, with or without
11 1.1 eeh * modification, are permitted provided that the following conditions
12 1.1 eeh * are met:
13 1.1 eeh * 1. Redistributions of source code must retain the above copyright
14 1.1 eeh * notice, this list of conditions and the following disclaimer.
15 1.1 eeh * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 eeh * notice, this list of conditions and the following disclaimer in the
17 1.1 eeh * documentation and/or other materials provided with the distribution.
18 1.1 eeh * 3. All advertising materials mentioning features or use of this software
19 1.1 eeh * must display the following acknowledgement:
20 1.1 eeh * This product includes software developed by the NetBSD
21 1.1 eeh * Foundation, Inc. and its contributors.
22 1.1 eeh * 4. Neither the name of The NetBSD Foundation nor the names of its
23 1.1 eeh * contributors may be used to endorse or promote products derived
24 1.1 eeh * from this software without specific prior written permission.
25 1.1 eeh *
26 1.1 eeh * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
27 1.1 eeh * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
28 1.1 eeh * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
29 1.1 eeh * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
30 1.1 eeh * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
31 1.1 eeh * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
32 1.1 eeh * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
33 1.1 eeh * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
34 1.1 eeh * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
35 1.1 eeh * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
36 1.1 eeh * POSSIBILITY OF SUCH DAMAGE.
37 1.1 eeh */
38 1.1 eeh
39 1.1 eeh /*
40 1.1 eeh * Copyright (c) 1992, 1993
41 1.1 eeh * The Regents of the University of California. All rights reserved.
42 1.1 eeh *
43 1.1 eeh * This software was developed by the Computer Systems Engineering group
44 1.1 eeh * at Lawrence Berkeley Laboratory under DARPA contract BG 91-66 and
45 1.1 eeh * contributed to Berkeley.
46 1.1 eeh *
47 1.1 eeh * All advertising materials mentioning features or use of this software
48 1.1 eeh * must display the following acknowledgement:
49 1.1 eeh * This product includes software developed by the University of
50 1.1 eeh * California, Lawrence Berkeley Laboratory.
51 1.1 eeh *
52 1.1 eeh * Redistribution and use in source and binary forms, with or without
53 1.1 eeh * modification, are permitted provided that the following conditions
54 1.1 eeh * are met:
55 1.1 eeh * 1. Redistributions of source code must retain the above copyright
56 1.1 eeh * notice, this list of conditions and the following disclaimer.
57 1.1 eeh * 2. Redistributions in binary form must reproduce the above copyright
58 1.1 eeh * notice, this list of conditions and the following disclaimer in the
59 1.1 eeh * documentation and/or other materials provided with the distribution.
60 1.1 eeh * 3. All advertising materials mentioning features or use of this software
61 1.1 eeh * must display the following acknowledgement:
62 1.1 eeh * This product includes software developed by the University of
63 1.1 eeh * California, Berkeley and its contributors.
64 1.1 eeh * 4. Neither the name of the University nor the names of its contributors
65 1.1 eeh * may be used to endorse or promote products derived from this software
66 1.1 eeh * without specific prior written permission.
67 1.1 eeh *
68 1.1 eeh * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
69 1.1 eeh * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
70 1.1 eeh * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
71 1.1 eeh * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
72 1.1 eeh * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
73 1.1 eeh * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
74 1.1 eeh * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
75 1.1 eeh * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
76 1.1 eeh * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
77 1.1 eeh * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
78 1.1 eeh * SUCH DAMAGE.
79 1.1 eeh *
80 1.1 eeh * @(#)sbus.c 8.1 (Berkeley) 6/11/93
81 1.1 eeh */
82 1.1 eeh
83 1.1 eeh /*
84 1.1 eeh * Sbus stuff.
85 1.1 eeh */
86 1.8 eeh #include "opt_ddb.h"
87 1.1 eeh
88 1.1 eeh #include <sys/param.h>
89 1.12 eeh #include <sys/extent.h>
90 1.1 eeh #include <sys/malloc.h>
91 1.1 eeh #include <sys/systm.h>
92 1.1 eeh #include <sys/device.h>
93 1.1 eeh #include <vm/vm.h>
94 1.1 eeh
95 1.1 eeh #include <machine/bus.h>
96 1.2 eeh #include <sparc64/sparc64/vaddrs.h>
97 1.13 mrg #include <sparc64/dev/iommureg.h>
98 1.1 eeh #include <sparc64/dev/sbusreg.h>
99 1.7 pk #include <dev/sbus/sbusvar.h>
100 1.1 eeh
101 1.1 eeh #include <machine/autoconf.h>
102 1.1 eeh #include <machine/ctlreg.h>
103 1.1 eeh #include <machine/cpu.h>
104 1.8 eeh #include <machine/sparc64.h>
105 1.1 eeh
106 1.1 eeh #ifdef DEBUG
107 1.1 eeh #define SDB_DVMA 0x1
108 1.1 eeh #define SDB_INTR 0x2
109 1.1 eeh int sbusdebug = 0;
110 1.1 eeh #endif
111 1.1 eeh
112 1.1 eeh void sbusreset __P((int));
113 1.1 eeh int sbus_flush __P((struct sbus_softc *));
114 1.1 eeh
115 1.1 eeh static bus_space_tag_t sbus_alloc_bustag __P((struct sbus_softc *));
116 1.1 eeh static bus_dma_tag_t sbus_alloc_dmatag __P((struct sbus_softc *));
117 1.3 eeh static int sbus_get_intr __P((struct sbus_softc *, int,
118 1.3 eeh struct sbus_intr **, int *));
119 1.1 eeh static int sbus_bus_mmap __P((bus_space_tag_t, bus_type_t, bus_addr_t,
120 1.1 eeh int, bus_space_handle_t *));
121 1.1 eeh static int _sbus_bus_map __P((
122 1.1 eeh bus_space_tag_t,
123 1.1 eeh bus_type_t,
124 1.1 eeh bus_addr_t, /*offset*/
125 1.1 eeh bus_size_t, /*size*/
126 1.1 eeh int, /*flags*/
127 1.3 eeh vaddr_t, /*preferred virtual address */
128 1.1 eeh bus_space_handle_t *));
129 1.1 eeh static void *sbus_intr_establish __P((
130 1.1 eeh bus_space_tag_t,
131 1.1 eeh int, /*level*/
132 1.1 eeh int, /*flags*/
133 1.1 eeh int (*) __P((void *)), /*handler*/
134 1.1 eeh void *)); /*handler arg*/
135 1.1 eeh
136 1.1 eeh
137 1.1 eeh /* autoconfiguration driver */
138 1.1 eeh int sbus_match __P((struct device *, struct cfdata *, void *));
139 1.1 eeh void sbus_attach __P((struct device *, struct device *, void *));
140 1.1 eeh
141 1.1 eeh
142 1.1 eeh struct cfattach sbus_ca = {
143 1.1 eeh sizeof(struct sbus_softc), sbus_match, sbus_attach
144 1.1 eeh };
145 1.1 eeh
146 1.1 eeh extern struct cfdriver sbus_cd;
147 1.1 eeh
148 1.1 eeh /*
149 1.1 eeh * DVMA routines
150 1.1 eeh */
151 1.3 eeh void sbus_enter __P((struct sbus_softc *, vaddr_t, int64_t, int));
152 1.8 eeh void sbus_remove __P((struct sbus_softc *, vaddr_t, size_t));
153 1.1 eeh int sbus_dmamap_load __P((bus_dma_tag_t, bus_dmamap_t, void *,
154 1.1 eeh bus_size_t, struct proc *, int));
155 1.1 eeh void sbus_dmamap_unload __P((bus_dma_tag_t, bus_dmamap_t));
156 1.1 eeh void sbus_dmamap_sync __P((bus_dma_tag_t, bus_dmamap_t, bus_addr_t,
157 1.1 eeh bus_size_t, int));
158 1.1 eeh int sbus_dmamem_alloc __P((bus_dma_tag_t tag, bus_size_t size,
159 1.1 eeh bus_size_t alignment, bus_size_t boundary,
160 1.1 eeh bus_dma_segment_t *segs, int nsegs, int *rsegs, int flags));
161 1.1 eeh void sbus_dmamem_free __P((bus_dma_tag_t tag, bus_dma_segment_t *segs,
162 1.1 eeh int nsegs));
163 1.2 eeh int sbus_dmamem_map __P((bus_dma_tag_t tag, bus_dma_segment_t *segs,
164 1.2 eeh int nsegs, size_t size, caddr_t *kvap, int flags));
165 1.2 eeh void sbus_dmamem_unmap __P((bus_dma_tag_t tag, caddr_t kva,
166 1.2 eeh size_t size));
167 1.1 eeh
168 1.1 eeh
169 1.1 eeh /*
170 1.1 eeh * Child devices receive the Sbus interrupt level in their attach
171 1.1 eeh * arguments. We translate these to CPU IPLs using the following
172 1.1 eeh * tables. Note: obio bus interrupt levels are identical to the
173 1.1 eeh * processor IPL.
174 1.1 eeh *
175 1.1 eeh * The second set of tables is used when the Sbus interrupt level
176 1.1 eeh * cannot be had from the PROM as an `interrupt' property. We then
177 1.1 eeh * fall back on the `intr' property which contains the CPU IPL.
178 1.1 eeh */
179 1.1 eeh
180 1.1 eeh /* Translate Sbus interrupt level to processor IPL */
181 1.1 eeh static int intr_sbus2ipl_4c[] = {
182 1.1 eeh 0, 1, 2, 3, 5, 7, 8, 9
183 1.1 eeh };
184 1.1 eeh static int intr_sbus2ipl_4m[] = {
185 1.1 eeh 0, 2, 3, 5, 7, 9, 11, 13
186 1.1 eeh };
187 1.1 eeh
188 1.1 eeh /*
189 1.1 eeh * This value is or'ed into the attach args' interrupt level cookie
190 1.1 eeh * if the interrupt level comes from an `intr' property, i.e. it is
191 1.1 eeh * not an Sbus interrupt level.
192 1.1 eeh */
193 1.1 eeh #define SBUS_INTR_COMPAT 0x80000000
194 1.1 eeh
195 1.1 eeh
196 1.1 eeh /*
197 1.1 eeh * Print the location of some sbus-attached device (called just
198 1.1 eeh * before attaching that device). If `sbus' is not NULL, the
199 1.1 eeh * device was found but not configured; print the sbus as well.
200 1.1 eeh * Return UNCONF (config_find ignores this if the device was configured).
201 1.1 eeh */
202 1.1 eeh int
203 1.1 eeh sbus_print(args, busname)
204 1.1 eeh void *args;
205 1.1 eeh const char *busname;
206 1.1 eeh {
207 1.1 eeh struct sbus_attach_args *sa = args;
208 1.3 eeh int i;
209 1.1 eeh
210 1.1 eeh if (busname)
211 1.1 eeh printf("%s at %s", sa->sa_name, busname);
212 1.8 eeh printf(" slot %ld offset 0x%lx", (long)sa->sa_slot,
213 1.8 eeh (u_long)sa->sa_offset);
214 1.3 eeh for (i=0; i<sa->sa_nintr; i++) {
215 1.3 eeh struct sbus_intr *sbi = &sa->sa_intr[i];
216 1.1 eeh
217 1.8 eeh printf(" vector %lx ipl %ld",
218 1.8 eeh (u_long)sbi->sbi_vec,
219 1.8 eeh (long)INTLEV(sbi->sbi_pri));
220 1.1 eeh }
221 1.1 eeh return (UNCONF);
222 1.1 eeh }
223 1.1 eeh
224 1.1 eeh int
225 1.1 eeh sbus_match(parent, cf, aux)
226 1.1 eeh struct device *parent;
227 1.1 eeh struct cfdata *cf;
228 1.1 eeh void *aux;
229 1.1 eeh {
230 1.1 eeh struct mainbus_attach_args *ma = aux;
231 1.1 eeh
232 1.1 eeh return (strcmp(cf->cf_driver->cd_name, ma->ma_name) == 0);
233 1.1 eeh }
234 1.1 eeh
235 1.1 eeh /*
236 1.1 eeh * Attach an Sbus.
237 1.1 eeh */
238 1.1 eeh void
239 1.1 eeh sbus_attach(parent, self, aux)
240 1.1 eeh struct device *parent;
241 1.1 eeh struct device *self;
242 1.1 eeh void *aux;
243 1.1 eeh {
244 1.9 eeh struct sbus_softc *sc = (struct sbus_softc *)self;
245 1.1 eeh struct mainbus_attach_args *ma = aux;
246 1.1 eeh int node = ma->ma_node;
247 1.1 eeh
248 1.1 eeh int node0, error;
249 1.1 eeh bus_space_tag_t sbt;
250 1.1 eeh struct sbus_attach_args sa;
251 1.1 eeh char *busname = "sbus";
252 1.1 eeh struct bootpath *bp = ma->ma_bp;
253 1.1 eeh
254 1.1 eeh
255 1.1 eeh sc->sc_bustag = ma->ma_bustag;
256 1.1 eeh sc->sc_dmatag = ma->ma_dmatag;
257 1.8 eeh sc->sc_sysio = (struct sysioreg*)(u_long)ma->ma_address[0]; /* Use prom mapping for sysio. */
258 1.1 eeh sc->sc_ign = ma->ma_interrupts[0] & INTMAP_IGN; /* Find interrupt group no */
259 1.1 eeh
260 1.1 eeh /* Setup interrupt translation tables */
261 1.1 eeh sc->sc_intr2ipl = CPU_ISSUN4C
262 1.1 eeh ? intr_sbus2ipl_4c
263 1.1 eeh : intr_sbus2ipl_4m;
264 1.1 eeh
265 1.1 eeh /*
266 1.1 eeh * Record clock frequency for synchronous SCSI.
267 1.1 eeh * IS THIS THE CORRECT DEFAULT??
268 1.1 eeh */
269 1.1 eeh sc->sc_clockfreq = getpropint(node, "clock-frequency", 25*1000*1000);
270 1.1 eeh printf(": clock = %s MHz\n", clockfreq(sc->sc_clockfreq));
271 1.1 eeh
272 1.1 eeh sbt = sbus_alloc_bustag(sc);
273 1.1 eeh sc->sc_dmatag = sbus_alloc_dmatag(sc);
274 1.1 eeh
275 1.1 eeh /*
276 1.1 eeh * Get the SBus burst transfer size if burst transfers are supported
277 1.1 eeh */
278 1.1 eeh sc->sc_burst = getpropint(node, "burst-sizes", 0);
279 1.1 eeh
280 1.1 eeh /* Propagate bootpath */
281 1.1 eeh if (bp != NULL && strcmp(bp->name, busname) == 0)
282 1.1 eeh bp++;
283 1.1 eeh else
284 1.1 eeh bp = NULL;
285 1.1 eeh
286 1.1 eeh /*
287 1.1 eeh * Collect address translations from the OBP.
288 1.1 eeh */
289 1.6 pk error = getprop(node, "ranges", sizeof(struct sbus_range),
290 1.1 eeh &sc->sc_nrange, (void **)&sc->sc_range);
291 1.16 eeh if (error)
292 1.1 eeh panic("%s: error getting ranges property", sc->sc_dev.dv_xname);
293 1.1 eeh
294 1.1 eeh /*
295 1.1 eeh * Setup the iommu.
296 1.1 eeh *
297 1.1 eeh * The sun4u iommu is part of the SBUS controller so we will
298 1.1 eeh * deal with it here. We could try to fake a device node so
299 1.12 eeh * we can eventually share it with the PCI bus run by psycho,
300 1.1 eeh * but I don't want to get into that sort of cruft.
301 1.12 eeh *
302 1.12 eeh * First we need to allocate a IOTSB. Problem is that the IOMMU
303 1.12 eeh * can only access the IOTSB by physical address, so all the
304 1.12 eeh * pages must be contiguous. Luckily, the smallest IOTSB size
305 1.12 eeh * is one 8K page.
306 1.1 eeh */
307 1.12 eeh sc->sc_tsbsize = 0;
308 1.12 eeh sc->sc_tsb = malloc(NBPG, M_DMAMAP, M_WAITOK);
309 1.12 eeh sc->sc_ptsb = pmap_extract(pmap_kernel(), (vaddr_t)sc->sc_tsb);
310 1.1 eeh
311 1.1 eeh /* Need to do 64-bit stores */
312 1.8 eeh bus_space_write_8(sc->sc_bustag, &sc->sc_sysio->sys_iommu.iommu_cr,
313 1.8 eeh 0, (IOMMUCR_TSB1K|IOMMUCR_8KPG|IOMMUCR_EN));
314 1.8 eeh bus_space_write_8(sc->sc_bustag, &sc->sc_sysio->sys_iommu.iommu_tsb,
315 1.8 eeh 0, sc->sc_ptsb);
316 1.16 eeh
317 1.1 eeh #ifdef DEBUG
318 1.1 eeh if (sbusdebug & SDB_DVMA)
319 1.1 eeh {
320 1.1 eeh /* Probe the iommu */
321 1.1 eeh int64_t cr, tsb;
322 1.1 eeh
323 1.8 eeh printf("iommu regs at: cr=%lx tsb=%lx flush=%lx\n", &sc->sc_sysio->sys_iommu.iommu_cr,
324 1.1 eeh &sc->sc_sysio->sys_iommu.iommu_tsb, &sc->sc_sysio->sys_iommu.iommu_flush);
325 1.1 eeh cr = sc->sc_sysio->sys_iommu.iommu_cr;
326 1.1 eeh tsb = sc->sc_sysio->sys_iommu.iommu_tsb;
327 1.8 eeh printf("iommu cr=%lx tsb=%lx\n", (long)cr, (long)tsb);
328 1.1 eeh printf("sysio base %p phys %p TSB base %p phys %p",
329 1.3 eeh (long)sc->sc_sysio, (long)pmap_extract(pmap_kernel(), (vaddr_t)sc->sc_sysio),
330 1.1 eeh (long)sc->sc_tsb, (long)sc->sc_ptsb);
331 1.1 eeh delay(1000000); /* 1 s */
332 1.1 eeh }
333 1.1 eeh #endif
334 1.1 eeh
335 1.1 eeh /*
336 1.1 eeh * Initialize streaming buffer.
337 1.1 eeh */
338 1.3 eeh sc->sc_flushpa = pmap_extract(pmap_kernel(), (vaddr_t)&sc->sc_flush);
339 1.8 eeh bus_space_write_8(sc->sc_bustag, &sc->sc_sysio->sys_strbuf.strbuf_ctl,
340 1.8 eeh 0, STRBUF_EN); /* Enable diagnostics mode? */
341 1.1 eeh
342 1.1 eeh /*
343 1.12 eeh * Now all the hardware's working we need to allocate a dvma map.
344 1.12 eeh *
345 1.12 eeh * The IOMMU address space always ends at 0xffffe000, but the starting
346 1.12 eeh * address depends on the size of the map. The map size is 1024 * 2 ^
347 1.12 eeh * sc->sc_tsbsize entries, where each entry is 8 bytes. The start of
348 1.12 eeh * the map can be calculated by (0xffffe000 << (8 + sc->sc_tsbsize)).
349 1.12 eeh *
350 1.12 eeh * Note: the stupid IOMMU ignores the high bits of an address, so a
351 1.12 eeh * NULL DMA pointer will be translated by the first page of the IOTSB.
352 1.12 eeh * To trap bugs we'll skip the first entry in the IOTSB.
353 1.12 eeh */
354 1.12 eeh sc->sc_dvmamap = extent_create("SBus dvma", /* XXXX should have instance number */
355 1.12 eeh IOTSB_VSTART(sc->sc_tsbsize) + NBPG, IOTSB_VEND,
356 1.12 eeh M_DEVBUF, 0, 0, EX_NOWAIT);
357 1.12 eeh
358 1.12 eeh /*
359 1.1 eeh * Loop through ROM children, fixing any relative addresses
360 1.1 eeh * and then configuring each device.
361 1.1 eeh * `specials' is an array of device names that are treated
362 1.1 eeh * specially:
363 1.1 eeh */
364 1.1 eeh node0 = firstchild(node);
365 1.1 eeh for (node = node0; node; node = nextsibling(node)) {
366 1.1 eeh char *name = getpropstring(node, "name");
367 1.1 eeh
368 1.1 eeh if (sbus_setup_attach_args(sc, sbt, sc->sc_dmatag,
369 1.1 eeh node, bp, &sa) != 0) {
370 1.1 eeh printf("sbus_attach: %s: incomplete\n", name);
371 1.1 eeh continue;
372 1.1 eeh }
373 1.1 eeh (void) config_found(&sc->sc_dev, (void *)&sa, sbus_print);
374 1.3 eeh sbus_destroy_attach_args(&sa);
375 1.1 eeh }
376 1.1 eeh }
377 1.1 eeh
378 1.1 eeh int
379 1.1 eeh sbus_setup_attach_args(sc, bustag, dmatag, node, bp, sa)
380 1.1 eeh struct sbus_softc *sc;
381 1.1 eeh bus_space_tag_t bustag;
382 1.1 eeh bus_dma_tag_t dmatag;
383 1.1 eeh int node;
384 1.1 eeh struct bootpath *bp;
385 1.1 eeh struct sbus_attach_args *sa;
386 1.1 eeh {
387 1.3 eeh /*struct sbus_reg sbusreg;*/
388 1.3 eeh /*int base;*/
389 1.1 eeh int error;
390 1.3 eeh int n;
391 1.1 eeh
392 1.1 eeh bzero(sa, sizeof(struct sbus_attach_args));
393 1.6 pk error = getprop(node, "name", 1, &n, (void **)&sa->sa_name);
394 1.3 eeh if (error != 0)
395 1.3 eeh return (error);
396 1.3 eeh sa->sa_name[n] = '\0';
397 1.3 eeh
398 1.1 eeh sa->sa_bustag = bustag;
399 1.1 eeh sa->sa_dmatag = dmatag;
400 1.1 eeh sa->sa_node = node;
401 1.1 eeh sa->sa_bp = bp;
402 1.1 eeh
403 1.6 pk error = getprop(node, "reg", sizeof(struct sbus_reg),
404 1.3 eeh &sa->sa_nreg, (void **)&sa->sa_reg);
405 1.3 eeh if (error != 0) {
406 1.3 eeh char buf[32];
407 1.3 eeh if (error != ENOENT ||
408 1.3 eeh !node_has_property(node, "device_type") ||
409 1.3 eeh strcmp(getpropstringA(node, "device_type", buf),
410 1.3 eeh "hierarchical") != 0)
411 1.3 eeh return (error);
412 1.3 eeh }
413 1.3 eeh for (n = 0; n < sa->sa_nreg; n++) {
414 1.3 eeh /* Convert to relative addressing, if necessary */
415 1.3 eeh u_int32_t base = sa->sa_reg[n].sbr_offset;
416 1.3 eeh if (SBUS_ABS(base)) {
417 1.3 eeh sa->sa_reg[n].sbr_slot = SBUS_ABS_TO_SLOT(base);
418 1.3 eeh sa->sa_reg[n].sbr_offset = SBUS_ABS_TO_OFFSET(base);
419 1.3 eeh }
420 1.1 eeh }
421 1.1 eeh
422 1.3 eeh if ((error = sbus_get_intr(sc, node, &sa->sa_intr, &sa->sa_nintr)) != 0)
423 1.1 eeh return (error);
424 1.1 eeh
425 1.6 pk error = getprop(node, "address", sizeof(u_int32_t),
426 1.3 eeh &sa->sa_npromvaddrs, (void **)&sa->sa_promvaddrs);
427 1.3 eeh if (error != 0 && error != ENOENT)
428 1.1 eeh return (error);
429 1.1 eeh
430 1.1 eeh return (0);
431 1.1 eeh }
432 1.1 eeh
433 1.3 eeh void
434 1.3 eeh sbus_destroy_attach_args(sa)
435 1.3 eeh struct sbus_attach_args *sa;
436 1.3 eeh {
437 1.3 eeh if (sa->sa_name != NULL)
438 1.3 eeh free(sa->sa_name, M_DEVBUF);
439 1.3 eeh
440 1.3 eeh if (sa->sa_nreg != 0)
441 1.3 eeh free(sa->sa_reg, M_DEVBUF);
442 1.3 eeh
443 1.3 eeh if (sa->sa_intr)
444 1.3 eeh free(sa->sa_intr, M_DEVBUF);
445 1.3 eeh
446 1.3 eeh if (sa->sa_promvaddrs)
447 1.8 eeh free((void *)sa->sa_promvaddrs, M_DEVBUF);
448 1.3 eeh
449 1.3 eeh bzero(sa, sizeof(struct sbus_attach_args));/*DEBUG*/
450 1.3 eeh }
451 1.3 eeh
452 1.3 eeh
453 1.1 eeh int
454 1.1 eeh _sbus_bus_map(t, btype, offset, size, flags, vaddr, hp)
455 1.1 eeh bus_space_tag_t t;
456 1.1 eeh bus_type_t btype;
457 1.1 eeh bus_addr_t offset;
458 1.1 eeh bus_size_t size;
459 1.1 eeh int flags;
460 1.3 eeh vaddr_t vaddr;
461 1.1 eeh bus_space_handle_t *hp;
462 1.1 eeh {
463 1.1 eeh struct sbus_softc *sc = t->cookie;
464 1.1 eeh int64_t slot = btype;
465 1.1 eeh int i;
466 1.1 eeh
467 1.1 eeh for (i = 0; i < sc->sc_nrange; i++) {
468 1.1 eeh bus_addr_t paddr;
469 1.1 eeh
470 1.1 eeh if (sc->sc_range[i].cspace != slot)
471 1.1 eeh continue;
472 1.1 eeh
473 1.1 eeh /* We've found the connection to the parent bus */
474 1.1 eeh paddr = sc->sc_range[i].poffset + offset;
475 1.1 eeh paddr |= ((bus_addr_t)sc->sc_range[i].pspace<<32);
476 1.1 eeh #ifdef DEBUG
477 1.1 eeh if (sbusdebug & SDB_DVMA)
478 1.8 eeh printf("\n_sbus_bus_map: mapping paddr slot %lx offset %lx poffset %lx paddr %lx\n",
479 1.8 eeh (long)slot, (long)offset, (long)sc->sc_range[i].poffset, (long)paddr);
480 1.1 eeh #endif
481 1.1 eeh return (bus_space_map2(sc->sc_bustag, 0, paddr,
482 1.1 eeh size, flags, vaddr, hp));
483 1.1 eeh }
484 1.1 eeh
485 1.1 eeh return (EINVAL);
486 1.1 eeh }
487 1.1 eeh
488 1.1 eeh int
489 1.1 eeh sbus_bus_mmap(t, btype, paddr, flags, hp)
490 1.1 eeh bus_space_tag_t t;
491 1.1 eeh bus_type_t btype;
492 1.1 eeh bus_addr_t paddr;
493 1.1 eeh int flags;
494 1.1 eeh bus_space_handle_t *hp;
495 1.1 eeh {
496 1.1 eeh bus_addr_t offset = paddr;
497 1.1 eeh int slot = (paddr>>32);
498 1.1 eeh struct sbus_softc *sc = t->cookie;
499 1.1 eeh int i;
500 1.1 eeh
501 1.1 eeh for (i = 0; i < sc->sc_nrange; i++) {
502 1.1 eeh bus_addr_t paddr;
503 1.1 eeh
504 1.1 eeh if (sc->sc_range[i].cspace != slot)
505 1.1 eeh continue;
506 1.1 eeh
507 1.1 eeh paddr = sc->sc_range[i].poffset + offset;
508 1.1 eeh paddr |= ((bus_addr_t)sc->sc_range[i].pspace<<32);
509 1.1 eeh return (bus_space_mmap(sc->sc_bustag, 0, paddr,
510 1.1 eeh flags, hp));
511 1.1 eeh }
512 1.1 eeh
513 1.1 eeh return (-1);
514 1.1 eeh }
515 1.1 eeh
516 1.1 eeh
517 1.1 eeh /*
518 1.1 eeh * Each attached device calls sbus_establish after it initializes
519 1.1 eeh * its sbusdev portion.
520 1.1 eeh */
521 1.1 eeh void
522 1.1 eeh sbus_establish(sd, dev)
523 1.1 eeh register struct sbusdev *sd;
524 1.1 eeh register struct device *dev;
525 1.1 eeh {
526 1.1 eeh register struct sbus_softc *sc;
527 1.1 eeh register struct device *curdev;
528 1.1 eeh
529 1.1 eeh /*
530 1.1 eeh * We have to look for the sbus by name, since it is not necessarily
531 1.1 eeh * our immediate parent (i.e. sun4m /iommu/sbus/espdma/esp)
532 1.1 eeh * We don't just use the device structure of the above-attached
533 1.1 eeh * sbus, since we might (in the future) support multiple sbus's.
534 1.1 eeh */
535 1.1 eeh for (curdev = dev->dv_parent; ; curdev = curdev->dv_parent) {
536 1.1 eeh if (!curdev || !curdev->dv_xname)
537 1.1 eeh panic("sbus_establish: can't find sbus parent for %s",
538 1.1 eeh sd->sd_dev->dv_xname
539 1.1 eeh ? sd->sd_dev->dv_xname
540 1.1 eeh : "<unknown>" );
541 1.1 eeh
542 1.1 eeh if (strncmp(curdev->dv_xname, "sbus", 4) == 0)
543 1.1 eeh break;
544 1.1 eeh }
545 1.1 eeh sc = (struct sbus_softc *) curdev;
546 1.1 eeh
547 1.1 eeh sd->sd_dev = dev;
548 1.1 eeh sd->sd_bchain = sc->sc_sbdev;
549 1.1 eeh sc->sc_sbdev = sd;
550 1.1 eeh }
551 1.1 eeh
552 1.1 eeh /*
553 1.1 eeh * Reset the given sbus. (???)
554 1.1 eeh */
555 1.1 eeh void
556 1.1 eeh sbusreset(sbus)
557 1.1 eeh int sbus;
558 1.1 eeh {
559 1.1 eeh register struct sbusdev *sd;
560 1.1 eeh struct sbus_softc *sc = sbus_cd.cd_devs[sbus];
561 1.1 eeh struct device *dev;
562 1.1 eeh
563 1.1 eeh printf("reset %s:", sc->sc_dev.dv_xname);
564 1.1 eeh for (sd = sc->sc_sbdev; sd != NULL; sd = sd->sd_bchain) {
565 1.1 eeh if (sd->sd_reset) {
566 1.1 eeh dev = sd->sd_dev;
567 1.1 eeh (*sd->sd_reset)(dev);
568 1.1 eeh printf(" %s", dev->dv_xname);
569 1.1 eeh }
570 1.1 eeh }
571 1.1 eeh /* Reload iommu regs */
572 1.12 eeh bus_space_write_8(sc->sc_bustag, &sc->sc_sysio->sys_iommu.iommu_cr,
573 1.8 eeh 0, (IOMMUCR_TSB1K|IOMMUCR_8KPG|IOMMUCR_EN));
574 1.8 eeh bus_space_write_8(sc->sc_bustag, &sc->sc_sysio->sys_iommu.iommu_tsb,
575 1.8 eeh 0, sc->sc_ptsb);
576 1.8 eeh bus_space_write_8(sc->sc_bustag, &sc->sc_sysio->sys_strbuf.strbuf_ctl,
577 1.8 eeh 0, STRBUF_EN); /* Enable diagnostics mode? */
578 1.1 eeh }
579 1.1 eeh
580 1.1 eeh /*
581 1.1 eeh * Here are the iommu control routines.
582 1.1 eeh */
583 1.1 eeh void
584 1.2 eeh sbus_enter(sc, va, pa, flags)
585 1.1 eeh struct sbus_softc *sc;
586 1.3 eeh vaddr_t va;
587 1.1 eeh int64_t pa;
588 1.2 eeh int flags;
589 1.1 eeh {
590 1.1 eeh int64_t tte;
591 1.1 eeh
592 1.1 eeh #ifdef DIAGNOSTIC
593 1.1 eeh if (va < sc->sc_dvmabase)
594 1.8 eeh panic("sbus_enter: va 0x%lx not in DVMA space",va);
595 1.1 eeh #endif
596 1.1 eeh
597 1.3 eeh tte = MAKEIOTTE(pa, !(flags&BUS_DMA_NOWRITE), !(flags&BUS_DMA_NOCACHE),
598 1.2 eeh !(flags&BUS_DMA_COHERENT));
599 1.1 eeh
600 1.1 eeh /* Is the streamcache flush really needed? */
601 1.8 eeh bus_space_write_8(sc->sc_bustag, &sc->sc_sysio->sys_strbuf.strbuf_pgflush,
602 1.8 eeh 0, va);
603 1.1 eeh sbus_flush(sc);
604 1.12 eeh #ifdef DEBUG
605 1.12 eeh if (sbusdebug & SDB_DVMA)
606 1.12 eeh printf("Clearing TSB slot %d for va %p\n", (int)IOTSBSLOT(va,sc->sc_tsbsize), va);
607 1.12 eeh #endif
608 1.1 eeh sc->sc_tsb[IOTSBSLOT(va,sc->sc_tsbsize)] = tte;
609 1.8 eeh bus_space_write_8(sc->sc_bustag, &sc->sc_sysio->sys_iommu.iommu_flush,
610 1.8 eeh 0, va);
611 1.1 eeh #ifdef DEBUG
612 1.1 eeh if (sbusdebug & SDB_DVMA)
613 1.8 eeh printf("sbus_enter: va %lx pa %lx TSB[%lx]@%p=%lx\n",
614 1.8 eeh va, (long)pa, IOTSBSLOT(va,sc->sc_tsbsize),
615 1.1 eeh &sc->sc_tsb[IOTSBSLOT(va,sc->sc_tsbsize)],
616 1.8 eeh (long)tte);
617 1.1 eeh #endif
618 1.1 eeh }
619 1.1 eeh
620 1.1 eeh /*
621 1.1 eeh * sbus_clear: clears mappings created by sbus_enter
622 1.1 eeh *
623 1.1 eeh * Only demap from IOMMU if flag is set.
624 1.1 eeh */
625 1.1 eeh void
626 1.1 eeh sbus_remove(sc, va, len)
627 1.1 eeh struct sbus_softc *sc;
628 1.3 eeh vaddr_t va;
629 1.8 eeh size_t len;
630 1.1 eeh {
631 1.1 eeh
632 1.1 eeh #ifdef DIAGNOSTIC
633 1.1 eeh if (va < sc->sc_dvmabase)
634 1.8 eeh panic("sbus_remove: va 0x%lx not in DVMA space", (long)va);
635 1.8 eeh if ((long)(va + len) < (long)va)
636 1.8 eeh panic("sbus_remove: va 0x%lx + len 0x%lx wraps",
637 1.8 eeh (long) va, (long) len);
638 1.8 eeh if (len & ~0xfffffff)
639 1.8 eeh panic("sbus_remove: rediculous len 0x%lx", (long)len);
640 1.1 eeh #endif
641 1.1 eeh
642 1.2 eeh va = trunc_page(va);
643 1.1 eeh while (len > 0) {
644 1.1 eeh
645 1.1 eeh /*
646 1.1 eeh * Streaming buffer flushes:
647 1.1 eeh *
648 1.1 eeh * 1 Tell strbuf to flush by storing va to strbuf_pgflush
649 1.1 eeh * If we're not on a cache line boundary (64-bits):
650 1.1 eeh * 2 Store 0 in flag
651 1.1 eeh * 3 Store pointer to flag in flushsync
652 1.1 eeh * 4 wait till flushsync becomes 0x1
653 1.1 eeh *
654 1.1 eeh * If it takes more than .5 sec, something went wrong.
655 1.1 eeh */
656 1.8 eeh #ifdef DEBUG
657 1.8 eeh if (sbusdebug & SDB_DVMA)
658 1.8 eeh printf("sbus_remove: flushing va %p TSB[%lx]@%p=%lx, %lu bytes left\n",
659 1.8 eeh (long)va, (long)IOTSBSLOT(va,sc->sc_tsbsize),
660 1.8 eeh (long)&sc->sc_tsb[IOTSBSLOT(va,sc->sc_tsbsize)],
661 1.8 eeh (long)(sc->sc_tsb[IOTSBSLOT(va,sc->sc_tsbsize)]),
662 1.8 eeh (u_long)len);
663 1.8 eeh #endif
664 1.8 eeh bus_space_write_8(sc->sc_bustag, &sc->sc_sysio->sys_strbuf.strbuf_pgflush, 0, va);
665 1.1 eeh if (len <= NBPG) {
666 1.1 eeh sbus_flush(sc);
667 1.8 eeh len = 0;
668 1.8 eeh } else len -= NBPG;
669 1.1 eeh #ifdef DEBUG
670 1.1 eeh if (sbusdebug & SDB_DVMA)
671 1.8 eeh printf("sbus_remove: flushed va %p TSB[%lx]@%p=%lx, %lu bytes left\n",
672 1.8 eeh (long)va, (long)IOTSBSLOT(va,sc->sc_tsbsize),
673 1.4 eeh (long)&sc->sc_tsb[IOTSBSLOT(va,sc->sc_tsbsize)],
674 1.8 eeh (long)(sc->sc_tsb[IOTSBSLOT(va,sc->sc_tsbsize)]),
675 1.8 eeh (u_long)len);
676 1.1 eeh #endif
677 1.1 eeh sc->sc_tsb[IOTSBSLOT(va,sc->sc_tsbsize)] = 0;
678 1.8 eeh bus_space_write_8(sc->sc_bustag, &sc->sc_sysio->sys_iommu.iommu_flush, 0, va);
679 1.1 eeh va += NBPG;
680 1.1 eeh }
681 1.1 eeh }
682 1.1 eeh
683 1.1 eeh int
684 1.1 eeh sbus_flush(sc)
685 1.1 eeh struct sbus_softc *sc;
686 1.1 eeh {
687 1.16 eeh struct timeval cur, flushtimeout;
688 1.16 eeh #define BUMPTIME(t, usec) { \
689 1.16 eeh register volatile struct timeval *tp = (t); \
690 1.16 eeh register long us; \
691 1.16 eeh \
692 1.16 eeh tp->tv_usec = us = tp->tv_usec + (usec); \
693 1.16 eeh if (us >= 1000000) { \
694 1.16 eeh tp->tv_usec = us - 1000000; \
695 1.16 eeh tp->tv_sec++; \
696 1.16 eeh } \
697 1.16 eeh }
698 1.1 eeh
699 1.1 eeh sc->sc_flush = 0;
700 1.8 eeh membar_sync();
701 1.8 eeh bus_space_write_8(sc->sc_bustag, &sc->sc_sysio->sys_strbuf.strbuf_flushsync, 0, sc->sc_flushpa);
702 1.8 eeh membar_sync();
703 1.16 eeh
704 1.16 eeh microtime(&flushtimeout);
705 1.16 eeh cur = flushtimeout;
706 1.16 eeh BUMPTIME(&flushtimeout, 500000); /* 1/2 sec */
707 1.16 eeh
708 1.8 eeh #ifdef DEBUG
709 1.16 eeh if (sbusdebug & SDB_DVMA) {
710 1.16 eeh printf("sbus_flush: flush = %lx at va = %lx pa = %lx now=%lx until = %lx:%lx\n",
711 1.8 eeh (long)sc->sc_flush, (long)&sc->sc_flush,
712 1.16 eeh (long)sc->sc_flushpa, cur.tv_sec, cur.tv_usec,
713 1.16 eeh flushtimeout.tv_sec, flushtimeout.tv_usec);
714 1.16 eeh }
715 1.1 eeh #endif
716 1.8 eeh /* Bypass non-coherent D$ */
717 1.16 eeh while( !ldxa(sc->sc_flushpa, ASI_PHYS_CACHED) &&
718 1.16 eeh ((cur.tv_sec <= flushtimeout.tv_sec) &&
719 1.16 eeh (cur.tv_usec <= flushtimeout.tv_usec)))
720 1.16 eeh microtime(&cur);
721 1.16 eeh
722 1.1 eeh #ifdef DIAGNOSTIC
723 1.8 eeh if( !sc->sc_flush ) {
724 1.8 eeh printf("sbus_flush: flush timeout %p at %p\n", (long)sc->sc_flush,
725 1.5 eeh (long)sc->sc_flushpa); /* panic? */
726 1.8 eeh #ifdef DDB
727 1.8 eeh Debugger();
728 1.8 eeh #endif
729 1.8 eeh }
730 1.8 eeh #endif
731 1.8 eeh #ifdef DEBUG
732 1.8 eeh if (sbusdebug & SDB_DVMA)
733 1.8 eeh printf("sbus_flush: flushed\n");
734 1.1 eeh #endif
735 1.1 eeh return (sc->sc_flush);
736 1.1 eeh }
737 1.16 eeh
738 1.1 eeh /*
739 1.1 eeh * Get interrupt attributes for an Sbus device.
740 1.1 eeh */
741 1.1 eeh int
742 1.3 eeh sbus_get_intr(sc, node, ipp, np)
743 1.1 eeh struct sbus_softc *sc;
744 1.1 eeh int node;
745 1.3 eeh struct sbus_intr **ipp;
746 1.3 eeh int *np;
747 1.1 eeh {
748 1.1 eeh int *ipl;
749 1.3 eeh int i, n, error;
750 1.1 eeh char buf[32];
751 1.1 eeh
752 1.1 eeh /*
753 1.1 eeh * The `interrupts' property contains the Sbus interrupt level.
754 1.1 eeh */
755 1.1 eeh ipl = NULL;
756 1.6 pk if (getprop(node, "interrupts", sizeof(int), np, (void **)&ipl) == 0) {
757 1.3 eeh /* Change format to an `struct sbus_intr' array */
758 1.3 eeh struct sbus_intr *ip;
759 1.10 eeh /* Default to interrupt level 2 -- otherwise unused */
760 1.10 eeh int pri = INTLEVENCODE(2);
761 1.3 eeh ip = malloc(*np * sizeof(struct sbus_intr), M_DEVBUF, M_NOWAIT);
762 1.3 eeh if (ip == NULL)
763 1.3 eeh return (ENOMEM);
764 1.1 eeh /* Now things get ugly. We need to take this value which is
765 1.1 eeh * the interrupt vector number and encode the IPL into it
766 1.1 eeh * somehow. Luckily, the interrupt vector has lots of free
767 1.1 eeh * space and we can easily stuff the IPL in there for a while.
768 1.1 eeh */
769 1.1 eeh getpropstringA(node, "device_type", buf);
770 1.10 eeh if (!buf[0]) {
771 1.10 eeh getpropstringA(node, "name", buf);
772 1.10 eeh }
773 1.3 eeh for (i=0; intrmap[i].in_class; i++) {
774 1.3 eeh if (strcmp(intrmap[i].in_class, buf) == 0) {
775 1.3 eeh pri = INTLEVENCODE(intrmap[i].in_lev);
776 1.1 eeh break;
777 1.1 eeh }
778 1.1 eeh }
779 1.3 eeh for (n = 0; n < *np; n++) {
780 1.3 eeh /*
781 1.3 eeh * We encode vector and priority into sbi_pri so we
782 1.3 eeh * can pass them as a unit. This will go away if
783 1.3 eeh * sbus_establish ever takes an sbus_intr instead
784 1.3 eeh * of an integer level.
785 1.3 eeh * Stuff the real vector in sbi_vec.
786 1.3 eeh */
787 1.3 eeh ip[n].sbi_pri = pri|ipl[n];
788 1.3 eeh ip[n].sbi_vec = ipl[n];
789 1.3 eeh }
790 1.1 eeh free(ipl, M_DEVBUF);
791 1.3 eeh *ipp = ip;
792 1.1 eeh return (0);
793 1.1 eeh }
794 1.1 eeh
795 1.1 eeh /* We really don't support the following */
796 1.1 eeh /* printf("\nWARNING: sbus_get_intr() \"interrupts\" not found -- using \"intr\"\n"); */
797 1.1 eeh /* And some devices don't even have interrupts */
798 1.1 eeh /*
799 1.1 eeh * Fall back on `intr' property.
800 1.1 eeh */
801 1.3 eeh *ipp = NULL;
802 1.6 pk error = getprop(node, "intr", sizeof(struct sbus_intr),
803 1.3 eeh np, (void **)ipp);
804 1.3 eeh switch (error) {
805 1.1 eeh case 0:
806 1.3 eeh for (n = *np; n-- > 0;) {
807 1.3 eeh /*
808 1.3 eeh * Move the interrupt vector into place.
809 1.3 eeh * We could remap the level, but the SBUS priorities
810 1.3 eeh * are probably good enough.
811 1.3 eeh */
812 1.3 eeh (*ipp)[n].sbi_vec = (*ipp)[n].sbi_pri;
813 1.3 eeh (*ipp)[n].sbi_pri |= INTLEVENCODE((*ipp)[n].sbi_pri);
814 1.1 eeh }
815 1.3 eeh break;
816 1.1 eeh case ENOENT:
817 1.3 eeh error = 0;
818 1.3 eeh break;
819 1.1 eeh }
820 1.1 eeh
821 1.3 eeh return (error);
822 1.1 eeh }
823 1.1 eeh
824 1.1 eeh
825 1.1 eeh /*
826 1.1 eeh * Install an interrupt handler for an Sbus device.
827 1.1 eeh */
828 1.1 eeh void *
829 1.1 eeh sbus_intr_establish(t, level, flags, handler, arg)
830 1.1 eeh bus_space_tag_t t;
831 1.1 eeh int level;
832 1.1 eeh int flags;
833 1.1 eeh int (*handler) __P((void *));
834 1.1 eeh void *arg;
835 1.1 eeh {
836 1.1 eeh struct sbus_softc *sc = t->cookie;
837 1.1 eeh struct intrhand *ih;
838 1.1 eeh int ipl;
839 1.8 eeh long vec = level;
840 1.1 eeh
841 1.1 eeh ih = (struct intrhand *)
842 1.1 eeh malloc(sizeof(struct intrhand), M_DEVBUF, M_NOWAIT);
843 1.1 eeh if (ih == NULL)
844 1.1 eeh return (NULL);
845 1.1 eeh
846 1.1 eeh if ((flags & BUS_INTR_ESTABLISH_SOFTINTR) != 0)
847 1.8 eeh ipl = vec;
848 1.8 eeh else if ((vec & SBUS_INTR_COMPAT) != 0)
849 1.8 eeh ipl = vec & ~SBUS_INTR_COMPAT;
850 1.1 eeh else {
851 1.1 eeh /* Decode and remove IPL */
852 1.8 eeh ipl = INTLEV(vec);
853 1.8 eeh vec = INTVEC(vec);
854 1.1 eeh #ifdef DEBUG
855 1.1 eeh if (sbusdebug & SDB_INTR) {
856 1.8 eeh printf("\nsbus: intr[%ld]%lx: %lx\n", (long)ipl, (long)vec,
857 1.8 eeh intrlev[vec]);
858 1.1 eeh printf("Hunting for IRQ...\n");
859 1.1 eeh }
860 1.1 eeh #endif
861 1.8 eeh if ((vec & INTMAP_OBIO) == 0) {
862 1.1 eeh /* We're in an SBUS slot */
863 1.1 eeh /* Register the map and clear intr registers */
864 1.1 eeh #ifdef DEBUG
865 1.1 eeh if (sbusdebug & SDB_INTR) {
866 1.8 eeh int64_t *intrptr = &(&sc->sc_sysio->sbus_slot0_int)[INTSLOT(vec)];
867 1.1 eeh int64_t intrmap = *intrptr;
868 1.1 eeh
869 1.8 eeh printf("Found SBUS %lx IRQ as %llx in slot %ld\n",
870 1.8 eeh (long)vec, (long)intrmap,
871 1.8 eeh (long)INTSLOT(vec));
872 1.1 eeh }
873 1.1 eeh #endif
874 1.8 eeh ih->ih_map = &(&sc->sc_sysio->sbus_slot0_int)[INTSLOT(vec)];
875 1.8 eeh ih->ih_clr = &sc->sc_sysio->sbus0_clr_int[INTVEC(vec)];
876 1.1 eeh /* Enable the interrupt */
877 1.8 eeh vec |= INTMAP_V;
878 1.9 eeh /* Insert IGN */
879 1.9 eeh vec |= sc->sc_ign;
880 1.8 eeh bus_space_write_8(sc->sc_bustag, ih->ih_map, 0, vec);
881 1.1 eeh } else {
882 1.1 eeh int64_t *intrptr = &sc->sc_sysio->scsi_int_map;
883 1.1 eeh int64_t intrmap = 0;
884 1.1 eeh int i;
885 1.1 eeh
886 1.1 eeh /* Insert IGN */
887 1.8 eeh vec |= sc->sc_ign;
888 1.1 eeh for (i=0;
889 1.1 eeh &intrptr[i] <= (int64_t *)&sc->sc_sysio->reserved_int_map &&
890 1.8 eeh INTVEC(intrmap=intrptr[i]) != INTVEC(vec);
891 1.1 eeh i++);
892 1.8 eeh if (INTVEC(intrmap) == INTVEC(vec)) {
893 1.1 eeh #ifdef DEBUG
894 1.1 eeh if (sbusdebug & SDB_INTR)
895 1.8 eeh printf("Found OBIO %lx IRQ as %lx in slot %d\n",
896 1.8 eeh vec, (long)intrmap, i);
897 1.1 eeh #endif
898 1.1 eeh /* Register the map and clear intr registers */
899 1.1 eeh ih->ih_map = &intrptr[i];
900 1.1 eeh intrptr = (int64_t *)&sc->sc_sysio->scsi_clr_int;
901 1.1 eeh ih->ih_clr = &intrptr[i];
902 1.1 eeh /* Enable the interrupt */
903 1.1 eeh intrmap |= INTMAP_V;
904 1.8 eeh bus_space_write_8(sc->sc_bustag, ih->ih_map, 0, (u_long)intrmap);
905 1.1 eeh } else panic("IRQ not found!");
906 1.1 eeh }
907 1.1 eeh }
908 1.1 eeh #ifdef DEBUG
909 1.8 eeh if (sbusdebug & SDB_INTR) { long i; for (i=0; i<1400000000; i++); }
910 1.1 eeh #endif
911 1.1 eeh
912 1.1 eeh ih->ih_fun = handler;
913 1.1 eeh ih->ih_arg = arg;
914 1.8 eeh ih->ih_number = vec;
915 1.1 eeh ih->ih_pil = (1<<ipl);
916 1.1 eeh if ((flags & BUS_INTR_ESTABLISH_FASTTRAP) != 0)
917 1.1 eeh intr_fasttrap(ipl, (void (*)__P((void)))handler);
918 1.1 eeh else
919 1.1 eeh intr_establish(ipl, ih);
920 1.1 eeh return (ih);
921 1.1 eeh }
922 1.1 eeh
923 1.1 eeh static bus_space_tag_t
924 1.1 eeh sbus_alloc_bustag(sc)
925 1.1 eeh struct sbus_softc *sc;
926 1.1 eeh {
927 1.1 eeh bus_space_tag_t sbt;
928 1.1 eeh
929 1.1 eeh sbt = (bus_space_tag_t)
930 1.1 eeh malloc(sizeof(struct sparc_bus_space_tag), M_DEVBUF, M_NOWAIT);
931 1.1 eeh if (sbt == NULL)
932 1.1 eeh return (NULL);
933 1.1 eeh
934 1.1 eeh bzero(sbt, sizeof *sbt);
935 1.1 eeh sbt->cookie = sc;
936 1.1 eeh sbt->parent = sc->sc_bustag;
937 1.12 eeh sbt->type = SBUS_BUS_SPACE;
938 1.1 eeh sbt->sparc_bus_map = _sbus_bus_map;
939 1.1 eeh sbt->sparc_bus_mmap = sbus_bus_mmap;
940 1.1 eeh sbt->sparc_intr_establish = sbus_intr_establish;
941 1.1 eeh return (sbt);
942 1.1 eeh }
943 1.1 eeh
944 1.1 eeh
945 1.1 eeh static bus_dma_tag_t
946 1.1 eeh sbus_alloc_dmatag(sc)
947 1.1 eeh struct sbus_softc *sc;
948 1.1 eeh {
949 1.1 eeh bus_dma_tag_t sdt, psdt = sc->sc_dmatag;
950 1.1 eeh
951 1.1 eeh sdt = (bus_dma_tag_t)
952 1.1 eeh malloc(sizeof(struct sparc_bus_dma_tag), M_DEVBUF, M_NOWAIT);
953 1.1 eeh if (sdt == NULL)
954 1.1 eeh /* Panic? */
955 1.1 eeh return (psdt);
956 1.1 eeh
957 1.1 eeh sdt->_cookie = sc;
958 1.1 eeh sdt->_parent = psdt;
959 1.1 eeh #define PCOPY(x) sdt->x = psdt->x
960 1.1 eeh PCOPY(_dmamap_create);
961 1.1 eeh PCOPY(_dmamap_destroy);
962 1.1 eeh sdt->_dmamap_load = sbus_dmamap_load;
963 1.1 eeh PCOPY(_dmamap_load_mbuf);
964 1.1 eeh PCOPY(_dmamap_load_uio);
965 1.1 eeh PCOPY(_dmamap_load_raw);
966 1.1 eeh sdt->_dmamap_unload = sbus_dmamap_unload;
967 1.1 eeh sdt->_dmamap_sync = sbus_dmamap_sync;
968 1.1 eeh sdt->_dmamem_alloc = sbus_dmamem_alloc;
969 1.1 eeh sdt->_dmamem_free = sbus_dmamem_free;
970 1.2 eeh sdt->_dmamem_map = sbus_dmamem_map;
971 1.2 eeh sdt->_dmamem_unmap = sbus_dmamem_unmap;
972 1.1 eeh PCOPY(_dmamem_mmap);
973 1.1 eeh #undef PCOPY
974 1.1 eeh sc->sc_dmatag = sdt;
975 1.1 eeh return (sdt);
976 1.1 eeh }
977 1.1 eeh
978 1.1 eeh int
979 1.1 eeh sbus_dmamap_load(t, map, buf, buflen, p, flags)
980 1.1 eeh bus_dma_tag_t t;
981 1.1 eeh bus_dmamap_t map;
982 1.1 eeh void *buf;
983 1.1 eeh bus_size_t buflen;
984 1.1 eeh struct proc *p;
985 1.1 eeh int flags;
986 1.1 eeh {
987 1.12 eeh int err, s;
988 1.1 eeh bus_size_t sgsize;
989 1.3 eeh paddr_t curaddr;
990 1.12 eeh u_long dvmaddr;
991 1.12 eeh vaddr_t vaddr = (vaddr_t)buf;
992 1.1 eeh pmap_t pmap;
993 1.1 eeh struct sbus_softc *sc = (struct sbus_softc *)t->_cookie;
994 1.1 eeh
995 1.2 eeh if (map->dm_nsegs) {
996 1.2 eeh /* Already in use?? */
997 1.2 eeh #ifdef DIAGNOSTIC
998 1.2 eeh printf("sbus_dmamap_load: map still in use\n");
999 1.2 eeh #endif
1000 1.2 eeh bus_dmamap_unload(t, map);
1001 1.2 eeh }
1002 1.12 eeh #if 1
1003 1.12 eeh /*
1004 1.12 eeh * Make sure that on error condition we return "no valid mappings".
1005 1.12 eeh */
1006 1.12 eeh map->dm_nsegs = 0;
1007 1.12 eeh
1008 1.12 eeh if (buflen > map->_dm_size)
1009 1.12 eeh #ifdef DEBUG
1010 1.12 eeh {
1011 1.16 eeh printf("sbus_dmamap_load(): error %d > %d -- map size exceeded!\n", buflen, map->_dm_size);
1012 1.12 eeh Debugger();
1013 1.12 eeh return (EINVAL);
1014 1.12 eeh }
1015 1.12 eeh #else
1016 1.12 eeh return (EINVAL);
1017 1.12 eeh #endif
1018 1.12 eeh sgsize = round_page(buflen + ((int)vaddr & PGOFSET));
1019 1.12 eeh
1020 1.12 eeh /*
1021 1.12 eeh * XXX Need to implement "don't dma across this boundry".
1022 1.12 eeh */
1023 1.12 eeh
1024 1.12 eeh s = splhigh();
1025 1.12 eeh err = extent_alloc(sc->sc_dvmamap, sgsize, NBPG,
1026 1.12 eeh map->_dm_boundary, EX_NOWAIT, (u_long *)&dvmaddr);
1027 1.12 eeh splx(s);
1028 1.12 eeh
1029 1.12 eeh if (err != 0)
1030 1.12 eeh return (err);
1031 1.12 eeh
1032 1.12 eeh #ifdef DEBUG
1033 1.12 eeh if (dvmaddr == (bus_addr_t)-1)
1034 1.12 eeh {
1035 1.16 eeh printf("sbus_dmamap_load(): dvmamap_alloc(%d, %x) failed!\n", sgsize, flags);
1036 1.12 eeh Debugger();
1037 1.12 eeh }
1038 1.12 eeh #endif
1039 1.12 eeh if (dvmaddr == (bus_addr_t)-1)
1040 1.12 eeh return (ENOMEM);
1041 1.12 eeh
1042 1.12 eeh /*
1043 1.12 eeh * We always use just one segment.
1044 1.12 eeh */
1045 1.12 eeh map->dm_mapsize = buflen;
1046 1.12 eeh map->dm_nsegs = 1;
1047 1.12 eeh map->dm_segs[0].ds_addr = dvmaddr + (vaddr & PGOFSET);
1048 1.12 eeh map->dm_segs[0].ds_len = sgsize;
1049 1.12 eeh
1050 1.12 eeh #else
1051 1.1 eeh if ((err = bus_dmamap_load(t->_parent, map, buf, buflen, p, flags)))
1052 1.1 eeh return (err);
1053 1.12 eeh #endif
1054 1.1 eeh if (p != NULL)
1055 1.1 eeh pmap = p->p_vmspace->vm_map.pmap;
1056 1.1 eeh else
1057 1.1 eeh pmap = pmap_kernel();
1058 1.1 eeh
1059 1.2 eeh dvmaddr = trunc_page(map->dm_segs[0].ds_addr);
1060 1.1 eeh sgsize = round_page(buflen + ((int)vaddr & PGOFSET));
1061 1.1 eeh for (; buflen > 0; ) {
1062 1.1 eeh /*
1063 1.1 eeh * Get the physical address for this page.
1064 1.1 eeh */
1065 1.3 eeh if ((curaddr = (bus_addr_t)pmap_extract(pmap, (vaddr_t)vaddr)) == NULL) {
1066 1.1 eeh bus_dmamap_unload(t, map);
1067 1.1 eeh return (-1);
1068 1.1 eeh }
1069 1.1 eeh
1070 1.1 eeh /*
1071 1.1 eeh * Compute the segment size, and adjust counts.
1072 1.1 eeh */
1073 1.1 eeh sgsize = NBPG - ((u_long)vaddr & PGOFSET);
1074 1.1 eeh if (buflen < sgsize)
1075 1.1 eeh sgsize = buflen;
1076 1.1 eeh
1077 1.2 eeh #ifdef DEBUG
1078 1.2 eeh if (sbusdebug & SDB_DVMA)
1079 1.8 eeh printf("sbus_dmamap_load: map %p loading va %lx at pa %lx\n",
1080 1.8 eeh map, (long)dvmaddr, (long)(curaddr & ~(NBPG-1)));
1081 1.2 eeh #endif
1082 1.2 eeh sbus_enter(sc, trunc_page(dvmaddr), trunc_page(curaddr), flags);
1083 1.1 eeh
1084 1.1 eeh dvmaddr += PAGE_SIZE;
1085 1.1 eeh vaddr += sgsize;
1086 1.1 eeh buflen -= sgsize;
1087 1.1 eeh }
1088 1.1 eeh return (0);
1089 1.1 eeh }
1090 1.1 eeh
1091 1.1 eeh void
1092 1.1 eeh sbus_dmamap_unload(t, map)
1093 1.1 eeh bus_dma_tag_t t;
1094 1.1 eeh bus_dmamap_t map;
1095 1.1 eeh {
1096 1.3 eeh vaddr_t addr;
1097 1.12 eeh int len, error, s;
1098 1.12 eeh bus_addr_t dvmaddr;
1099 1.12 eeh bus_size_t sgsize;
1100 1.1 eeh struct sbus_softc *sc = (struct sbus_softc *)t->_cookie;
1101 1.1 eeh
1102 1.1 eeh if (map->dm_nsegs != 1)
1103 1.16 eeh panic("sbus_dmamap_unload: nsegs = %d", map->dm_nsegs);
1104 1.1 eeh
1105 1.2 eeh addr = trunc_page(map->dm_segs[0].ds_addr);
1106 1.1 eeh len = map->dm_segs[0].ds_len;
1107 1.1 eeh
1108 1.2 eeh #ifdef DEBUG
1109 1.2 eeh if (sbusdebug & SDB_DVMA)
1110 1.8 eeh printf("sbus_dmamap_unload: map %p removing va %lx size %lx\n",
1111 1.8 eeh map, (long)addr, (long)len);
1112 1.2 eeh #endif
1113 1.1 eeh sbus_remove(sc, addr, len);
1114 1.12 eeh #if 1
1115 1.12 eeh dvmaddr = (map->dm_segs[0].ds_addr & ~PGOFSET);
1116 1.12 eeh sgsize = map->dm_segs[0].ds_len;
1117 1.12 eeh
1118 1.12 eeh /* Mark the mappings as invalid. */
1119 1.12 eeh map->dm_mapsize = 0;
1120 1.12 eeh map->dm_nsegs = 0;
1121 1.12 eeh
1122 1.12 eeh /* Unmapping is bus dependent */
1123 1.12 eeh s = splhigh();
1124 1.12 eeh error = extent_free(sc->sc_dvmamap, dvmaddr, sgsize, EX_NOWAIT);
1125 1.12 eeh splx(s);
1126 1.12 eeh if (error != 0)
1127 1.12 eeh printf("warning: %ld of DVMA space lost\n", (long)sgsize);
1128 1.12 eeh
1129 1.12 eeh cache_flush((caddr_t)dvmaddr, (u_int) sgsize);
1130 1.12 eeh #else
1131 1.1 eeh bus_dmamap_unload(t->_parent, map);
1132 1.12 eeh #endif
1133 1.1 eeh }
1134 1.1 eeh
1135 1.1 eeh
1136 1.1 eeh void
1137 1.1 eeh sbus_dmamap_sync(t, map, offset, len, ops)
1138 1.1 eeh bus_dma_tag_t t;
1139 1.1 eeh bus_dmamap_t map;
1140 1.1 eeh bus_addr_t offset;
1141 1.1 eeh bus_size_t len;
1142 1.1 eeh int ops;
1143 1.1 eeh {
1144 1.1 eeh struct sbus_softc *sc = (struct sbus_softc *)t->_cookie;
1145 1.3 eeh vaddr_t va = map->dm_segs[0].ds_addr + offset;
1146 1.1 eeh
1147 1.1 eeh /*
1148 1.1 eeh * We only support one DMA segment; supporting more makes this code
1149 1.1 eeh * too unweildy.
1150 1.1 eeh */
1151 1.1 eeh
1152 1.8 eeh if (ops&BUS_DMASYNC_PREREAD) {
1153 1.8 eeh #ifdef DEBUG
1154 1.8 eeh if (sbusdebug & SDB_DVMA)
1155 1.8 eeh printf("sbus_dmamap_sync: syncing va %p len %lu BUS_DMASYNC_PREREAD\n",
1156 1.8 eeh (long)va, (u_long)len);
1157 1.8 eeh #endif
1158 1.8 eeh
1159 1.1 eeh /* Nothing to do */;
1160 1.8 eeh }
1161 1.1 eeh if (ops&BUS_DMASYNC_POSTREAD) {
1162 1.1 eeh /*
1163 1.1 eeh * We should sync the IOMMU streaming caches here first.
1164 1.1 eeh */
1165 1.8 eeh #ifdef DEBUG
1166 1.8 eeh if (sbusdebug & SDB_DVMA)
1167 1.8 eeh printf("sbus_dmamap_sync: syncing va %p len %lu BUS_DMASYNC_POSTREAD\n",
1168 1.8 eeh (long)va, (u_long)len);
1169 1.8 eeh #endif
1170 1.1 eeh while (len > 0) {
1171 1.1 eeh
1172 1.1 eeh /*
1173 1.1 eeh * Streaming buffer flushes:
1174 1.1 eeh *
1175 1.1 eeh * 1 Tell strbuf to flush by storing va to strbuf_pgflush
1176 1.1 eeh * If we're not on a cache line boundary (64-bits):
1177 1.1 eeh * 2 Store 0 in flag
1178 1.1 eeh * 3 Store pointer to flag in flushsync
1179 1.1 eeh * 4 wait till flushsync becomes 0x1
1180 1.1 eeh *
1181 1.1 eeh * If it takes more than .5 sec, something went wrong.
1182 1.1 eeh */
1183 1.8 eeh #ifdef DEBUG
1184 1.8 eeh if (sbusdebug & SDB_DVMA)
1185 1.8 eeh printf("sbus_dmamap_sync: flushing va %p, %lu bytes left\n",
1186 1.8 eeh (long)va, (u_long)len);
1187 1.8 eeh #endif
1188 1.8 eeh bus_space_write_8(sc->sc_bustag, &sc->sc_sysio->sys_strbuf.strbuf_pgflush, 0, va);
1189 1.1 eeh if (len <= NBPG) {
1190 1.1 eeh sbus_flush(sc);
1191 1.8 eeh len = 0;
1192 1.8 eeh } else
1193 1.8 eeh len -= NBPG;
1194 1.1 eeh va += NBPG;
1195 1.1 eeh }
1196 1.1 eeh }
1197 1.8 eeh if (ops&BUS_DMASYNC_PREWRITE) {
1198 1.8 eeh #ifdef DEBUG
1199 1.8 eeh if (sbusdebug & SDB_DVMA)
1200 1.8 eeh printf("sbus_dmamap_sync: syncing va %p len %lu BUS_DMASYNC_PREWRITE\n",
1201 1.8 eeh (long)va, (u_long)len);
1202 1.8 eeh #endif
1203 1.1 eeh /* Nothing to do */;
1204 1.8 eeh }
1205 1.8 eeh if (ops&BUS_DMASYNC_POSTWRITE) {
1206 1.8 eeh #ifdef DEBUG
1207 1.8 eeh if (sbusdebug & SDB_DVMA)
1208 1.8 eeh printf("sbus_dmamap_sync: syncing va %p len %lu BUS_DMASYNC_POSTWRITE\n",
1209 1.8 eeh (long)va, (u_long)len);
1210 1.8 eeh #endif
1211 1.8 eeh /* Nothing to do */;
1212 1.8 eeh }
1213 1.1 eeh bus_dmamap_sync(t->_parent, map, offset, len, ops);
1214 1.1 eeh }
1215 1.1 eeh
1216 1.8 eeh
1217 1.8 eeh /*
1218 1.8 eeh * Take memory allocated by our parent bus and generate DVMA mappings for it.
1219 1.8 eeh */
1220 1.1 eeh int
1221 1.1 eeh sbus_dmamem_alloc(t, size, alignment, boundary, segs, nsegs, rsegs, flags)
1222 1.1 eeh bus_dma_tag_t t;
1223 1.1 eeh bus_size_t size, alignment, boundary;
1224 1.1 eeh bus_dma_segment_t *segs;
1225 1.1 eeh int nsegs;
1226 1.1 eeh int *rsegs;
1227 1.1 eeh int flags;
1228 1.1 eeh {
1229 1.3 eeh paddr_t curaddr;
1230 1.12 eeh u_long dvmaddr;
1231 1.1 eeh vm_page_t m;
1232 1.1 eeh struct pglist *mlist;
1233 1.1 eeh int error;
1234 1.12 eeh int n, s;
1235 1.1 eeh struct sbus_softc *sc = (struct sbus_softc *)t->_cookie;
1236 1.1 eeh
1237 1.1 eeh if ((error = bus_dmamem_alloc(t->_parent, size, alignment,
1238 1.1 eeh boundary, segs, nsegs, rsegs, flags)))
1239 1.1 eeh return (error);
1240 1.1 eeh
1241 1.8 eeh /*
1242 1.8 eeh * Allocate a DVMA mapping for our new memory.
1243 1.8 eeh */
1244 1.1 eeh for (n=0; n<*rsegs; n++) {
1245 1.12 eeh #if 1
1246 1.12 eeh s = splhigh();
1247 1.12 eeh if (extent_alloc(sc->sc_dvmamap, segs[0].ds_len, alignment,
1248 1.12 eeh boundary, EX_NOWAIT, (u_long *)&dvmaddr)) {
1249 1.12 eeh splx(s);
1250 1.12 eeh /* Free what we got and exit */
1251 1.12 eeh bus_dmamem_free(t->_parent, segs, nsegs);
1252 1.12 eeh return (ENOMEM);
1253 1.12 eeh }
1254 1.12 eeh splx(s);
1255 1.12 eeh #else
1256 1.8 eeh dvmaddr = dvmamap_alloc(segs[0].ds_len, flags);
1257 1.8 eeh if (dvmaddr == (bus_addr_t)-1) {
1258 1.8 eeh /* Free what we got and exit */
1259 1.8 eeh bus_dmamem_free(t->_parent, segs, nsegs);
1260 1.8 eeh return (ENOMEM);
1261 1.8 eeh }
1262 1.12 eeh #endif
1263 1.8 eeh segs[n].ds_addr = dvmaddr;
1264 1.1 eeh size = segs[n].ds_len;
1265 1.1 eeh mlist = segs[n]._ds_mlist;
1266 1.1 eeh
1267 1.1 eeh /* Map memory into DVMA space */
1268 1.1 eeh for (m = mlist->tqh_first; m != NULL; m = m->pageq.tqe_next) {
1269 1.1 eeh curaddr = VM_PAGE_TO_PHYS(m);
1270 1.12 eeh #ifdef DEBUG
1271 1.12 eeh if (sbusdebug & SDB_DVMA)
1272 1.12 eeh printf("sbus_dmamem_alloc: map %p loading va %lx at pa %lx\n",
1273 1.12 eeh (long)m, (long)dvmaddr, (long)(curaddr & ~(NBPG-1)));
1274 1.12 eeh #endif
1275 1.2 eeh sbus_enter(sc, dvmaddr, curaddr, flags);
1276 1.1 eeh dvmaddr += PAGE_SIZE;
1277 1.1 eeh }
1278 1.1 eeh }
1279 1.1 eeh return (0);
1280 1.1 eeh }
1281 1.1 eeh
1282 1.1 eeh void
1283 1.1 eeh sbus_dmamem_free(t, segs, nsegs)
1284 1.1 eeh bus_dma_tag_t t;
1285 1.1 eeh bus_dma_segment_t *segs;
1286 1.1 eeh int nsegs;
1287 1.1 eeh {
1288 1.3 eeh vaddr_t addr;
1289 1.2 eeh int len;
1290 1.12 eeh int n, s, error;
1291 1.1 eeh struct sbus_softc *sc = (struct sbus_softc *)t->_cookie;
1292 1.1 eeh
1293 1.1 eeh
1294 1.1 eeh for (n=0; n<nsegs; n++) {
1295 1.1 eeh addr = segs[n].ds_addr;
1296 1.1 eeh len = segs[n].ds_len;
1297 1.1 eeh sbus_remove(sc, addr, len);
1298 1.12 eeh #if 1
1299 1.12 eeh s = splhigh();
1300 1.12 eeh error = extent_free(sc->sc_dvmamap, addr, len, EX_NOWAIT);
1301 1.12 eeh splx(s);
1302 1.12 eeh if (error != 0)
1303 1.12 eeh printf("warning: %ld of DVMA space lost\n", (long)len);
1304 1.12 eeh #else
1305 1.8 eeh dvmamap_free(addr, len);
1306 1.12 eeh #endif
1307 1.1 eeh }
1308 1.1 eeh bus_dmamem_free(t->_parent, segs, nsegs);
1309 1.1 eeh }
1310 1.1 eeh
1311 1.2 eeh /*
1312 1.8 eeh * Map the DVMA mappings into the kernel pmap.
1313 1.2 eeh * Check the flags to see whether we're streaming or coherent.
1314 1.2 eeh */
1315 1.2 eeh int
1316 1.2 eeh sbus_dmamem_map(t, segs, nsegs, size, kvap, flags)
1317 1.2 eeh bus_dma_tag_t t;
1318 1.2 eeh bus_dma_segment_t *segs;
1319 1.2 eeh int nsegs;
1320 1.2 eeh size_t size;
1321 1.2 eeh caddr_t *kvap;
1322 1.2 eeh int flags;
1323 1.2 eeh {
1324 1.2 eeh vm_page_t m;
1325 1.3 eeh vaddr_t va;
1326 1.2 eeh bus_addr_t addr;
1327 1.2 eeh struct pglist *mlist;
1328 1.2 eeh struct sbus_softc *sc = (struct sbus_softc *)t->_cookie;
1329 1.3 eeh int cbit;
1330 1.2 eeh
1331 1.2 eeh /*
1332 1.2 eeh * digest flags:
1333 1.2 eeh */
1334 1.2 eeh cbit = 0;
1335 1.2 eeh if (flags & BUS_DMA_COHERENT) /* Disable vcache */
1336 1.2 eeh cbit |= PMAP_NVC;
1337 1.3 eeh if (flags & BUS_DMA_NOCACHE) /* sideffects */
1338 1.2 eeh cbit |= PMAP_NC;
1339 1.2 eeh /*
1340 1.8 eeh * Now take this and map it into the CPU since it should already
1341 1.8 eeh * be in the the IOMMU.
1342 1.2 eeh */
1343 1.8 eeh *kvap = (caddr_t)va = segs[0].ds_addr;
1344 1.2 eeh mlist = segs[0]._ds_mlist;
1345 1.2 eeh for (m = mlist->tqh_first; m != NULL; m = m->pageq.tqe_next) {
1346 1.2 eeh
1347 1.2 eeh if (size == 0)
1348 1.2 eeh panic("_bus_dmamem_map: size botch");
1349 1.2 eeh
1350 1.2 eeh addr = VM_PAGE_TO_PHYS(m);
1351 1.2 eeh pmap_enter(pmap_kernel(), va, addr | cbit,
1352 1.14 thorpej VM_PROT_READ | VM_PROT_WRITE, TRUE,
1353 1.14 thorpej VM_PROT_READ | VM_PROT_WRITE);
1354 1.2 eeh va += PAGE_SIZE;
1355 1.2 eeh size -= PAGE_SIZE;
1356 1.2 eeh }
1357 1.2 eeh
1358 1.2 eeh return (0);
1359 1.2 eeh }
1360 1.2 eeh
1361 1.2 eeh /*
1362 1.8 eeh * Unmap DVMA mappings from kernel
1363 1.2 eeh */
1364 1.2 eeh void
1365 1.2 eeh sbus_dmamem_unmap(t, kva, size)
1366 1.2 eeh bus_dma_tag_t t;
1367 1.2 eeh caddr_t kva;
1368 1.2 eeh size_t size;
1369 1.2 eeh {
1370 1.2 eeh struct sbus_softc *sc = (struct sbus_softc *)t->_cookie;
1371 1.2 eeh
1372 1.2 eeh #ifdef DIAGNOSTIC
1373 1.2 eeh if ((u_long)kva & PGOFSET)
1374 1.2 eeh panic("_bus_dmamem_unmap");
1375 1.2 eeh #endif
1376 1.2 eeh
1377 1.2 eeh size = round_page(size);
1378 1.8 eeh pmap_remove(pmap_kernel(), (vaddr_t)kva, size);
1379 1.2 eeh }
1380