vrpciu.c revision 1.22 1 1.22 msaitoh /* $NetBSD: vrpciu.c,v 1.22 2015/10/02 05:22:51 msaitoh Exp $ */
2 1.1 enami
3 1.1 enami /*-
4 1.1 enami * Copyright (c) 2001 Enami Tsugutomo.
5 1.1 enami * All rights reserved.
6 1.1 enami *
7 1.1 enami * Redistribution and use in source and binary forms, with or without
8 1.1 enami * modification, are permitted provided that the following conditions
9 1.1 enami * are met:
10 1.1 enami * 1. Redistributions of source code must retain the above copyright
11 1.1 enami * notice, this list of conditions and the following disclaimer.
12 1.1 enami * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 enami * notice, this list of conditions and the following disclaimer in the
14 1.1 enami * documentation and/or other materials provided with the distribution.
15 1.1 enami *
16 1.1 enami * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
17 1.1 enami * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 1.1 enami * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 1.1 enami * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
20 1.1 enami * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 1.1 enami * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 1.1 enami * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 1.1 enami * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 1.1 enami * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 1.1 enami * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 1.1 enami * SUCH DAMAGE.
27 1.1 enami */
28 1.14 lukem
29 1.14 lukem #include <sys/cdefs.h>
30 1.22 msaitoh __KERNEL_RCSID(0, "$NetBSD: vrpciu.c,v 1.22 2015/10/02 05:22:51 msaitoh Exp $");
31 1.1 enami
32 1.1 enami #include <sys/param.h>
33 1.1 enami #include <sys/systm.h>
34 1.1 enami #include <sys/device.h>
35 1.1 enami
36 1.1 enami #include <machine/bus.h>
37 1.2 takemura #include <machine/bus_space_hpcmips.h>
38 1.2 takemura #include <machine/bus_dma_hpcmips.h>
39 1.4 takemura #include <machine/config_hook.h>
40 1.5 shin #include <machine/platid.h>
41 1.5 shin #include <machine/platid_mask.h>
42 1.1 enami
43 1.1 enami #include <dev/pci/pcivar.h>
44 1.3 takemura #include <dev/pci/pcidevs.h>
45 1.5 shin #include <dev/pci/pciidereg.h>
46 1.1 enami
47 1.1 enami #include <hpcmips/vr/icureg.h>
48 1.6 takemura #include <hpcmips/vr/vripif.h>
49 1.1 enami #include <hpcmips/vr/vrpciureg.h>
50 1.1 enami
51 1.1 enami #include "pci.h"
52 1.1 enami
53 1.1 enami #ifdef DEBUG
54 1.1 enami #define DPRINTF(args) printf args
55 1.1 enami #else
56 1.1 enami #define DPRINTF(args)
57 1.1 enami #endif
58 1.1 enami
59 1.1 enami struct vrpciu_softc {
60 1.20 chs device_t sc_dev;
61 1.1 enami
62 1.1 enami vrip_chipset_tag_t sc_vc;
63 1.1 enami bus_space_tag_t sc_iot;
64 1.1 enami bus_space_handle_t sc_ioh;
65 1.1 enami void *sc_ih;
66 1.1 enami
67 1.1 enami struct vrc4173bcu_softc *sc_bcu; /* vrc4173bcu */
68 1.1 enami
69 1.1 enami struct hpcmips_pci_chipset sc_pc;
70 1.1 enami };
71 1.1 enami
72 1.1 enami static void vrpciu_write(struct vrpciu_softc *, int, u_int32_t);
73 1.1 enami static u_int32_t
74 1.1 enami vrpciu_read(struct vrpciu_softc *, int);
75 1.1 enami #ifdef DEBUG
76 1.1 enami static void vrpciu_write_2(struct vrpciu_softc *, int, u_int16_t)
77 1.1 enami __attribute__((unused));
78 1.1 enami static u_int16_t
79 1.1 enami vrpciu_read_2(struct vrpciu_softc *, int);
80 1.1 enami #endif
81 1.20 chs static int vrpciu_match(device_t, cfdata_t, void *);
82 1.20 chs static void vrpciu_attach(device_t, device_t, void *);
83 1.1 enami static int vrpciu_intr(void *);
84 1.20 chs static void vrpciu_attach_hook(device_t, device_t,
85 1.1 enami struct pcibus_attach_args *);
86 1.1 enami static int vrpciu_bus_maxdevs(pci_chipset_tag_t, int);
87 1.19 dyoung static int vrpciu_bus_devorder(pci_chipset_tag_t, int, uint8_t *, int);
88 1.1 enami static pcitag_t vrpciu_make_tag(pci_chipset_tag_t, int, int, int);
89 1.1 enami static void vrpciu_decompose_tag(pci_chipset_tag_t, pcitag_t, int *, int *,
90 1.1 enami int *);
91 1.1 enami static pcireg_t vrpciu_conf_read(pci_chipset_tag_t, pcitag_t, int);
92 1.1 enami static void vrpciu_conf_write(pci_chipset_tag_t, pcitag_t, int, pcireg_t);
93 1.20 chs static int vrpciu_intr_map(const struct pci_attach_args *, pci_intr_handle_t *);
94 1.21 christos static const char *vrpciu_intr_string(pci_chipset_tag_t, pci_intr_handle_t,
95 1.21 christos char *, size_t);
96 1.4 takemura static const struct evcnt *vrpciu_intr_evcnt(pci_chipset_tag_t,
97 1.4 takemura pci_intr_handle_t);
98 1.1 enami static void *vrpciu_intr_establish(pci_chipset_tag_t, pci_intr_handle_t,
99 1.1 enami int, int (*)(void *), void *);
100 1.1 enami static void vrpciu_intr_disestablish(pci_chipset_tag_t, void *);
101 1.1 enami
102 1.20 chs CFATTACH_DECL_NEW(vrpciu, sizeof(struct vrpciu_softc),
103 1.11 thorpej vrpciu_match, vrpciu_attach, NULL, NULL);
104 1.1 enami
105 1.1 enami static void
106 1.1 enami vrpciu_write(struct vrpciu_softc *sc, int offset, u_int32_t val)
107 1.1 enami {
108 1.1 enami
109 1.1 enami bus_space_write_4(sc->sc_iot, sc->sc_ioh, offset, val);
110 1.1 enami }
111 1.1 enami
112 1.1 enami static u_int32_t
113 1.1 enami vrpciu_read(struct vrpciu_softc *sc, int offset)
114 1.1 enami {
115 1.1 enami
116 1.1 enami return (bus_space_read_4(sc->sc_iot, sc->sc_ioh, offset));
117 1.1 enami }
118 1.1 enami
119 1.1 enami #ifdef DEBUG
120 1.1 enami static void
121 1.1 enami vrpciu_write_2(struct vrpciu_softc *sc, int offset, u_int16_t val)
122 1.1 enami {
123 1.1 enami
124 1.1 enami bus_space_write_2(sc->sc_iot, sc->sc_ioh, offset, val);
125 1.1 enami }
126 1.1 enami
127 1.1 enami static u_int16_t
128 1.1 enami vrpciu_read_2(struct vrpciu_softc *sc, int offset)
129 1.1 enami {
130 1.1 enami
131 1.1 enami return (bus_space_read_2(sc->sc_iot, sc->sc_ioh, offset));
132 1.1 enami }
133 1.1 enami #endif
134 1.1 enami
135 1.1 enami static int
136 1.20 chs vrpciu_match(device_t parent, cfdata_t match, void *aux)
137 1.1 enami {
138 1.1 enami
139 1.1 enami return (1);
140 1.1 enami }
141 1.1 enami
142 1.1 enami static void
143 1.20 chs vrpciu_attach(device_t parent, device_t self, void *aux)
144 1.1 enami {
145 1.20 chs struct vrpciu_softc *sc = device_private(self);
146 1.1 enami pci_chipset_tag_t pc = &sc->sc_pc;
147 1.1 enami struct vrip_attach_args *va = aux;
148 1.7 takemura #if defined(DEBUG) || NPCI > 0
149 1.7 takemura u_int32_t reg;
150 1.7 takemura #endif
151 1.7 takemura #if NPCI > 0
152 1.2 takemura struct bus_space_tag_hpcmips *iot;
153 1.2 takemura char tmpbuf[16];
154 1.1 enami struct pcibus_attach_args pba;
155 1.1 enami #endif
156 1.1 enami
157 1.20 chs sc->sc_dev = self;
158 1.1 enami sc->sc_vc = va->va_vc;
159 1.1 enami sc->sc_iot = va->va_iot;
160 1.1 enami if (bus_space_map(sc->sc_iot, va->va_addr, va->va_size, 0,
161 1.1 enami &sc->sc_ioh)) {
162 1.1 enami printf(": couldn't map io space\n");
163 1.1 enami return;
164 1.1 enami }
165 1.1 enami
166 1.6 takemura sc->sc_ih = vrip_intr_establish(va->va_vc, va->va_unit, 0, IPL_TTY,
167 1.1 enami vrpciu_intr, sc);
168 1.1 enami if (sc->sc_ih == NULL) {
169 1.1 enami printf(": couldn't establish interrupt\n");
170 1.1 enami return;
171 1.1 enami }
172 1.1 enami
173 1.1 enami /* Enable level 2 interrupt */
174 1.1 enami vrip_intr_setmask2(va->va_vc, sc->sc_ih, PCIINT_INT0, 1);
175 1.1 enami
176 1.1 enami printf("\n");
177 1.1 enami
178 1.1 enami #ifdef DEBUG
179 1.1 enami #define DUMP_MAW(sc, name, reg) do { \
180 1.20 chs printf("%s: %s =\t0x%08x\n", device_xname((sc)->sc_dev), \
181 1.1 enami (name), (reg)); \
182 1.1 enami printf("%s:\tIBA/MASK =\t0x%08x/0x%08x (0x%08x - 0x%08x)\n", \
183 1.20 chs device_xname((sc)->sc_dev), \
184 1.1 enami reg & VRPCIU_MAW_IBAMASK, VRPCIU_MAW_ADDRMASK(reg), \
185 1.1 enami VRPCIU_MAW_ADDR(reg), \
186 1.1 enami VRPCIU_MAW_ADDR(reg) + VRPCIU_MAW_SIZE(reg)); \
187 1.20 chs printf("%s:\tWINEN =\t0x%08x\n", device_xname((sc)->sc_dev), \
188 1.1 enami reg & VRPCIU_MAW_WINEN); \
189 1.20 chs printf("%s:\tPCIADR =\t0x%08x\n", device_xname((sc)->sc_dev), \
190 1.1 enami VRPCIU_MAW_PCIADDR(reg)); \
191 1.1 enami } while (0)
192 1.20 chs #define DUMP_TAW(sc, name, reg) do { \
193 1.20 chs printf("%s: %s =\t\t0x%08x\n", device_xname((sc)->sc_dev), \
194 1.20 chs (name), (reg)); \
195 1.20 chs printf("%s:\tMASK =\t0x%08x\n", device_xname((sc)->sc_dev), \
196 1.20 chs VRPCIU_TAW_ADDRMASK(reg)); \
197 1.20 chs printf("%s:\tWINEN =\t0x%08x\n", device_xname((sc)->sc_dev), \
198 1.20 chs reg & VRPCIU_TAW_WINEN); \
199 1.20 chs printf("%s:\tIBA =\t0x%08x\n", device_xname((sc)->sc_dev), \
200 1.20 chs VRPCIU_TAW_IBA(reg)); \
201 1.1 enami } while (0)
202 1.1 enami reg = vrpciu_read(sc, VRPCIU_MMAW1REG);
203 1.1 enami DUMP_MAW(sc, "MMAW1", reg);
204 1.1 enami reg = vrpciu_read(sc, VRPCIU_MMAW2REG);
205 1.1 enami DUMP_MAW(sc, "MMAW2", reg);
206 1.1 enami reg = vrpciu_read(sc, VRPCIU_TAW1REG);
207 1.1 enami DUMP_TAW(sc, "TAW1", reg);
208 1.1 enami reg = vrpciu_read(sc, VRPCIU_TAW2REG);
209 1.1 enami DUMP_TAW(sc, "TAW2", reg);
210 1.1 enami reg = vrpciu_read(sc, VRPCIU_MIOAWREG);
211 1.1 enami DUMP_MAW(sc, "MIOAW", reg);
212 1.20 chs printf("%s: BUSERRAD =\t0x%08x\n", device_xname(sc->sc_dev),
213 1.1 enami vrpciu_read(sc, VRPCIU_BUSERRADREG));
214 1.20 chs printf("%s: INTCNTSTA =\t0x%08x\n", device_xname(sc->sc_dev),
215 1.1 enami vrpciu_read(sc, VRPCIU_INTCNTSTAREG));
216 1.20 chs printf("%s: EXACC =\t0x%08x\n", device_xname(sc->sc_dev),
217 1.1 enami vrpciu_read(sc, VRPCIU_EXACCREG));
218 1.20 chs printf("%s: RECONT =\t0x%08x\n", device_xname(sc->sc_dev),
219 1.1 enami vrpciu_read(sc, VRPCIU_RECONTREG));
220 1.20 chs printf("%s: PCIEN =\t0x%08x\n", device_xname(sc->sc_dev),
221 1.1 enami vrpciu_read(sc, VRPCIU_ENREG));
222 1.20 chs printf("%s: CLOCKSEL =\t0x%08x\n", device_xname(sc->sc_dev),
223 1.1 enami vrpciu_read(sc, VRPCIU_CLKSELREG));
224 1.20 chs printf("%s: TRDYV =\t0x%08x\n", device_xname(sc->sc_dev),
225 1.1 enami vrpciu_read(sc, VRPCIU_TRDYVREG));
226 1.20 chs printf("%s: CLKRUN =\t0x%08x\n", device_xname(sc->sc_dev),
227 1.1 enami vrpciu_read_2(sc, VRPCIU_CLKRUNREG));
228 1.20 chs printf("%s: IDREG =\t0x%08x\n", device_xname(sc->sc_dev),
229 1.1 enami vrpciu_read(sc, VRPCIU_CONF_BASE + PCI_ID_REG));
230 1.1 enami reg = vrpciu_read(sc, VRPCIU_CONF_BASE + PCI_COMMAND_STATUS_REG);
231 1.20 chs printf("%s: CSR =\t\t0x%08x\n", device_xname(sc->sc_dev), reg);
232 1.1 enami vrpciu_write(sc, VRPCIU_CONF_BASE + PCI_COMMAND_STATUS_REG, reg);
233 1.20 chs printf("%s: CSR =\t\t0x%08x\n", device_xname(sc->sc_dev),
234 1.1 enami vrpciu_read(sc, VRPCIU_CONF_BASE + PCI_COMMAND_STATUS_REG));
235 1.20 chs printf("%s: CLASS =\t0x%08x\n", device_xname(sc->sc_dev),
236 1.1 enami vrpciu_read(sc, VRPCIU_CONF_BASE + PCI_CLASS_REG));
237 1.20 chs printf("%s: BHLC =\t\t0x%08x\n", device_xname(sc->sc_dev),
238 1.1 enami vrpciu_read(sc, VRPCIU_CONF_BASE + PCI_BHLC_REG));
239 1.20 chs printf("%s: MAIL =\t\t0x%08x\n", device_xname(sc->sc_dev),
240 1.1 enami vrpciu_read(sc, VRPCIU_CONF_BASE + VRPCIU_CONF_MAILREG));
241 1.20 chs printf("%s: MBA1 =\t\t0x%08x\n", device_xname(sc->sc_dev),
242 1.1 enami vrpciu_read(sc, VRPCIU_CONF_BASE + VRPCIU_CONF_MBA1REG));
243 1.20 chs printf("%s: MBA2 =\t\t0x%08x\n", device_xname(sc->sc_dev),
244 1.1 enami vrpciu_read(sc, VRPCIU_CONF_BASE + VRPCIU_CONF_MBA2REG));
245 1.20 chs printf("%s: INTR =\t\t0x%08x\n", device_xname(sc->sc_dev),
246 1.1 enami vrpciu_read(sc, VRPCIU_CONF_BASE + PCI_INTERRUPT_REG));
247 1.1 enami #if 0
248 1.1 enami vrpciu_write(sc, VRPCIU_CONF_BASE + PCI_INTERRUPT_REG,
249 1.1 enami vrpciu_read(sc, VRPCIU_CONF_BASE + PCI_INTERRUPT_REG) | 0x01);
250 1.20 chs printf("%s: INTR =\t\t0x%08x\n", device_xname(sc->sc_dev),
251 1.1 enami vrpciu_read(sc, VRPCIU_CONF_BASE + PCI_INTERRUPT_REG));
252 1.1 enami #endif
253 1.1 enami #endif
254 1.1 enami
255 1.20 chs pc->pc_dev = sc->sc_dev;
256 1.1 enami pc->pc_attach_hook = vrpciu_attach_hook;
257 1.1 enami pc->pc_bus_maxdevs = vrpciu_bus_maxdevs;
258 1.3 takemura pc->pc_bus_devorder = vrpciu_bus_devorder;
259 1.1 enami pc->pc_make_tag = vrpciu_make_tag;
260 1.1 enami pc->pc_decompose_tag = vrpciu_decompose_tag;
261 1.1 enami pc->pc_conf_read = vrpciu_conf_read;
262 1.1 enami pc->pc_conf_write = vrpciu_conf_write;
263 1.4 takemura pc->pc_intr_map = vrpciu_intr_map;
264 1.4 takemura pc->pc_intr_string = vrpciu_intr_string;
265 1.4 takemura pc->pc_intr_evcnt = vrpciu_intr_evcnt;
266 1.1 enami pc->pc_intr_establish = vrpciu_intr_establish;
267 1.1 enami pc->pc_intr_disestablish = vrpciu_intr_disestablish;
268 1.1 enami
269 1.1 enami #if 0
270 1.1 enami {
271 1.1 enami int i;
272 1.1 enami
273 1.1 enami for (i = 0; i < 8; i++)
274 1.1 enami printf("%s: ID_REG(0, 0, %d) = 0x%08x\n",
275 1.20 chs device_xname(sc->sc_dev), i,
276 1.1 enami pci_conf_read(pc, pci_make_tag(pc, 0, 0, i),
277 1.1 enami PCI_ID_REG));
278 1.1 enami }
279 1.1 enami #endif
280 1.1 enami
281 1.1 enami #if NPCI > 0
282 1.1 enami memset(&pba, 0, sizeof(pba));
283 1.1 enami
284 1.1 enami /* For now, just inherit window mappings set by WinCE. XXX. */
285 1.1 enami
286 1.2 takemura iot = hpcmips_alloc_bus_space_tag();
287 1.1 enami reg = vrpciu_read(sc, VRPCIU_MIOAWREG);
288 1.2 takemura snprintf(tmpbuf, sizeof(tmpbuf), "%s/iot",
289 1.20 chs device_xname(sc->sc_dev));
290 1.2 takemura hpcmips_init_bus_space(iot, (struct bus_space_tag_hpcmips *)sc->sc_iot,
291 1.2 takemura tmpbuf, VRPCIU_MAW_ADDR(reg), VRPCIU_MAW_SIZE(reg));
292 1.2 takemura pba.pba_iot = &iot->bst;
293 1.1 enami
294 1.1 enami /*
295 1.1 enami * Just use system bus space tag. It works since WinCE maps
296 1.1 enami * PCI bus space at same offset. But this isn't right thing
297 1.1 enami * of course. XXX.
298 1.1 enami */
299 1.1 enami pba.pba_memt = sc->sc_iot;
300 1.2 takemura pba.pba_dmat = &hpcmips_default_bus_dma_tag.bdt;
301 1.13 fvdl pba.pba_dmat64 = NULL;
302 1.1 enami pba.pba_bus = 0;
303 1.9 thorpej pba.pba_bridgetag = NULL;
304 1.5 shin
305 1.5 shin if (platid_match(&platid, &platid_mask_MACH_LASER5_L_BOARD)) {
306 1.5 shin /*
307 1.16 abs * fix PCI device configuration for L-Router.
308 1.5 shin */
309 1.5 shin /* change IDE controller to native mode */
310 1.5 shin reg = pci_conf_read(pc, pci_make_tag(pc, 0, 16, 0),
311 1.5 shin PCI_CLASS_REG);
312 1.5 shin reg |= PCIIDE_INTERFACE_PCI(0) << PCI_INTERFACE_SHIFT;
313 1.5 shin reg |= PCIIDE_INTERFACE_PCI(1) << PCI_INTERFACE_SHIFT;
314 1.5 shin pci_conf_write(pc, pci_make_tag(pc, 0, 16, 0), PCI_CLASS_REG,
315 1.5 shin reg);
316 1.5 shin /* fix broken BAR setting of fxp0, fxp1 */
317 1.5 shin pci_conf_write(pc, pci_make_tag(pc, 0, 0, 0), PCI_MAPREG_START,
318 1.5 shin 0x11100000);
319 1.5 shin pci_conf_write(pc, pci_make_tag(pc, 0, 1, 0), PCI_MAPREG_START,
320 1.5 shin 0x11200000);
321 1.5 shin }
322 1.5 shin
323 1.18 dyoung pba.pba_flags = PCI_FLAGS_IO_OKAY | PCI_FLAGS_MEM_OKAY |
324 1.1 enami PCI_FLAGS_MRL_OKAY;
325 1.1 enami pba.pba_pc = pc;
326 1.1 enami
327 1.15 drochner config_found_ia(self, "pcibus", &pba, pcibusprint);
328 1.1 enami #endif
329 1.1 enami }
330 1.1 enami
331 1.1 enami /*
332 1.1 enami * Handle PCI error interrupts.
333 1.1 enami */
334 1.1 enami int
335 1.1 enami vrpciu_intr(void *arg)
336 1.1 enami {
337 1.1 enami struct vrpciu_softc *sc = (struct vrpciu_softc *)arg;
338 1.8 takemura u_int32_t isr, baddr;
339 1.1 enami
340 1.1 enami isr = vrpciu_read(sc, VRPCIU_INTCNTSTAREG);
341 1.8 takemura baddr = vrpciu_read(sc, VRPCIU_BUSERRADREG);
342 1.8 takemura printf("%s: status=0x%08x bad addr=0x%08x\n",
343 1.20 chs device_xname(sc->sc_dev), isr, baddr);
344 1.1 enami return ((isr & 0x0f) ? 1 : 0);
345 1.1 enami }
346 1.1 enami
347 1.1 enami void
348 1.20 chs vrpciu_attach_hook(device_t parent, device_t self,
349 1.1 enami struct pcibus_attach_args *pba)
350 1.1 enami {
351 1.1 enami
352 1.1 enami return;
353 1.1 enami }
354 1.1 enami
355 1.1 enami int
356 1.1 enami vrpciu_bus_maxdevs(pci_chipset_tag_t pc, int busno)
357 1.1 enami {
358 1.1 enami
359 1.1 enami return (32);
360 1.1 enami }
361 1.1 enami
362 1.3 takemura int
363 1.19 dyoung vrpciu_bus_devorder(pci_chipset_tag_t pc, int busno, uint8_t *devs, int maxdevs)
364 1.3 takemura {
365 1.19 dyoung int dev, i, n;
366 1.19 dyoung uint8_t *devn;
367 1.3 takemura char priorities[32];
368 1.3 takemura static pcireg_t ids[] = {
369 1.3 takemura /* these devices should be attached first */
370 1.3 takemura PCI_ID_CODE(PCI_VENDOR_NEC, PCI_PRODUCT_NEC_VRC4173_BCU),
371 1.3 takemura };
372 1.3 takemura
373 1.19 dyoung n = MIN(32, maxdevs);
374 1.19 dyoung if (n <= 0)
375 1.19 dyoung return 0;
376 1.19 dyoung
377 1.19 dyoung devn = devs + n;
378 1.19 dyoung
379 1.3 takemura /* scan PCI devices and check the id table */
380 1.3 takemura memset(priorities, 0, sizeof(priorities));
381 1.3 takemura for (dev = 0; dev < 32; dev++) {
382 1.3 takemura pcireg_t id;
383 1.19 dyoung id = pci_conf_read(pc, pci_make_tag(pc, 0, dev, 0), PCI_ID_REG);
384 1.19 dyoung for (i = 0; i < __arraycount(ids); i++)
385 1.3 takemura if (id == ids[i])
386 1.3 takemura priorities[dev] = 1;
387 1.3 takemura }
388 1.3 takemura
389 1.3 takemura /* fill order array */
390 1.19 dyoung for (i = 1; 0 <= i; i--) {
391 1.19 dyoung for (dev = 0; dev < 32; dev++) {
392 1.19 dyoung if (priorities[dev] == i && devs != devn)
393 1.3 takemura *devs++ = dev;
394 1.19 dyoung }
395 1.19 dyoung }
396 1.3 takemura
397 1.19 dyoung return n;
398 1.3 takemura }
399 1.3 takemura
400 1.1 enami pcitag_t
401 1.1 enami vrpciu_make_tag(pci_chipset_tag_t pc, int bus, int device, int function)
402 1.1 enami {
403 1.1 enami
404 1.1 enami return ((bus << 16) | (device << 11) | (function << 8));
405 1.1 enami }
406 1.1 enami
407 1.1 enami void
408 1.1 enami vrpciu_decompose_tag(pci_chipset_tag_t pc, pcitag_t tag, int *bp, int *dp,
409 1.1 enami int *fp)
410 1.1 enami {
411 1.1 enami
412 1.1 enami if (bp != NULL)
413 1.1 enami *bp = (tag >> 16) & 0xff;
414 1.1 enami if (dp != NULL)
415 1.1 enami *dp = (tag >> 11) & 0x1f;
416 1.1 enami if (fp != NULL)
417 1.1 enami *fp = (tag >> 8) & 0x07;
418 1.1 enami }
419 1.1 enami
420 1.1 enami pcireg_t
421 1.1 enami vrpciu_conf_read(pci_chipset_tag_t pc, pcitag_t tag, int reg)
422 1.1 enami {
423 1.20 chs struct vrpciu_softc *sc = device_private(pc->pc_dev);
424 1.1 enami u_int32_t val;
425 1.1 enami int bus, device, function;
426 1.1 enami
427 1.22 msaitoh if ((unsigned int)reg >= PCI_CONF_SIZE)
428 1.22 msaitoh return ((pcireg_t) -1);
429 1.22 msaitoh
430 1.1 enami pci_decompose_tag(pc, tag, &bus, &device, &function);
431 1.1 enami if (bus == 0) {
432 1.1 enami if (device > 21)
433 1.1 enami return ((pcitag_t)-1);
434 1.1 enami tag = (1 << (device + 11)) | (function << 8); /* Type 0 */
435 1.1 enami } else
436 1.1 enami tag |= VRPCIU_CONF_TYPE1;
437 1.1 enami
438 1.1 enami vrpciu_write(sc, VRPCIU_CONFAREG, tag | reg);
439 1.1 enami val = vrpciu_read(sc, VRPCIU_CONFDREG);
440 1.1 enami #if 0
441 1.1 enami printf("%s: conf_read: tag = 0x%08x, reg = 0x%x, val = 0x%08x\n",
442 1.20 chs device_xname(sc->sc_dev), (u_int32_t)tag, reg, val);
443 1.1 enami #endif
444 1.1 enami return (val);
445 1.1 enami }
446 1.1 enami
447 1.1 enami void
448 1.1 enami vrpciu_conf_write(pci_chipset_tag_t pc, pcitag_t tag, int reg,
449 1.1 enami pcireg_t data)
450 1.1 enami {
451 1.20 chs struct vrpciu_softc *sc = device_private(pc->pc_dev);
452 1.1 enami int bus, device, function;
453 1.1 enami
454 1.1 enami #if 0
455 1.1 enami printf("%s: conf_write: tag = 0x%08x, reg = 0x%x, val = 0x%08x\n",
456 1.20 chs device_xname(sc->sc_dev), (u_int32_t)tag, reg, (u_int32_t)data);
457 1.1 enami #endif
458 1.22 msaitoh
459 1.22 msaitoh if ((unsigned int)reg >= PCI_CONF_SIZE)
460 1.22 msaitoh return;
461 1.22 msaitoh
462 1.1 enami vrpciu_decompose_tag(pc, tag, &bus, &device, &function);
463 1.1 enami if (bus == 0) {
464 1.1 enami if (device > 21)
465 1.1 enami return;
466 1.1 enami tag = (1 << (device + 11)) | (function << 8); /* Type 0 */
467 1.1 enami } else
468 1.1 enami tag |= VRPCIU_CONF_TYPE1;
469 1.1 enami
470 1.1 enami vrpciu_write(sc, VRPCIU_CONFAREG, tag | reg);
471 1.1 enami vrpciu_write(sc, VRPCIU_CONFDREG, data);
472 1.1 enami }
473 1.1 enami
474 1.4 takemura int
475 1.20 chs vrpciu_intr_map(const struct pci_attach_args *pa, pci_intr_handle_t *ihp)
476 1.4 takemura {
477 1.4 takemura pci_chipset_tag_t pc = pa->pa_pc;
478 1.4 takemura pcitag_t intrtag = pa->pa_intrtag;
479 1.4 takemura int bus, dev, func;
480 1.4 takemura #ifdef DEBUG
481 1.4 takemura int line = pa->pa_intrline;
482 1.4 takemura int pin = pa->pa_intrpin;
483 1.4 takemura #endif
484 1.4 takemura
485 1.4 takemura pci_decompose_tag(pc, intrtag, &bus, &dev, &func);
486 1.20 chs DPRINTF(("%s(%d, %d, %d): line = %d, pin = %d\n", device_xname(pc->pc_dev),
487 1.4 takemura bus, dev, func, line, pin));
488 1.4 takemura
489 1.4 takemura *ihp = CONFIG_HOOK_PCIINTR_ID(bus, dev, func);
490 1.4 takemura
491 1.4 takemura return (0);
492 1.4 takemura }
493 1.4 takemura
494 1.4 takemura const char *
495 1.21 christos vrpciu_intr_string(pci_chipset_tag_t pc, pci_intr_handle_t ih, char *buf,
496 1.21 christos size_t len)
497 1.1 enami {
498 1.21 christos snprintf(buf, len, "pciintr %d:%d:%d",
499 1.4 takemura CONFIG_HOOK_PCIINTR_BUS((int)ih),
500 1.4 takemura CONFIG_HOOK_PCIINTR_DEVICE((int)ih),
501 1.4 takemura CONFIG_HOOK_PCIINTR_FUNCTION((int)ih));
502 1.1 enami
503 1.21 christos return buf;
504 1.1 enami }
505 1.1 enami
506 1.4 takemura const struct evcnt *
507 1.4 takemura vrpciu_intr_evcnt(pci_chipset_tag_t pc, pci_intr_handle_t ih)
508 1.1 enami {
509 1.1 enami
510 1.4 takemura /* XXX for now, no evcnt parent reported */
511 1.4 takemura
512 1.4 takemura return (NULL);
513 1.1 enami }
514 1.1 enami
515 1.1 enami void *
516 1.4 takemura vrpciu_intr_establish(pci_chipset_tag_t pc, pci_intr_handle_t ih, int level,
517 1.1 enami int (*func)(void *), void *arg)
518 1.1 enami {
519 1.1 enami
520 1.4 takemura if (ih == -1)
521 1.4 takemura return (NULL);
522 1.7 takemura DPRINTF(("vrpciu_intr_establish: %lx\n", ih));
523 1.3 takemura
524 1.4 takemura return (config_hook(CONFIG_HOOK_PCIINTR, ih, CONFIG_HOOK_EXCLUSIVE,
525 1.4 takemura (int (*)(void *, int, long, void *))func, arg));
526 1.1 enami }
527 1.1 enami
528 1.1 enami void
529 1.4 takemura vrpciu_intr_disestablish(pci_chipset_tag_t pc, void *cookie)
530 1.1 enami {
531 1.1 enami
532 1.7 takemura DPRINTF(("vrpciu_intr_disestablish: %p\n", cookie));
533 1.4 takemura config_unhook(cookie);
534 1.1 enami }
535