schizo.c revision 1.33 1 1.33 msaitoh /* $NetBSD: schizo.c,v 1.33 2015/10/02 05:22:52 msaitoh Exp $ */
2 1.1 mrg /* $OpenBSD: schizo.c,v 1.55 2008/08/18 20:29:37 brad Exp $ */
3 1.1 mrg
4 1.1 mrg /*
5 1.1 mrg * Copyright (c) 2002 Jason L. Wright (jason (at) thought.net)
6 1.1 mrg * Copyright (c) 2003 Henric Jungheim
7 1.29 mrg * Copyright (c) 2008, 2009, 2010, 2012 Matthew R. Green
8 1.1 mrg * All rights reserved.
9 1.1 mrg *
10 1.1 mrg * Redistribution and use in source and binary forms, with or without
11 1.1 mrg * modification, are permitted provided that the following conditions
12 1.1 mrg * are met:
13 1.1 mrg * 1. Redistributions of source code must retain the above copyright
14 1.1 mrg * notice, this list of conditions and the following disclaimer.
15 1.1 mrg * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 mrg * notice, this list of conditions and the following disclaimer in the
17 1.1 mrg * documentation and/or other materials provided with the distribution.
18 1.1 mrg *
19 1.1 mrg * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
20 1.1 mrg * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
21 1.1 mrg * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
22 1.1 mrg * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
23 1.1 mrg * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
24 1.1 mrg * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
25 1.1 mrg * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
26 1.1 mrg * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
27 1.1 mrg * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
28 1.1 mrg * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.1 mrg * POSSIBILITY OF SUCH DAMAGE.
30 1.1 mrg */
31 1.1 mrg
32 1.28 mrg #include <sys/cdefs.h>
33 1.33 msaitoh __KERNEL_RCSID(0, "$NetBSD: schizo.c,v 1.33 2015/10/02 05:22:52 msaitoh Exp $");
34 1.28 mrg
35 1.1 mrg #include <sys/param.h>
36 1.1 mrg #include <sys/device.h>
37 1.1 mrg #include <sys/errno.h>
38 1.1 mrg #include <sys/extent.h>
39 1.24 macallan #include <sys/kmem.h>
40 1.1 mrg #include <sys/malloc.h>
41 1.1 mrg #include <sys/systm.h>
42 1.1 mrg #include <sys/time.h>
43 1.1 mrg #include <sys/reboot.h>
44 1.1 mrg
45 1.1 mrg #define _SPARC_BUS_DMA_PRIVATE
46 1.23 dyoung #include <sys/bus.h>
47 1.1 mrg #include <machine/autoconf.h>
48 1.1 mrg #include <machine/psl.h>
49 1.1 mrg
50 1.1 mrg #include <dev/pci/pcivar.h>
51 1.1 mrg #include <dev/pci/pcireg.h>
52 1.1 mrg
53 1.1 mrg #include <sparc64/dev/iommureg.h>
54 1.1 mrg #include <sparc64/dev/iommuvar.h>
55 1.1 mrg #include <sparc64/dev/schizoreg.h>
56 1.1 mrg #include <sparc64/dev/schizovar.h>
57 1.1 mrg #include <sparc64/sparc64/cache.h>
58 1.1 mrg
59 1.1 mrg #ifdef DEBUG
60 1.1 mrg #define SDB_PROM 0x01
61 1.1 mrg #define SDB_BUSMAP 0x02
62 1.1 mrg #define SDB_INTR 0x04
63 1.2 mrg #define SDB_INTMAP 0x08
64 1.2 mrg #define SDB_CONF 0x10
65 1.7 mrg int schizo_debug = 0x0;
66 1.1 mrg #define DPRINTF(l, s) do { if (schizo_debug & l) printf s; } while (0)
67 1.1 mrg #else
68 1.1 mrg #define DPRINTF(l, s)
69 1.1 mrg #endif
70 1.1 mrg
71 1.1 mrg extern struct sparc_pci_chipset _sparc_pci_chipset;
72 1.1 mrg
73 1.21 christos static int schizo_match(device_t, cfdata_t, void *);
74 1.21 christos static void schizo_attach(device_t, device_t, void *);
75 1.2 mrg static int schizo_print(void *aux, const char *p);
76 1.2 mrg
77 1.22 christos CFATTACH_DECL_NEW(schizo, sizeof(struct schizo_softc),
78 1.2 mrg schizo_match, schizo_attach, NULL, NULL);
79 1.2 mrg
80 1.1 mrg void schizo_init_iommu(struct schizo_softc *, struct schizo_pbm *);
81 1.1 mrg
82 1.1 mrg void schizo_set_intr(struct schizo_softc *, struct schizo_pbm *, int,
83 1.2 mrg int (*handler)(void *), void *, int, const char *);
84 1.1 mrg int schizo_ue(void *);
85 1.1 mrg int schizo_ce(void *);
86 1.1 mrg int schizo_safari_error(void *);
87 1.1 mrg int schizo_pci_error(void *);
88 1.1 mrg
89 1.1 mrg pci_chipset_tag_t schizo_alloc_chipset(struct schizo_pbm *, int,
90 1.1 mrg pci_chipset_tag_t);
91 1.1 mrg bus_space_tag_t schizo_alloc_mem_tag(struct schizo_pbm *);
92 1.1 mrg bus_space_tag_t schizo_alloc_io_tag(struct schizo_pbm *);
93 1.1 mrg bus_space_tag_t schizo_alloc_config_tag(struct schizo_pbm *);
94 1.1 mrg bus_space_tag_t schizo_alloc_bus_tag(struct schizo_pbm *, const char *,
95 1.2 mrg int);
96 1.1 mrg bus_dma_tag_t schizo_alloc_dma_tag(struct schizo_pbm *);
97 1.1 mrg
98 1.1 mrg pcireg_t schizo_conf_read(pci_chipset_tag_t, pcitag_t, int);
99 1.1 mrg void schizo_conf_write(pci_chipset_tag_t, pcitag_t, int, pcireg_t);
100 1.1 mrg
101 1.2 mrg int schizo_bus_map(bus_space_tag_t t, bus_addr_t offset, bus_size_t size,
102 1.2 mrg int flags, vaddr_t unused, bus_space_handle_t *hp);
103 1.2 mrg static paddr_t schizo_bus_mmap(bus_space_tag_t t, bus_addr_t paddr,
104 1.2 mrg off_t off, int prot, int flags);
105 1.2 mrg static void *schizo_intr_establish(bus_space_tag_t, int, int, int (*)(void *),
106 1.2 mrg void *, void(*)(void));
107 1.19 dyoung static int schizo_pci_intr_map(const struct pci_attach_args *,
108 1.19 dyoung pci_intr_handle_t *);
109 1.2 mrg static void *schizo_pci_intr_establish(pci_chipset_tag_t, pci_intr_handle_t,
110 1.2 mrg int, int (*)(void *), void *);
111 1.4 mrg static int schizo_dmamap_create(bus_dma_tag_t, bus_size_t, int, bus_size_t,
112 1.4 mrg bus_size_t, int, bus_dmamap_t *);
113 1.1 mrg
114 1.1 mrg int
115 1.30 chs schizo_match(device_t parent, cfdata_t match, void *aux)
116 1.1 mrg {
117 1.1 mrg struct mainbus_attach_args *ma = aux;
118 1.1 mrg char *str;
119 1.1 mrg
120 1.1 mrg if (strcmp(ma->ma_name, "pci") != 0)
121 1.1 mrg return (0);
122 1.1 mrg
123 1.2 mrg str = prom_getpropstring(ma->ma_node, "model");
124 1.1 mrg if (strcmp(str, "schizo") == 0)
125 1.1 mrg return (1);
126 1.1 mrg
127 1.2 mrg str = prom_getpropstring(ma->ma_node, "compatible");
128 1.1 mrg if (strcmp(str, "pci108e,8001") == 0)
129 1.1 mrg return (1);
130 1.1 mrg if (strcmp(str, "pci108e,8002") == 0) /* XMITS */
131 1.1 mrg return (1);
132 1.1 mrg if (strcmp(str, "pci108e,a801") == 0) /* Tomatillo */
133 1.1 mrg return (1);
134 1.1 mrg
135 1.1 mrg return (0);
136 1.1 mrg }
137 1.1 mrg
138 1.1 mrg void
139 1.30 chs schizo_attach(device_t parent, device_t self, void *aux)
140 1.1 mrg {
141 1.21 christos struct schizo_softc *sc = device_private(self);
142 1.1 mrg struct mainbus_attach_args *ma = aux;
143 1.13 mrg struct schizo_pbm *pbm;
144 1.15 mrg struct iommu_state *is;
145 1.13 mrg struct pcibus_attach_args pba;
146 1.13 mrg uint64_t reg, eccctrl;
147 1.13 mrg int *busranges = NULL, nranges;
148 1.1 mrg char *str;
149 1.17 mrg bool no_sc;
150 1.1 mrg
151 1.16 mrg aprint_normal(": addr %" PRIx64, ma->ma_reg[0].ur_paddr);
152 1.2 mrg str = prom_getpropstring(ma->ma_node, "compatible");
153 1.1 mrg if (strcmp(str, "pci108e,a801") == 0)
154 1.1 mrg sc->sc_tomatillo = 1;
155 1.29 mrg
156 1.29 mrg sc->sc_ver = prom_getpropint(sc->sc_node, "version#", 0);
157 1.29 mrg
158 1.21 christos sc->sc_dev = self;
159 1.1 mrg sc->sc_node = ma->ma_node;
160 1.1 mrg sc->sc_dmat = ma->ma_dmatag;
161 1.2 mrg sc->sc_bustag = ma->ma_bustag;
162 1.1 mrg
163 1.13 mrg if (bus_space_map(sc->sc_bustag, ma->ma_reg[1].ur_paddr - 0x10000UL,
164 1.2 mrg sizeof(struct schizo_regs), 0,
165 1.2 mrg &sc->sc_ctrlh)) {
166 1.16 mrg aprint_error(": failed to map registers\n");
167 1.1 mrg return;
168 1.1 mrg }
169 1.1 mrg
170 1.10 mrg sc->sc_ign = INTIGN(ma->ma_upaid << INTMAP_IGN_SHIFT);
171 1.6 mrg
172 1.1 mrg /* enable schizo ecc error interrupts */
173 1.2 mrg eccctrl = schizo_read(sc, SCZ_ECCCTRL);
174 1.2 mrg eccctrl |= SCZ_ECCCTRL_EE_INTEN |
175 1.2 mrg SCZ_ECCCTRL_UE_INTEN |
176 1.2 mrg SCZ_ECCCTRL_CE_INTEN;
177 1.2 mrg schizo_write(sc, SCZ_ECCCTRL, eccctrl);
178 1.1 mrg
179 1.24 macallan pbm = kmem_zalloc(sizeof(*pbm), KM_NOSLEEP);
180 1.1 mrg if (pbm == NULL)
181 1.1 mrg panic("schizo: can't alloc schizo pbm");
182 1.1 mrg
183 1.1 mrg pbm->sp_sc = sc;
184 1.2 mrg pbm->sp_regt = sc->sc_bustag;
185 1.1 mrg
186 1.13 mrg if ((ma->ma_reg[0].ur_paddr & 0x00700000) == 0x00600000)
187 1.5 mrg pbm->sp_bus_a = 1;
188 1.5 mrg else
189 1.5 mrg pbm->sp_bus_a = 0;
190 1.5 mrg
191 1.13 mrg /*
192 1.13 mrg * Map interrupt registers
193 1.13 mrg */
194 1.13 mrg if (bus_space_map(sc->sc_bustag, ma->ma_reg[0].ur_paddr,
195 1.13 mrg ma->ma_reg[0].ur_len,
196 1.13 mrg BUS_SPACE_MAP_LINEAR, &pbm->sp_intrh)) {
197 1.16 mrg aprint_error(": failed to interrupt map registers\n");
198 1.32 christos kmem_free(pbm, sizeof(*pbm));
199 1.13 mrg return;
200 1.13 mrg }
201 1.13 mrg
202 1.2 mrg if (prom_getprop(sc->sc_node, "ranges", sizeof(struct schizo_range),
203 1.1 mrg &pbm->sp_nrange, (void **)&pbm->sp_range))
204 1.1 mrg panic("schizo: can't get ranges");
205 1.1 mrg
206 1.2 mrg if (prom_getprop(sc->sc_node, "bus-range", sizeof(int), &nranges,
207 1.1 mrg (void **)&busranges))
208 1.1 mrg panic("schizo: can't get bus-range");
209 1.1 mrg
210 1.16 mrg aprint_normal(": \"%s\", version %d, ign %x, bus %c %d to %d\n",
211 1.29 mrg sc->sc_tomatillo ? "Tomatillo" : "Schizo", sc->sc_ver,
212 1.29 mrg sc->sc_ign, pbm->sp_bus_a ? 'A' : 'B', busranges[0], busranges[1]);
213 1.16 mrg aprint_naive("\n");
214 1.1 mrg
215 1.1 mrg if (bus_space_subregion(pbm->sp_regt, sc->sc_ctrlh,
216 1.2 mrg pbm->sp_bus_a ? offsetof(struct schizo_regs, pbm_a) :
217 1.1 mrg offsetof(struct schizo_regs, pbm_b),
218 1.1 mrg sizeof(struct schizo_pbm_regs),
219 1.1 mrg &pbm->sp_regh)) {
220 1.1 mrg panic("schizo: unable to create PBM handle");
221 1.1 mrg }
222 1.1 mrg
223 1.15 mrg is = &pbm->sp_is;
224 1.15 mrg pbm->sp_sb.sb_is = is;
225 1.17 mrg no_sc = prom_getproplen(sc->sc_node, "no-streaming-cache") >= 0;
226 1.17 mrg if (no_sc)
227 1.21 christos aprint_debug_dev(sc->sc_dev, "no streaming buffers\n");
228 1.17 mrg else {
229 1.15 mrg vaddr_t va = (vaddr_t)&pbm->sp_flush[0x40];
230 1.15 mrg
231 1.15 mrg /*
232 1.15 mrg * Initialize the strbuf_ctl.
233 1.15 mrg *
234 1.15 mrg * The flush sync buffer must be 64-byte aligned.
235 1.15 mrg */
236 1.15 mrg is->is_sb[0] = &pbm->sp_sb;
237 1.15 mrg is->is_sb[0]->sb_flush = (void *)(va & ~0x3f);
238 1.15 mrg
239 1.15 mrg bus_space_subregion(pbm->sp_regt, pbm->sp_regh,
240 1.15 mrg offsetof(struct schizo_pbm_regs, strbuf),
241 1.15 mrg sizeof(struct iommu_strbuf), &is->is_sb[0]->sb_sb);
242 1.15 mrg }
243 1.15 mrg
244 1.21 christos aprint_normal_dev(sc->sc_dev, " ");
245 1.1 mrg schizo_init_iommu(sc, pbm);
246 1.1 mrg
247 1.1 mrg pbm->sp_memt = schizo_alloc_mem_tag(pbm);
248 1.1 mrg pbm->sp_iot = schizo_alloc_io_tag(pbm);
249 1.1 mrg pbm->sp_cfgt = schizo_alloc_config_tag(pbm);
250 1.1 mrg pbm->sp_dmat = schizo_alloc_dma_tag(pbm);
251 1.20 dyoung pbm->sp_flags = (pbm->sp_memt ? PCI_FLAGS_MEM_OKAY : 0) |
252 1.20 dyoung (pbm->sp_iot ? PCI_FLAGS_IO_OKAY : 0);
253 1.1 mrg
254 1.1 mrg if (bus_space_map(pbm->sp_cfgt, 0, 0x1000000, 0, &pbm->sp_cfgh))
255 1.1 mrg panic("schizo: could not map config space");
256 1.1 mrg
257 1.1 mrg pbm->sp_pc = schizo_alloc_chipset(pbm, sc->sc_node,
258 1.1 mrg &_sparc_pci_chipset);
259 1.3 nakayama pbm->sp_pc->spc_busmax = busranges[1];
260 1.24 macallan pbm->sp_pc->spc_busnode = kmem_zalloc(sizeof(*pbm->sp_pc->spc_busnode),
261 1.24 macallan KM_NOSLEEP);
262 1.3 nakayama if (pbm->sp_pc->spc_busnode == NULL)
263 1.24 macallan panic("schizo: kmem_alloc busnode");
264 1.1 mrg
265 1.1 mrg pba.pba_bus = busranges[0];
266 1.1 mrg pba.pba_bridgetag = NULL;
267 1.1 mrg pba.pba_pc = pbm->sp_pc;
268 1.1 mrg pba.pba_flags = pbm->sp_flags;
269 1.1 mrg pba.pba_dmat = pbm->sp_dmat;
270 1.2 mrg pba.pba_dmat64 = NULL; /* XXX */
271 1.1 mrg pba.pba_memt = pbm->sp_memt;
272 1.1 mrg pba.pba_iot = pbm->sp_iot;
273 1.1 mrg
274 1.1 mrg free(busranges, M_DEVBUF);
275 1.1 mrg
276 1.1 mrg schizo_pbm_write(pbm, SCZ_PCI_INTR_RETRY, 5);
277 1.1 mrg
278 1.1 mrg /* clear out the bus errors */
279 1.1 mrg schizo_pbm_write(pbm, SCZ_PCI_CTRL, schizo_pbm_read(pbm, SCZ_PCI_CTRL));
280 1.1 mrg schizo_pbm_write(pbm, SCZ_PCI_AFSR, schizo_pbm_read(pbm, SCZ_PCI_AFSR));
281 1.1 mrg schizo_cfg_write(pbm, PCI_COMMAND_STATUS_REG,
282 1.1 mrg schizo_cfg_read(pbm, PCI_COMMAND_STATUS_REG));
283 1.1 mrg
284 1.1 mrg reg = schizo_pbm_read(pbm, SCZ_PCI_CTRL);
285 1.1 mrg /* enable/disable error interrupts and arbiter */
286 1.29 mrg reg |= SCZ_PCICTRL_EEN | SCZ_PCICTRL_MMU_INT;
287 1.29 mrg if (sc->sc_tomatillo) {
288 1.29 mrg reg &= ~SCZ_PCICTRL_SBH_INT;
289 1.29 mrg reg |= TOM_PCICTRL_ARB;
290 1.29 mrg reg |= TOM_PCICTRL_PRM | TOM_PCICTRL_PRO |
291 1.29 mrg TOM_PCICTRL_PRL;
292 1.29 mrg if (sc->sc_ver <= 1) /* 2.0 */
293 1.29 mrg reg |= TOM_PCICTRL_DTO_INT;
294 1.29 mrg else
295 1.29 mrg reg |= SCZ_PCICTRL_PTO;
296 1.29 mrg } else
297 1.29 mrg reg |= SCZ_PCICTRL_SBH_INT | SCZ_PCICTRL_ARB;
298 1.29 mrg if (OF_getproplen(sc->sc_node, "no-bus-parking") < 0)
299 1.29 mrg reg |= SCZ_PCICTRL_PARK;
300 1.1 mrg schizo_pbm_write(pbm, SCZ_PCI_CTRL, reg);
301 1.1 mrg
302 1.1 mrg reg = schizo_pbm_read(pbm, SCZ_PCI_DIAG);
303 1.1 mrg reg &= ~(SCZ_PCIDIAG_D_RTRYARB | SCZ_PCIDIAG_D_RETRY |
304 1.1 mrg SCZ_PCIDIAG_D_INTSYNC);
305 1.1 mrg schizo_pbm_write(pbm, SCZ_PCI_DIAG, reg);
306 1.1 mrg
307 1.2 mrg if (pbm->sp_bus_a)
308 1.1 mrg schizo_set_intr(sc, pbm, PIL_HIGH, schizo_pci_error,
309 1.1 mrg pbm, SCZ_PCIERR_A_INO, "pci_a");
310 1.1 mrg else
311 1.1 mrg schizo_set_intr(sc, pbm, PIL_HIGH, schizo_pci_error,
312 1.1 mrg pbm, SCZ_PCIERR_B_INO, "pci_b");
313 1.1 mrg
314 1.1 mrg /* double mapped */
315 1.1 mrg schizo_set_intr(sc, pbm, PIL_HIGH, schizo_ue, sc, SCZ_UE_INO,
316 1.1 mrg "ue");
317 1.1 mrg schizo_set_intr(sc, pbm, PIL_HIGH, schizo_ce, sc, SCZ_CE_INO,
318 1.1 mrg "ce");
319 1.1 mrg schizo_set_intr(sc, pbm, PIL_HIGH, schizo_safari_error, sc,
320 1.1 mrg SCZ_SERR_INO, "safari");
321 1.1 mrg
322 1.17 mrg if (sc->sc_tomatillo) {
323 1.17 mrg /*
324 1.18 mrg * Enable the IOCACHE.
325 1.17 mrg */
326 1.17 mrg uint64_t iocache_csr;
327 1.17 mrg
328 1.18 mrg iocache_csr = TOM_IOCACHE_CSR_WRT_PEN |
329 1.18 mrg (1 << TOM_IOCACHE_CSR_POFFSET_SHIFT) |
330 1.18 mrg TOM_IOCACHE_CSR_PEN_RDM |
331 1.18 mrg TOM_IOCACHE_CSR_PEN_ONE |
332 1.18 mrg TOM_IOCACHE_CSR_PEN_LINE;
333 1.18 mrg schizo_pbm_write(pbm, SCZ_PCI_IOCACHE_CSR, iocache_csr);
334 1.17 mrg }
335 1.17 mrg
336 1.21 christos config_found(sc->sc_dev, &pba, schizo_print);
337 1.1 mrg }
338 1.1 mrg
339 1.1 mrg int
340 1.1 mrg schizo_ue(void *vsc)
341 1.1 mrg {
342 1.1 mrg struct schizo_softc *sc = vsc;
343 1.1 mrg
344 1.21 christos panic("%s: uncorrectable error", device_xname(sc->sc_dev));
345 1.1 mrg return (1);
346 1.1 mrg }
347 1.1 mrg
348 1.1 mrg int
349 1.1 mrg schizo_ce(void *vsc)
350 1.1 mrg {
351 1.1 mrg struct schizo_softc *sc = vsc;
352 1.1 mrg
353 1.21 christos panic("%s: correctable error", device_xname(sc->sc_dev));
354 1.1 mrg return (1);
355 1.1 mrg }
356 1.1 mrg
357 1.1 mrg int
358 1.1 mrg schizo_pci_error(void *vpbm)
359 1.1 mrg {
360 1.1 mrg struct schizo_pbm *sp = vpbm;
361 1.1 mrg struct schizo_softc *sc = sp->sp_sc;
362 1.2 mrg u_int64_t afsr, afar, ctrl, tfar;
363 1.1 mrg u_int32_t csr;
364 1.2 mrg char bits[128];
365 1.1 mrg
366 1.1 mrg afsr = schizo_pbm_read(sp, SCZ_PCI_AFSR);
367 1.1 mrg afar = schizo_pbm_read(sp, SCZ_PCI_AFAR);
368 1.1 mrg ctrl = schizo_pbm_read(sp, SCZ_PCI_CTRL);
369 1.1 mrg csr = schizo_cfg_read(sp, PCI_COMMAND_STATUS_REG);
370 1.1 mrg
371 1.21 christos printf("%s: pci bus %c error\n", device_xname(sc->sc_dev),
372 1.1 mrg sp->sp_bus_a ? 'A' : 'B');
373 1.1 mrg
374 1.8 christos snprintb(bits, sizeof(bits), SCZ_PCIAFSR_BITS, afsr);
375 1.8 christos printf("PCIAFSR=%s\n", bits);
376 1.14 nakayama printf("PCIAFAR=%" PRIx64 "\n", afar);
377 1.8 christos snprintb(bits, sizeof(bits), SCZ_PCICTRL_BITS, ctrl);
378 1.8 christos printf("PCICTRL=%s\n", bits);
379 1.2 mrg #ifdef PCI_COMMAND_STATUS_BITS
380 1.8 christos snprintb(bits, sizeof(bits), PCI_COMMAND_STATUS_BITS, csr);
381 1.8 christos printf("PCICSR=%s\n", bits);
382 1.2 mrg #endif
383 1.1 mrg
384 1.1 mrg if (ctrl & SCZ_PCICTRL_MMU_ERR) {
385 1.1 mrg ctrl = schizo_pbm_read(sp, SCZ_PCI_IOMMU_CTRL);
386 1.14 nakayama printf("IOMMUCTRL=%" PRIx64 "\n", ctrl);
387 1.1 mrg
388 1.1 mrg if ((ctrl & TOM_IOMMU_ERR) == 0)
389 1.1 mrg goto clear_error;
390 1.1 mrg
391 1.1 mrg if (sc->sc_tomatillo) {
392 1.1 mrg tfar = schizo_pbm_read(sp, TOM_PCI_IOMMU_TFAR);
393 1.14 nakayama printf("IOMMUTFAR=%" PRIx64 "\n", tfar);
394 1.1 mrg }
395 1.1 mrg
396 1.1 mrg /* These are non-fatal if target abort was signalled. */
397 1.1 mrg if ((ctrl & TOM_IOMMU_ERR_MASK) == TOM_IOMMU_INV_ERR ||
398 1.1 mrg ctrl & TOM_IOMMU_ILLTSBTBW_ERR ||
399 1.1 mrg ctrl & TOM_IOMMU_BADVA_ERR) {
400 1.1 mrg if (csr & PCI_STATUS_TARGET_TARGET_ABORT) {
401 1.1 mrg schizo_pbm_write(sp, SCZ_PCI_IOMMU_CTRL, ctrl);
402 1.1 mrg goto clear_error;
403 1.1 mrg }
404 1.1 mrg }
405 1.1 mrg }
406 1.1 mrg
407 1.21 christos panic("%s: fatal", device_xname(sc->sc_dev));
408 1.1 mrg
409 1.1 mrg clear_error:
410 1.1 mrg schizo_cfg_write(sp, PCI_COMMAND_STATUS_REG, csr);
411 1.1 mrg schizo_pbm_write(sp, SCZ_PCI_CTRL, ctrl);
412 1.1 mrg schizo_pbm_write(sp, SCZ_PCI_AFSR, afsr);
413 1.1 mrg return (1);
414 1.1 mrg }
415 1.1 mrg
416 1.1 mrg int
417 1.1 mrg schizo_safari_error(void *vsc)
418 1.1 mrg {
419 1.1 mrg struct schizo_softc *sc = vsc;
420 1.1 mrg
421 1.21 christos printf("%s: safari error\n", device_xname(sc->sc_dev));
422 1.1 mrg
423 1.14 nakayama printf("ERRLOG=%" PRIx64 "\n", schizo_read(sc, SCZ_SAFARI_ERRLOG));
424 1.14 nakayama printf("UE_AFSR=%" PRIx64 "\n", schizo_read(sc, SCZ_UE_AFSR));
425 1.14 nakayama printf("UE_AFAR=%" PRIx64 "\n", schizo_read(sc, SCZ_UE_AFAR));
426 1.14 nakayama printf("CE_AFSR=%" PRIx64 "\n", schizo_read(sc, SCZ_CE_AFSR));
427 1.14 nakayama printf("CE_AFAR=%" PRIx64 "\n", schizo_read(sc, SCZ_CE_AFAR));
428 1.1 mrg
429 1.21 christos panic("%s: fatal", device_xname(sc->sc_dev));
430 1.1 mrg return (1);
431 1.1 mrg }
432 1.1 mrg
433 1.1 mrg void
434 1.1 mrg schizo_init_iommu(struct schizo_softc *sc, struct schizo_pbm *pbm)
435 1.1 mrg {
436 1.1 mrg struct iommu_state *is = &pbm->sp_is;
437 1.1 mrg int *vdma = NULL, nitem, tsbsize = 7;
438 1.1 mrg u_int32_t iobase = -1;
439 1.1 mrg char *name;
440 1.1 mrg
441 1.4 mrg /* punch in our copies */
442 1.1 mrg is->is_bustag = pbm->sp_regt;
443 1.15 mrg bus_space_subregion(is->is_bustag, pbm->sp_regh,
444 1.15 mrg offsetof(struct schizo_pbm_regs, iommu),
445 1.18 mrg sizeof(struct iommureg2),
446 1.15 mrg &is->is_iommu);
447 1.1 mrg
448 1.1 mrg /*
449 1.1 mrg * Separate the men from the boys. If the `virtual-dma'
450 1.1 mrg * property exists, use it.
451 1.1 mrg */
452 1.2 mrg if (!prom_getprop(sc->sc_node, "virtual-dma", sizeof(vdma), &nitem,
453 1.1 mrg (void **)&vdma)) {
454 1.1 mrg /* Damn. Gotta use these values. */
455 1.1 mrg iobase = vdma[0];
456 1.1 mrg #define TSBCASE(x) case 1 << ((x) + 23): tsbsize = (x); break
457 1.1 mrg switch (vdma[1]) {
458 1.1 mrg TSBCASE(1); TSBCASE(2); TSBCASE(3);
459 1.1 mrg TSBCASE(4); TSBCASE(5); TSBCASE(6);
460 1.1 mrg default:
461 1.1 mrg printf("bogus tsb size %x, using 7\n", vdma[1]);
462 1.1 mrg TSBCASE(7);
463 1.1 mrg }
464 1.1 mrg #undef TSBCASE
465 1.2 mrg DPRINTF(SDB_BUSMAP, ("schizo_init_iommu: iobase=0x%x\n", iobase));
466 1.1 mrg free(vdma, M_DEVBUF);
467 1.1 mrg } else {
468 1.2 mrg DPRINTF(SDB_BUSMAP, ("schizo_init_iommu: getprop failed, "
469 1.1 mrg "using iobase=0x%x, tsbsize=%d\n", iobase, tsbsize));
470 1.1 mrg }
471 1.1 mrg
472 1.15 mrg /* give us a nice name.. */
473 1.24 macallan name = (char *)kmem_alloc(32, KM_NOSLEEP);
474 1.15 mrg if (name == NULL)
475 1.24 macallan
476 1.24 macallan panic("couldn't kmem_alloc iommu name");
477 1.21 christos snprintf(name, 32, "%s dvma", device_xname(sc->sc_dev));
478 1.15 mrg
479 1.1 mrg iommu_init(name, is, tsbsize, iobase);
480 1.1 mrg }
481 1.1 mrg
482 1.1 mrg int
483 1.1 mrg schizo_print(void *aux, const char *p)
484 1.1 mrg {
485 1.2 mrg
486 1.1 mrg if (p == NULL)
487 1.1 mrg return (UNCONF);
488 1.1 mrg return (QUIET);
489 1.1 mrg }
490 1.1 mrg
491 1.1 mrg pcireg_t
492 1.1 mrg schizo_conf_read(pci_chipset_tag_t pc, pcitag_t tag, int reg)
493 1.1 mrg {
494 1.2 mrg struct schizo_pbm *sp = pc->cookie;
495 1.31 nakayama struct cpu_info *ci = curcpu();
496 1.11 nakayama pcireg_t val = (pcireg_t)~0;
497 1.31 nakayama int s;
498 1.2 mrg
499 1.2 mrg DPRINTF(SDB_CONF, ("%s: tag %lx reg %x ", __func__, (long)tag, reg));
500 1.33 msaitoh if (PCITAG_NODE(tag) != -1 && (unsigned int)reg < PCI_CONF_SIZE) {
501 1.31 nakayama s = splhigh();
502 1.31 nakayama ci->ci_pci_probe = true;
503 1.31 nakayama membar_Sync();
504 1.11 nakayama val = bus_space_read_4(sp->sp_cfgt, sp->sp_cfgh,
505 1.11 nakayama PCITAG_OFFSET(tag) + reg);
506 1.31 nakayama membar_Sync();
507 1.31 nakayama if (ci->ci_pci_fault)
508 1.31 nakayama val = (pcireg_t)~0;
509 1.31 nakayama ci->ci_pci_probe = ci->ci_pci_fault = false;
510 1.31 nakayama splx(s);
511 1.31 nakayama }
512 1.2 mrg DPRINTF(SDB_CONF, (" returning %08x\n", (u_int)val));
513 1.2 mrg return (val);
514 1.1 mrg }
515 1.1 mrg
516 1.1 mrg void
517 1.1 mrg schizo_conf_write(pci_chipset_tag_t pc, pcitag_t tag, int reg, pcireg_t data)
518 1.1 mrg {
519 1.2 mrg struct schizo_pbm *sp = pc->cookie;
520 1.2 mrg
521 1.2 mrg DPRINTF(SDB_CONF, ("%s: tag %lx; reg %x; data %x", __func__,
522 1.2 mrg (long)tag, reg, (int)data));
523 1.11 nakayama
524 1.11 nakayama /* If we don't know it, just punt it. */
525 1.11 nakayama if (PCITAG_NODE(tag) == -1) {
526 1.11 nakayama DPRINTF(SDB_CONF, (" .. bad addr\n"));
527 1.11 nakayama return;
528 1.11 nakayama }
529 1.11 nakayama
530 1.33 msaitoh if ((unsigned int)reg >= PCI_CONF_SIZE)
531 1.33 msaitoh return;
532 1.33 msaitoh
533 1.2 mrg bus_space_write_4(sp->sp_cfgt, sp->sp_cfgh,
534 1.1 mrg PCITAG_OFFSET(tag) + reg, data);
535 1.2 mrg DPRINTF(SDB_CONF, (" .. done\n"));
536 1.1 mrg }
537 1.1 mrg
538 1.1 mrg void
539 1.1 mrg schizo_set_intr(struct schizo_softc *sc, struct schizo_pbm *pbm, int ipl,
540 1.2 mrg int (*handler)(void *), void *arg, int ino, const char *what)
541 1.1 mrg {
542 1.1 mrg struct intrhand *ih;
543 1.2 mrg u_int64_t mapoff, clroff;
544 1.13 mrg uintptr_t intrregs;
545 1.2 mrg
546 1.6 mrg DPRINTF(SDB_INTR, ("%s: ino %x ign %x fn %p arg %p", __func__,
547 1.6 mrg ino, sc->sc_ign, handler, arg));
548 1.6 mrg
549 1.2 mrg mapoff = offsetof(struct schizo_pbm_regs, imap[ino]);
550 1.2 mrg clroff = offsetof(struct schizo_pbm_regs, iclr[ino]);
551 1.12 mrg ino |= sc->sc_ign;
552 1.1 mrg
553 1.14 nakayama DPRINTF(SDB_INTR, (" mapoff %" PRIx64 " clroff %" PRIx64 "\n",
554 1.14 nakayama mapoff, clroff));
555 1.6 mrg
556 1.2 mrg ih = (struct intrhand *)
557 1.24 macallan kmem_alloc(sizeof(struct intrhand), KM_NOSLEEP);
558 1.2 mrg if (ih == NULL)
559 1.1 mrg return;
560 1.2 mrg ih->ih_arg = arg;
561 1.13 mrg intrregs = (uintptr_t)bus_space_vaddr(pbm->sp_regt, pbm->sp_intrh);
562 1.14 nakayama ih->ih_map = (uint64_t *)(uintptr_t)(intrregs + mapoff);
563 1.14 nakayama ih->ih_clr = (uint64_t *)(uintptr_t)(intrregs + clroff);
564 1.2 mrg ih->ih_fun = handler;
565 1.27 nakayama ih->ih_pil = ipl;
566 1.2 mrg ih->ih_number = INTVEC(schizo_pbm_read(pbm, mapoff));
567 1.26 mrg ih->ih_pending = 0;
568 1.26 mrg
569 1.2 mrg intr_establish(ipl, ipl != IPL_VM, ih);
570 1.2 mrg
571 1.2 mrg schizo_pbm_write(pbm, mapoff,
572 1.2 mrg ih->ih_number | INTMAP_V | (CPU_UPAID << INTMAP_TID_SHIFT));
573 1.1 mrg }
574 1.1 mrg
575 1.1 mrg bus_space_tag_t
576 1.1 mrg schizo_alloc_mem_tag(struct schizo_pbm *sp)
577 1.1 mrg {
578 1.29 mrg return (schizo_alloc_bus_tag(sp, "mem", PCI_MEMORY_BUS_SPACE));
579 1.1 mrg }
580 1.1 mrg
581 1.1 mrg bus_space_tag_t
582 1.1 mrg schizo_alloc_io_tag(struct schizo_pbm *sp)
583 1.1 mrg {
584 1.29 mrg return (schizo_alloc_bus_tag(sp, "io", PCI_IO_BUS_SPACE));
585 1.1 mrg }
586 1.1 mrg
587 1.1 mrg bus_space_tag_t
588 1.1 mrg schizo_alloc_config_tag(struct schizo_pbm *sp)
589 1.1 mrg {
590 1.29 mrg return (schizo_alloc_bus_tag(sp, "cfg", PCI_CONFIG_BUS_SPACE));
591 1.1 mrg }
592 1.1 mrg
593 1.1 mrg bus_space_tag_t
594 1.2 mrg schizo_alloc_bus_tag(struct schizo_pbm *pbm, const char *name, int type)
595 1.1 mrg {
596 1.1 mrg struct schizo_softc *sc = pbm->sp_sc;
597 1.2 mrg bus_space_tag_t bt;
598 1.1 mrg
599 1.24 macallan bt = (bus_space_tag_t) kmem_zalloc(sizeof(struct sparc_bus_space_tag),
600 1.24 macallan KM_NOSLEEP);
601 1.1 mrg if (bt == NULL)
602 1.1 mrg panic("schizo: could not allocate bus tag");
603 1.1 mrg
604 1.1 mrg bt->cookie = pbm;
605 1.2 mrg bt->parent = sc->sc_bustag;
606 1.2 mrg bt->type = type;
607 1.1 mrg bt->sparc_bus_map = schizo_bus_map;
608 1.1 mrg bt->sparc_bus_mmap = schizo_bus_mmap;
609 1.1 mrg bt->sparc_intr_establish = schizo_intr_establish;
610 1.1 mrg return (bt);
611 1.1 mrg }
612 1.1 mrg
613 1.1 mrg bus_dma_tag_t
614 1.1 mrg schizo_alloc_dma_tag(struct schizo_pbm *pbm)
615 1.1 mrg {
616 1.1 mrg struct schizo_softc *sc = pbm->sp_sc;
617 1.1 mrg bus_dma_tag_t dt, pdt = sc->sc_dmat;
618 1.1 mrg
619 1.24 macallan dt = kmem_zalloc(sizeof(*dt), KM_NOSLEEP);
620 1.1 mrg if (dt == NULL)
621 1.1 mrg panic("schizo: could not alloc dma tag");
622 1.1 mrg
623 1.1 mrg dt->_cookie = pbm;
624 1.1 mrg dt->_parent = pdt;
625 1.2 mrg #define PCOPY(x) dt->x = pdt->x
626 1.4 mrg dt->_dmamap_create = schizo_dmamap_create;
627 1.2 mrg PCOPY(_dmamap_destroy);
628 1.2 mrg dt->_dmamap_load = iommu_dvmamap_load;
629 1.2 mrg PCOPY(_dmamap_load_mbuf);
630 1.2 mrg PCOPY(_dmamap_load_uio);
631 1.2 mrg dt->_dmamap_load_raw = iommu_dvmamap_load_raw;
632 1.2 mrg dt->_dmamap_unload = iommu_dvmamap_unload;
633 1.2 mrg dt->_dmamap_sync = iommu_dvmamap_sync;
634 1.2 mrg dt->_dmamem_alloc = iommu_dvmamem_alloc;
635 1.2 mrg dt->_dmamem_free = iommu_dvmamem_free;
636 1.2 mrg dt->_dmamem_map = iommu_dvmamem_map;
637 1.2 mrg dt->_dmamem_unmap = iommu_dvmamem_unmap;
638 1.2 mrg PCOPY(_dmamem_mmap);
639 1.2 mrg #undef PCOPY
640 1.1 mrg return (dt);
641 1.1 mrg }
642 1.1 mrg
643 1.1 mrg pci_chipset_tag_t
644 1.1 mrg schizo_alloc_chipset(struct schizo_pbm *pbm, int node, pci_chipset_tag_t pc)
645 1.1 mrg {
646 1.1 mrg pci_chipset_tag_t npc;
647 1.1 mrg
648 1.24 macallan npc = kmem_alloc(sizeof *npc, KM_NOSLEEP);
649 1.1 mrg if (npc == NULL)
650 1.1 mrg panic("schizo: could not allocate pci_chipset_tag_t");
651 1.1 mrg memcpy(npc, pc, sizeof *pc);
652 1.1 mrg npc->cookie = pbm;
653 1.1 mrg npc->rootnode = node;
654 1.2 mrg npc->spc_conf_read = schizo_conf_read;
655 1.2 mrg npc->spc_conf_write = schizo_conf_write;
656 1.10 mrg npc->spc_intr_map = schizo_pci_intr_map;
657 1.2 mrg npc->spc_intr_establish = schizo_pci_intr_establish;
658 1.17 mrg npc->spc_find_ino = NULL;
659 1.1 mrg return (npc);
660 1.1 mrg }
661 1.1 mrg
662 1.1 mrg int
663 1.2 mrg schizo_dmamap_create(bus_dma_tag_t t, bus_size_t size,
664 1.1 mrg int nsegments, bus_size_t maxsegsz, bus_size_t boundary, int flags,
665 1.1 mrg bus_dmamap_t *dmamp)
666 1.1 mrg {
667 1.2 mrg struct schizo_pbm *pbm = t->_cookie;
668 1.4 mrg int error;
669 1.1 mrg
670 1.4 mrg error = bus_dmamap_create(t->_parent, size, nsegments, maxsegsz,
671 1.4 mrg boundary, flags, dmamp);
672 1.4 mrg if (error == 0)
673 1.4 mrg (*dmamp)->_dm_cookie = &pbm->sp_sb;
674 1.4 mrg return error;
675 1.1 mrg }
676 1.2 mrg
677 1.2 mrg static struct schizo_range *
678 1.2 mrg get_schizorange(struct schizo_pbm *pbm, int ss)
679 1.2 mrg {
680 1.2 mrg int i;
681 1.2 mrg
682 1.2 mrg for (i = 0; i < pbm->sp_nrange; i++) {
683 1.2 mrg if (((pbm->sp_range[i].cspace >> 24) & 0x03) == ss)
684 1.2 mrg return (&pbm->sp_range[i]);
685 1.2 mrg }
686 1.2 mrg /* not found */
687 1.2 mrg return (NULL);
688 1.2 mrg }
689 1.1 mrg
690 1.1 mrg int
691 1.2 mrg schizo_bus_map(bus_space_tag_t t, bus_addr_t offset, bus_size_t size,
692 1.2 mrg int flags, vaddr_t unused, bus_space_handle_t *hp)
693 1.1 mrg {
694 1.2 mrg bus_addr_t paddr;
695 1.1 mrg struct schizo_pbm *pbm = t->cookie;
696 1.2 mrg struct schizo_softc *sc = pbm->sp_sc;
697 1.2 mrg struct schizo_range *sr;
698 1.2 mrg int ss;
699 1.1 mrg
700 1.1 mrg DPRINTF(SDB_BUSMAP, ("schizo_bus_map: type %d off %qx sz %qx flags %d",
701 1.2 mrg t->type,
702 1.1 mrg (unsigned long long)offset,
703 1.1 mrg (unsigned long long)size,
704 1.1 mrg flags));
705 1.1 mrg
706 1.2 mrg ss = sparc_pci_childspace(t->type);
707 1.2 mrg DPRINTF(SDB_BUSMAP, (" cspace %d\n", ss));
708 1.1 mrg
709 1.2 mrg sr = get_schizorange(pbm, ss);
710 1.2 mrg if (sr != NULL) {
711 1.2 mrg paddr = BUS_ADDR(sr->phys_hi, sr->phys_lo + offset);
712 1.2 mrg DPRINTF(SDB_BUSMAP, ("%s: mapping paddr "
713 1.2 mrg "space %lx offset %lx paddr %qx\n",
714 1.2 mrg __func__, (long)ss, (long)offset,
715 1.2 mrg (unsigned long long)paddr));
716 1.2 mrg return ((*sc->sc_bustag->sparc_bus_map)(t, paddr, size,
717 1.2 mrg flags, 0, hp));
718 1.1 mrg }
719 1.2 mrg DPRINTF(SDB_BUSMAP, ("%s: FAILED\n", __func__));
720 1.1 mrg return (EINVAL);
721 1.1 mrg }
722 1.1 mrg
723 1.2 mrg static paddr_t
724 1.2 mrg schizo_bus_mmap(bus_space_tag_t t, bus_addr_t paddr, off_t off, int prot,
725 1.2 mrg int flags)
726 1.1 mrg {
727 1.1 mrg bus_addr_t offset = paddr;
728 1.1 mrg struct schizo_pbm *pbm = t->cookie;
729 1.2 mrg struct schizo_softc *sc = pbm->sp_sc;
730 1.2 mrg struct schizo_range *sr;
731 1.2 mrg int ss;
732 1.1 mrg
733 1.2 mrg ss = sparc_pci_childspace(t->type);
734 1.1 mrg
735 1.1 mrg DPRINTF(SDB_BUSMAP, ("schizo_bus_mmap: prot %d flags %d pa %qx\n",
736 1.1 mrg prot, flags, (unsigned long long)paddr));
737 1.1 mrg
738 1.2 mrg sr = get_schizorange(pbm, ss);
739 1.2 mrg if (sr != NULL) {
740 1.2 mrg paddr = BUS_ADDR(sr->phys_hi, sr->phys_lo + offset);
741 1.2 mrg DPRINTF(SDB_BUSMAP, ("%s: mapping paddr "
742 1.2 mrg "space %lx offset %lx paddr %qx\n",
743 1.2 mrg __func__, (long)ss, (long)offset,
744 1.2 mrg (unsigned long long)paddr));
745 1.2 mrg return (bus_space_mmap(sc->sc_bustag, paddr, off,
746 1.2 mrg prot, flags));
747 1.1 mrg }
748 1.2 mrg DPRINTF(SDB_BUSMAP, ("%s: FAILED\n", __func__));
749 1.1 mrg return (-1);
750 1.1 mrg }
751 1.1 mrg
752 1.10 mrg /*
753 1.12 mrg * Set the IGN for this schizo into the handle.
754 1.10 mrg */
755 1.10 mrg int
756 1.19 dyoung schizo_pci_intr_map(const struct pci_attach_args *pa, pci_intr_handle_t *ihp)
757 1.10 mrg {
758 1.10 mrg struct schizo_pbm *pbm = pa->pa_pc->cookie;
759 1.10 mrg struct schizo_softc *sc = pbm->sp_sc;
760 1.10 mrg
761 1.12 mrg *ihp |= sc->sc_ign;
762 1.10 mrg DPRINTF(SDB_INTMAP, ("returning IGN adjusted to %x\n", *ihp));
763 1.10 mrg return (0);
764 1.10 mrg }
765 1.10 mrg
766 1.2 mrg static void *
767 1.2 mrg schizo_intr_establish(bus_space_tag_t t, int ihandle, int level,
768 1.2 mrg int (*handler)(void *), void *arg, void (*fastvec)(void) /* ignored */)
769 1.1 mrg {
770 1.1 mrg struct schizo_pbm *pbm = t->cookie;
771 1.1 mrg struct intrhand *ih = NULL;
772 1.7 mrg uint64_t mapoff, clroff;
773 1.13 mrg uintptr_t intrregs;
774 1.7 mrg volatile uint64_t *intrmapptr = NULL, *intrclrptr = NULL;
775 1.1 mrg int ino;
776 1.5 mrg long vec;
777 1.1 mrg
778 1.1 mrg vec = INTVEC(ihandle);
779 1.1 mrg ino = INTINO(vec);
780 1.1 mrg
781 1.24 macallan ih = kmem_alloc(sizeof *ih, KM_NOSLEEP);
782 1.5 mrg if (ih == NULL)
783 1.5 mrg return (NULL);
784 1.5 mrg
785 1.6 mrg DPRINTF(SDB_INTR, ("\n%s: ihandle %d level %d fn %p arg %p\n", __func__,
786 1.2 mrg ihandle, level, handler, arg));
787 1.2 mrg
788 1.1 mrg if (level == IPL_NONE)
789 1.1 mrg level = INTLEV(vec);
790 1.1 mrg if (level == IPL_NONE) {
791 1.1 mrg printf(": no IPL, setting IPL 2.\n");
792 1.1 mrg level = 2;
793 1.1 mrg }
794 1.1 mrg
795 1.5 mrg mapoff = offsetof(struct schizo_pbm_regs, imap[ino]);
796 1.5 mrg clroff = offsetof(struct schizo_pbm_regs, iclr[ino]);
797 1.1 mrg
798 1.14 nakayama DPRINTF(SDB_INTR, ("%s: intr %x: %p mapoff %" PRIx64 " clroff %"
799 1.14 nakayama PRIx64 "\n", __func__, ino, intrlev[ino], mapoff, clroff));
800 1.6 mrg
801 1.25 macallan ih->ih_ivec = ihandle;
802 1.25 macallan
803 1.13 mrg intrregs = (uintptr_t)bus_space_vaddr(pbm->sp_regt, pbm->sp_intrh);
804 1.14 nakayama intrmapptr = (uint64_t *)(uintptr_t)(intrregs + mapoff);
805 1.14 nakayama intrclrptr = (uint64_t *)(uintptr_t)(intrregs + clroff);
806 1.6 mrg
807 1.5 mrg if (INTIGN(vec) == 0)
808 1.13 mrg ino |= schizo_pbm_readintr(pbm, mapoff) & INTMAP_IGN;
809 1.5 mrg else
810 1.5 mrg ino |= vec & INTMAP_IGN;
811 1.1 mrg
812 1.5 mrg /* Register the map and clear intr registers */
813 1.2 mrg ih->ih_map = intrmapptr;
814 1.2 mrg ih->ih_clr = intrclrptr;
815 1.2 mrg
816 1.2 mrg ih->ih_fun = handler;
817 1.2 mrg ih->ih_arg = arg;
818 1.2 mrg ih->ih_pil = level;
819 1.6 mrg ih->ih_number = ino;
820 1.26 mrg ih->ih_pending = 0;
821 1.2 mrg
822 1.5 mrg DPRINTF(SDB_INTR, (
823 1.6 mrg "; installing handler %p arg %p with inr %x pil %u\n",
824 1.6 mrg handler, arg, ino, (u_int)ih->ih_pil));
825 1.5 mrg
826 1.2 mrg intr_establish(ih->ih_pil, level != IPL_VM, ih);
827 1.1 mrg
828 1.5 mrg /*
829 1.5 mrg * Enable the interrupt now we have the handler installed.
830 1.5 mrg * Read the current value as we can't change it besides the
831 1.5 mrg * valid bit so so make sure only this bit is changed.
832 1.5 mrg */
833 1.5 mrg if (intrmapptr) {
834 1.2 mrg u_int64_t imap;
835 1.1 mrg
836 1.13 mrg imap = schizo_pbm_readintr(pbm, mapoff);
837 1.5 mrg DPRINTF(SDB_INTR, ("; read intrmap = %016qx",
838 1.5 mrg (unsigned long long)imap));
839 1.2 mrg imap |= INTMAP_V;
840 1.5 mrg DPRINTF(SDB_INTR, ("; addr of intrmapptr = %p", intrmapptr));
841 1.5 mrg DPRINTF(SDB_INTR, ("; writing intrmap = %016qx\n",
842 1.5 mrg (unsigned long long)imap));
843 1.13 mrg schizo_pbm_writeintr(pbm, mapoff, imap);
844 1.13 mrg imap = schizo_pbm_readintr(pbm, mapoff);
845 1.5 mrg DPRINTF(SDB_INTR, ("; reread intrmap = %016qx",
846 1.5 mrg (unsigned long long)imap));
847 1.2 mrg ih->ih_number |= imap & INTMAP_INR;
848 1.1 mrg }
849 1.5 mrg if (intrclrptr) {
850 1.5 mrg /* set state to IDLE */
851 1.13 mrg schizo_pbm_writeintr(pbm, clroff, 0);
852 1.5 mrg }
853 1.1 mrg
854 1.1 mrg return (ih);
855 1.1 mrg }
856 1.1 mrg
857 1.2 mrg static void *
858 1.2 mrg schizo_pci_intr_establish(pci_chipset_tag_t pc, pci_intr_handle_t ih, int level,
859 1.2 mrg int (*func)(void *), void *arg)
860 1.2 mrg {
861 1.2 mrg void *cookie;
862 1.2 mrg struct schizo_pbm *pbm = (struct schizo_pbm *)pc->cookie;
863 1.2 mrg
864 1.9 mrg DPRINTF(SDB_INTR, ("%s: ih %lx; level %d", __func__, (u_long)ih, level));
865 1.2 mrg cookie = bus_intr_establish(pbm->sp_memt, ih, level, func, arg);
866 1.2 mrg
867 1.2 mrg DPRINTF(SDB_INTR, ("; returning handle %p\n", cookie));
868 1.2 mrg return (cookie);
869 1.2 mrg }
870