pci_machdep.c revision 1.52 1 1.52 dyoung /* $NetBSD: pci_machdep.c,v 1.52 2011/10/18 23:43:36 dyoung Exp $ */
2 1.1 fvdl
3 1.1 fvdl /*-
4 1.1 fvdl * Copyright (c) 1997, 1998 The NetBSD Foundation, Inc.
5 1.1 fvdl * All rights reserved.
6 1.1 fvdl *
7 1.1 fvdl * This code is derived from software contributed to The NetBSD Foundation
8 1.1 fvdl * by Jason R. Thorpe of the Numerical Aerospace Simulation Facility,
9 1.1 fvdl * NASA Ames Research Center.
10 1.1 fvdl *
11 1.1 fvdl * Redistribution and use in source and binary forms, with or without
12 1.1 fvdl * modification, are permitted provided that the following conditions
13 1.1 fvdl * are met:
14 1.1 fvdl * 1. Redistributions of source code must retain the above copyright
15 1.1 fvdl * notice, this list of conditions and the following disclaimer.
16 1.1 fvdl * 2. Redistributions in binary form must reproduce the above copyright
17 1.1 fvdl * notice, this list of conditions and the following disclaimer in the
18 1.1 fvdl * documentation and/or other materials provided with the distribution.
19 1.1 fvdl *
20 1.1 fvdl * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
21 1.1 fvdl * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
22 1.1 fvdl * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
23 1.1 fvdl * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
24 1.1 fvdl * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
25 1.1 fvdl * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
26 1.1 fvdl * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
27 1.1 fvdl * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
28 1.1 fvdl * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
29 1.1 fvdl * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
30 1.1 fvdl * POSSIBILITY OF SUCH DAMAGE.
31 1.1 fvdl */
32 1.1 fvdl
33 1.1 fvdl /*
34 1.1 fvdl * Copyright (c) 1996 Christopher G. Demetriou. All rights reserved.
35 1.1 fvdl * Copyright (c) 1994 Charles M. Hannum. All rights reserved.
36 1.1 fvdl *
37 1.1 fvdl * Redistribution and use in source and binary forms, with or without
38 1.1 fvdl * modification, are permitted provided that the following conditions
39 1.1 fvdl * are met:
40 1.1 fvdl * 1. Redistributions of source code must retain the above copyright
41 1.1 fvdl * notice, this list of conditions and the following disclaimer.
42 1.1 fvdl * 2. Redistributions in binary form must reproduce the above copyright
43 1.1 fvdl * notice, this list of conditions and the following disclaimer in the
44 1.1 fvdl * documentation and/or other materials provided with the distribution.
45 1.1 fvdl * 3. All advertising materials mentioning features or use of this software
46 1.1 fvdl * must display the following acknowledgement:
47 1.1 fvdl * This product includes software developed by Charles M. Hannum.
48 1.1 fvdl * 4. The name of the author may not be used to endorse or promote products
49 1.1 fvdl * derived from this software without specific prior written permission.
50 1.1 fvdl *
51 1.1 fvdl * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
52 1.1 fvdl * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
53 1.1 fvdl * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
54 1.1 fvdl * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
55 1.1 fvdl * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
56 1.1 fvdl * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
57 1.1 fvdl * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
58 1.1 fvdl * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
59 1.1 fvdl * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
60 1.1 fvdl * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
61 1.1 fvdl */
62 1.1 fvdl
63 1.1 fvdl /*
64 1.1 fvdl * Machine-specific functions for PCI autoconfiguration.
65 1.1 fvdl *
66 1.1 fvdl * On PCs, there are two methods of generating PCI configuration cycles.
67 1.1 fvdl * We try to detect the appropriate mechanism for this machine and set
68 1.1 fvdl * up a few function pointers to access the correct method directly.
69 1.1 fvdl *
70 1.1 fvdl * The configuration method can be hard-coded in the config file by
71 1.1 fvdl * using `options PCI_CONF_MODE=N', where `N' is the configuration mode
72 1.1 fvdl * as defined section 3.6.4.1, `Generating Configuration Cycles'.
73 1.1 fvdl */
74 1.1 fvdl
75 1.1 fvdl #include <sys/cdefs.h>
76 1.52 dyoung __KERNEL_RCSID(0, "$NetBSD: pci_machdep.c,v 1.52 2011/10/18 23:43:36 dyoung Exp $");
77 1.1 fvdl
78 1.1 fvdl #include <sys/types.h>
79 1.1 fvdl #include <sys/param.h>
80 1.1 fvdl #include <sys/time.h>
81 1.1 fvdl #include <sys/systm.h>
82 1.1 fvdl #include <sys/errno.h>
83 1.1 fvdl #include <sys/device.h>
84 1.29 ad #include <sys/bus.h>
85 1.42 dyoung #include <sys/cpu.h>
86 1.43 dyoung #include <sys/kmem.h>
87 1.1 fvdl
88 1.1 fvdl #include <uvm/uvm_extern.h>
89 1.1 fvdl
90 1.10 yamt #include <machine/bus_private.h>
91 1.1 fvdl
92 1.1 fvdl #include <machine/pio.h>
93 1.30 ad #include <machine/lock.h>
94 1.1 fvdl
95 1.3 fvdl #include <dev/isa/isareg.h>
96 1.1 fvdl #include <dev/isa/isavar.h>
97 1.1 fvdl #include <dev/pci/pcivar.h>
98 1.1 fvdl #include <dev/pci/pcireg.h>
99 1.43 dyoung #include <dev/pci/pccbbreg.h>
100 1.1 fvdl #include <dev/pci/pcidevs.h>
101 1.52 dyoung #include <dev/pci/genfb_pcivar.h>
102 1.52 dyoung
103 1.52 dyoung #include <dev/wsfb/genfbvar.h>
104 1.52 dyoung #include <arch/x86/include/genfb_machdep.h>
105 1.52 dyoung #include <dev/ic/vgareg.h>
106 1.1 fvdl
107 1.37 jmcneill #include "acpica.h"
108 1.52 dyoung #include "genfb.h"
109 1.52 dyoung #include "isa.h"
110 1.52 dyoung #include "opt_acpi.h"
111 1.52 dyoung #include "opt_ddb.h"
112 1.14 bouyer #include "opt_mpbios.h"
113 1.52 dyoung #include "opt_vga.h"
114 1.52 dyoung #include "pci.h"
115 1.52 dyoung #include "wsdisplay.h"
116 1.52 dyoung
117 1.52 dyoung #ifdef DDB
118 1.52 dyoung #include <machine/db_machdep.h>
119 1.52 dyoung #include <ddb/db_sym.h>
120 1.52 dyoung #include <ddb/db_extern.h>
121 1.52 dyoung #endif
122 1.52 dyoung
123 1.52 dyoung #ifdef VGA_POST
124 1.52 dyoung #include <x86/vga_post.h>
125 1.52 dyoung #endif
126 1.52 dyoung
127 1.52 dyoung #include <machine/autoconf.h>
128 1.52 dyoung #include <machine/bootinfo.h>
129 1.14 bouyer
130 1.14 bouyer #ifdef MPBIOS
131 1.14 bouyer #include <machine/mpbiosvar.h>
132 1.14 bouyer #endif
133 1.14 bouyer
134 1.37 jmcneill #if NACPICA > 0
135 1.14 bouyer #include <machine/mpacpi.h>
136 1.14 bouyer #endif
137 1.14 bouyer
138 1.16 christos #include <machine/mpconfig.h>
139 1.16 christos
140 1.1 fvdl #include "opt_pci_conf_mode.h"
141 1.1 fvdl
142 1.19 jmcneill #ifdef __i386__
143 1.19 jmcneill #include "opt_xbox.h"
144 1.19 jmcneill #ifdef XBOX
145 1.19 jmcneill #include <machine/xbox.h>
146 1.19 jmcneill #endif
147 1.19 jmcneill #endif
148 1.19 jmcneill
149 1.38 dyoung #ifdef PCI_CONF_MODE
150 1.38 dyoung #if (PCI_CONF_MODE == 1) || (PCI_CONF_MODE == 2)
151 1.38 dyoung static int pci_mode = PCI_CONF_MODE;
152 1.38 dyoung #else
153 1.38 dyoung #error Invalid PCI configuration mode.
154 1.38 dyoung #endif
155 1.38 dyoung #else
156 1.38 dyoung static int pci_mode = -1;
157 1.38 dyoung #endif
158 1.1 fvdl
159 1.42 dyoung struct pci_conf_lock {
160 1.42 dyoung uint32_t cl_cpuno; /* 0: unlocked
161 1.42 dyoung * 1 + n: locked by CPU n (0 <= n)
162 1.42 dyoung */
163 1.42 dyoung uint32_t cl_sel; /* the address that's being read. */
164 1.42 dyoung };
165 1.42 dyoung
166 1.42 dyoung static void pci_conf_unlock(struct pci_conf_lock *);
167 1.42 dyoung static uint32_t pci_conf_selector(pcitag_t, int);
168 1.42 dyoung static unsigned int pci_conf_port(pcitag_t, int);
169 1.42 dyoung static void pci_conf_select(uint32_t);
170 1.42 dyoung static void pci_conf_lock(struct pci_conf_lock *, uint32_t);
171 1.11 sekiya static void pci_bridge_hook(pci_chipset_tag_t, pcitag_t, void *);
172 1.11 sekiya struct pci_bridge_hook_arg {
173 1.11 sekiya void (*func)(pci_chipset_tag_t, pcitag_t, void *);
174 1.11 sekiya void *arg;
175 1.11 sekiya };
176 1.11 sekiya
177 1.1 fvdl #define PCI_MODE1_ENABLE 0x80000000UL
178 1.1 fvdl #define PCI_MODE1_ADDRESS_REG 0x0cf8
179 1.1 fvdl #define PCI_MODE1_DATA_REG 0x0cfc
180 1.1 fvdl
181 1.1 fvdl #define PCI_MODE2_ENABLE_REG 0x0cf8
182 1.1 fvdl #define PCI_MODE2_FORWARD_REG 0x0cfa
183 1.1 fvdl
184 1.1 fvdl #define _m1tag(b, d, f) \
185 1.1 fvdl (PCI_MODE1_ENABLE | ((b) << 16) | ((d) << 11) | ((f) << 8))
186 1.1 fvdl #define _qe(bus, dev, fcn, vend, prod) \
187 1.1 fvdl {_m1tag(bus, dev, fcn), PCI_ID_CODE(vend, prod)}
188 1.1 fvdl struct {
189 1.33 cegger uint32_t tag;
190 1.1 fvdl pcireg_t id;
191 1.1 fvdl } pcim1_quirk_tbl[] = {
192 1.1 fvdl _qe(0, 0, 0, PCI_VENDOR_COMPAQ, PCI_PRODUCT_COMPAQ_TRIFLEX1),
193 1.1 fvdl /* XXX Triflex2 not tested */
194 1.1 fvdl _qe(0, 0, 0, PCI_VENDOR_COMPAQ, PCI_PRODUCT_COMPAQ_TRIFLEX2),
195 1.1 fvdl _qe(0, 0, 0, PCI_VENDOR_COMPAQ, PCI_PRODUCT_COMPAQ_TRIFLEX4),
196 1.1 fvdl /* Triton needed for Connectix Virtual PC */
197 1.1 fvdl _qe(0, 0, 0, PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82437FX),
198 1.1 fvdl /* Connectix Virtual PC 5 has a 440BX */
199 1.1 fvdl _qe(0, 0, 0, PCI_VENDOR_INTEL, PCI_PRODUCT_INTEL_82443BX_NOAGP),
200 1.15 soren /* Parallels Desktop for Mac */
201 1.15 soren _qe(0, 2, 0, PCI_VENDOR_PARALLELS, PCI_PRODUCT_PARALLELS_VIDEO),
202 1.15 soren _qe(0, 3, 0, PCI_VENDOR_PARALLELS, PCI_PRODUCT_PARALLELS_TOOLS),
203 1.36 drochner /* SIS 740 */
204 1.36 drochner _qe(0, 0, 0, PCI_VENDOR_SIS, PCI_PRODUCT_SIS_740),
205 1.12 christos /* SIS 741 */
206 1.12 christos _qe(0, 0, 0, PCI_VENDOR_SIS, PCI_PRODUCT_SIS_741),
207 1.1 fvdl {0, 0xffffffff} /* patchable */
208 1.1 fvdl };
209 1.1 fvdl #undef _m1tag
210 1.1 fvdl #undef _id
211 1.1 fvdl #undef _qe
212 1.1 fvdl
213 1.1 fvdl /*
214 1.1 fvdl * PCI doesn't have any special needs; just use the generic versions
215 1.1 fvdl * of these functions.
216 1.1 fvdl */
217 1.1 fvdl struct x86_bus_dma_tag pci_bus_dma_tag = {
218 1.46 christos ._tag_needs_free = 0,
219 1.3 fvdl #if defined(_LP64) || defined(PAE)
220 1.46 christos ._bounce_thresh = PCI32_DMA_BOUNCE_THRESHOLD,
221 1.46 christos ._bounce_alloc_lo = ISA_DMA_BOUNCE_THRESHOLD,
222 1.46 christos ._bounce_alloc_hi = PCI32_DMA_BOUNCE_THRESHOLD,
223 1.3 fvdl #else
224 1.46 christos ._bounce_thresh = 0,
225 1.46 christos ._bounce_alloc_lo = 0,
226 1.46 christos ._bounce_alloc_hi = 0,
227 1.46 christos #endif
228 1.46 christos ._may_bounce = NULL,
229 1.1 fvdl };
230 1.5 fvdl
231 1.5 fvdl #ifdef _LP64
232 1.5 fvdl struct x86_bus_dma_tag pci_bus_dma64_tag = {
233 1.46 christos ._tag_needs_free = 0,
234 1.46 christos ._bounce_thresh = 0,
235 1.46 christos ._bounce_alloc_lo = 0,
236 1.46 christos ._bounce_alloc_hi = 0,
237 1.46 christos ._may_bounce = NULL,
238 1.5 fvdl };
239 1.5 fvdl #endif
240 1.1 fvdl
241 1.42 dyoung static struct pci_conf_lock cl0 = {
242 1.42 dyoung .cl_cpuno = 0UL
243 1.42 dyoung , .cl_sel = 0UL
244 1.42 dyoung };
245 1.42 dyoung
246 1.42 dyoung static struct pci_conf_lock * const cl = &cl0;
247 1.42 dyoung
248 1.52 dyoung #if NGENFB > 0 && NACPICA > 0 && defined(VGA_POST)
249 1.52 dyoung extern int acpi_md_vbios_reset;
250 1.52 dyoung extern int acpi_md_vesa_modenum;
251 1.52 dyoung #endif
252 1.52 dyoung
253 1.52 dyoung static struct genfb_colormap_callback gfb_cb;
254 1.52 dyoung static struct genfb_pmf_callback pmf_cb;
255 1.52 dyoung static struct genfb_mode_callback mode_cb;
256 1.52 dyoung #ifdef VGA_POST
257 1.52 dyoung static struct vga_post *vga_posth = NULL;
258 1.52 dyoung #endif
259 1.52 dyoung
260 1.42 dyoung static void
261 1.42 dyoung pci_conf_lock(struct pci_conf_lock *ocl, uint32_t sel)
262 1.42 dyoung {
263 1.42 dyoung uint32_t cpuno;
264 1.42 dyoung
265 1.42 dyoung KASSERT(sel != 0);
266 1.42 dyoung
267 1.42 dyoung kpreempt_disable();
268 1.42 dyoung cpuno = cpu_number() + 1;
269 1.42 dyoung /* If the kernel enters pci_conf_lock() through an interrupt
270 1.42 dyoung * handler, then the CPU may already hold the lock.
271 1.42 dyoung *
272 1.42 dyoung * If the CPU does not already hold the lock, spin until
273 1.42 dyoung * we can acquire it.
274 1.42 dyoung */
275 1.42 dyoung if (cpuno == cl->cl_cpuno) {
276 1.42 dyoung ocl->cl_cpuno = cpuno;
277 1.42 dyoung } else {
278 1.44 dyoung u_int spins;
279 1.44 dyoung
280 1.42 dyoung ocl->cl_cpuno = 0;
281 1.44 dyoung
282 1.44 dyoung spins = SPINLOCK_BACKOFF_MIN;
283 1.44 dyoung while (atomic_cas_32(&cl->cl_cpuno, 0, cpuno) != 0) {
284 1.44 dyoung SPINLOCK_BACKOFF(spins);
285 1.44 dyoung #ifdef LOCKDEBUG
286 1.44 dyoung if (SPINLOCK_SPINOUT(spins)) {
287 1.44 dyoung panic("%s: cpu %" PRId32
288 1.44 dyoung " spun out waiting for cpu %" PRId32,
289 1.44 dyoung __func__, cpuno, cl->cl_cpuno);
290 1.44 dyoung }
291 1.44 dyoung #endif /* LOCKDEBUG */
292 1.44 dyoung }
293 1.42 dyoung }
294 1.42 dyoung
295 1.42 dyoung /* Only one CPU can be here, so an interlocked atomic_swap(3)
296 1.42 dyoung * is not necessary.
297 1.42 dyoung *
298 1.42 dyoung * Evaluating atomic_cas_32_ni()'s argument, cl->cl_sel,
299 1.42 dyoung * and applying atomic_cas_32_ni() is not an atomic operation,
300 1.42 dyoung * however, any interrupt that, in the middle of the
301 1.42 dyoung * operation, modifies cl->cl_sel, will also restore
302 1.42 dyoung * cl->cl_sel. So cl->cl_sel will have the same value when
303 1.42 dyoung * we apply atomic_cas_32_ni() as when we evaluated it,
304 1.42 dyoung * before.
305 1.42 dyoung */
306 1.42 dyoung ocl->cl_sel = atomic_cas_32_ni(&cl->cl_sel, cl->cl_sel, sel);
307 1.42 dyoung pci_conf_select(sel);
308 1.42 dyoung }
309 1.42 dyoung
310 1.42 dyoung static void
311 1.42 dyoung pci_conf_unlock(struct pci_conf_lock *ocl)
312 1.42 dyoung {
313 1.42 dyoung uint32_t sel;
314 1.42 dyoung
315 1.42 dyoung sel = atomic_cas_32_ni(&cl->cl_sel, cl->cl_sel, ocl->cl_sel);
316 1.42 dyoung pci_conf_select(ocl->cl_sel);
317 1.42 dyoung if (ocl->cl_cpuno != cl->cl_cpuno)
318 1.42 dyoung atomic_cas_32(&cl->cl_cpuno, cl->cl_cpuno, ocl->cl_cpuno);
319 1.42 dyoung kpreempt_enable();
320 1.42 dyoung }
321 1.42 dyoung
322 1.39 dyoung static uint32_t
323 1.39 dyoung pci_conf_selector(pcitag_t tag, int reg)
324 1.39 dyoung {
325 1.39 dyoung static const pcitag_t mode2_mask = {
326 1.39 dyoung .mode2 = {
327 1.39 dyoung .enable = 0xff
328 1.39 dyoung , .forward = 0xff
329 1.39 dyoung }
330 1.39 dyoung };
331 1.39 dyoung
332 1.39 dyoung switch (pci_mode) {
333 1.39 dyoung case 1:
334 1.39 dyoung return tag.mode1 | reg;
335 1.39 dyoung case 2:
336 1.39 dyoung return tag.mode1 & mode2_mask.mode1;
337 1.39 dyoung default:
338 1.39 dyoung panic("%s: mode not configured", __func__);
339 1.39 dyoung }
340 1.39 dyoung }
341 1.39 dyoung
342 1.39 dyoung static unsigned int
343 1.39 dyoung pci_conf_port(pcitag_t tag, int reg)
344 1.39 dyoung {
345 1.39 dyoung switch (pci_mode) {
346 1.39 dyoung case 1:
347 1.39 dyoung return PCI_MODE1_DATA_REG;
348 1.39 dyoung case 2:
349 1.39 dyoung return tag.mode2.port | reg;
350 1.39 dyoung default:
351 1.39 dyoung panic("%s: mode not configured", __func__);
352 1.39 dyoung }
353 1.39 dyoung }
354 1.39 dyoung
355 1.39 dyoung static void
356 1.42 dyoung pci_conf_select(uint32_t sel)
357 1.39 dyoung {
358 1.39 dyoung pcitag_t tag;
359 1.39 dyoung
360 1.39 dyoung switch (pci_mode) {
361 1.39 dyoung case 1:
362 1.42 dyoung outl(PCI_MODE1_ADDRESS_REG, sel);
363 1.39 dyoung return;
364 1.39 dyoung case 2:
365 1.42 dyoung tag.mode1 = sel;
366 1.39 dyoung outb(PCI_MODE2_ENABLE_REG, tag.mode2.enable);
367 1.39 dyoung if (tag.mode2.enable != 0)
368 1.39 dyoung outb(PCI_MODE2_FORWARD_REG, tag.mode2.forward);
369 1.39 dyoung return;
370 1.39 dyoung default:
371 1.39 dyoung panic("%s: mode not configured", __func__);
372 1.39 dyoung }
373 1.39 dyoung }
374 1.39 dyoung
375 1.1 fvdl void
376 1.32 dyoung pci_attach_hook(device_t parent, device_t self, struct pcibus_attach_args *pba)
377 1.1 fvdl {
378 1.1 fvdl
379 1.1 fvdl if (pba->pba_bus == 0)
380 1.26 mjf aprint_normal(": configuration mode %d", pci_mode);
381 1.4 fvdl #ifdef MPBIOS
382 1.4 fvdl mpbios_pci_attach_hook(parent, self, pba);
383 1.4 fvdl #endif
384 1.37 jmcneill #if NACPICA > 0
385 1.4 fvdl mpacpi_pci_attach_hook(parent, self, pba);
386 1.4 fvdl #endif
387 1.1 fvdl }
388 1.1 fvdl
389 1.1 fvdl int
390 1.18 christos pci_bus_maxdevs(pci_chipset_tag_t pc, int busno)
391 1.1 fvdl {
392 1.1 fvdl
393 1.19 jmcneill #if defined(__i386__) && defined(XBOX)
394 1.19 jmcneill /*
395 1.19 jmcneill * Scanning above the first device is fatal on the Microsoft Xbox.
396 1.19 jmcneill * If busno=1, only allow for one device.
397 1.19 jmcneill */
398 1.19 jmcneill if (arch_i386_is_xbox) {
399 1.19 jmcneill if (busno == 1)
400 1.19 jmcneill return 1;
401 1.19 jmcneill else if (busno > 1)
402 1.19 jmcneill return 0;
403 1.19 jmcneill }
404 1.19 jmcneill #endif
405 1.19 jmcneill
406 1.1 fvdl /*
407 1.1 fvdl * Bus number is irrelevant. If Configuration Mechanism 2 is in
408 1.1 fvdl * use, can only have devices 0-15 on any bus. If Configuration
409 1.1 fvdl * Mechanism 1 is in use, can have devices 0-32 (i.e. the `normal'
410 1.1 fvdl * range).
411 1.1 fvdl */
412 1.1 fvdl if (pci_mode == 2)
413 1.1 fvdl return (16);
414 1.1 fvdl else
415 1.1 fvdl return (32);
416 1.1 fvdl }
417 1.1 fvdl
418 1.1 fvdl pcitag_t
419 1.18 christos pci_make_tag(pci_chipset_tag_t pc, int bus, int device, int function)
420 1.1 fvdl {
421 1.47 dyoung pci_chipset_tag_t ipc;
422 1.1 fvdl pcitag_t tag;
423 1.1 fvdl
424 1.47 dyoung for (ipc = pc; ipc != NULL; ipc = ipc->pc_super) {
425 1.47 dyoung if ((ipc->pc_present & PCI_OVERRIDE_MAKE_TAG) == 0)
426 1.47 dyoung continue;
427 1.47 dyoung return (*ipc->pc_ov->ov_make_tag)(ipc->pc_ctx,
428 1.47 dyoung pc, bus, device, function);
429 1.41 dyoung }
430 1.40 dyoung
431 1.1 fvdl switch (pci_mode) {
432 1.1 fvdl case 1:
433 1.38 dyoung if (bus >= 256 || device >= 32 || function >= 8)
434 1.39 dyoung panic("%s: bad request", __func__);
435 1.38 dyoung
436 1.38 dyoung tag.mode1 = PCI_MODE1_ENABLE |
437 1.38 dyoung (bus << 16) | (device << 11) | (function << 8);
438 1.38 dyoung return tag;
439 1.1 fvdl case 2:
440 1.38 dyoung if (bus >= 256 || device >= 16 || function >= 8)
441 1.39 dyoung panic("%s: bad request", __func__);
442 1.38 dyoung
443 1.38 dyoung tag.mode2.port = 0xc000 | (device << 8);
444 1.38 dyoung tag.mode2.enable = 0xf0 | (function << 1);
445 1.38 dyoung tag.mode2.forward = bus;
446 1.38 dyoung return tag;
447 1.1 fvdl default:
448 1.39 dyoung panic("%s: mode not configured", __func__);
449 1.1 fvdl }
450 1.1 fvdl }
451 1.1 fvdl
452 1.1 fvdl void
453 1.18 christos pci_decompose_tag(pci_chipset_tag_t pc, pcitag_t tag,
454 1.17 christos int *bp, int *dp, int *fp)
455 1.1 fvdl {
456 1.47 dyoung pci_chipset_tag_t ipc;
457 1.1 fvdl
458 1.47 dyoung for (ipc = pc; ipc != NULL; ipc = ipc->pc_super) {
459 1.47 dyoung if ((ipc->pc_present & PCI_OVERRIDE_DECOMPOSE_TAG) == 0)
460 1.47 dyoung continue;
461 1.47 dyoung (*ipc->pc_ov->ov_decompose_tag)(ipc->pc_ctx,
462 1.47 dyoung pc, tag, bp, dp, fp);
463 1.47 dyoung return;
464 1.40 dyoung }
465 1.40 dyoung
466 1.1 fvdl switch (pci_mode) {
467 1.1 fvdl case 1:
468 1.38 dyoung if (bp != NULL)
469 1.38 dyoung *bp = (tag.mode1 >> 16) & 0xff;
470 1.38 dyoung if (dp != NULL)
471 1.38 dyoung *dp = (tag.mode1 >> 11) & 0x1f;
472 1.38 dyoung if (fp != NULL)
473 1.38 dyoung *fp = (tag.mode1 >> 8) & 0x7;
474 1.38 dyoung return;
475 1.1 fvdl case 2:
476 1.38 dyoung if (bp != NULL)
477 1.38 dyoung *bp = tag.mode2.forward & 0xff;
478 1.38 dyoung if (dp != NULL)
479 1.38 dyoung *dp = (tag.mode2.port >> 8) & 0xf;
480 1.38 dyoung if (fp != NULL)
481 1.38 dyoung *fp = (tag.mode2.enable >> 1) & 0x7;
482 1.38 dyoung return;
483 1.1 fvdl default:
484 1.39 dyoung panic("%s: mode not configured", __func__);
485 1.1 fvdl }
486 1.1 fvdl }
487 1.1 fvdl
488 1.1 fvdl pcireg_t
489 1.43 dyoung pci_conf_read(pci_chipset_tag_t pc, pcitag_t tag, int reg)
490 1.1 fvdl {
491 1.47 dyoung pci_chipset_tag_t ipc;
492 1.1 fvdl pcireg_t data;
493 1.42 dyoung struct pci_conf_lock ocl;
494 1.1 fvdl
495 1.31 dyoung KASSERT((reg & 0x3) == 0);
496 1.40 dyoung
497 1.47 dyoung for (ipc = pc; ipc != NULL; ipc = ipc->pc_super) {
498 1.47 dyoung if ((ipc->pc_present & PCI_OVERRIDE_CONF_READ) == 0)
499 1.47 dyoung continue;
500 1.47 dyoung return (*ipc->pc_ov->ov_conf_read)(ipc->pc_ctx, pc, tag, reg);
501 1.41 dyoung }
502 1.40 dyoung
503 1.20 jmcneill #if defined(__i386__) && defined(XBOX)
504 1.20 jmcneill if (arch_i386_is_xbox) {
505 1.20 jmcneill int bus, dev, fn;
506 1.20 jmcneill pci_decompose_tag(pc, tag, &bus, &dev, &fn);
507 1.20 jmcneill if (bus == 0 && dev == 0 && (fn == 1 || fn == 2))
508 1.20 jmcneill return (pcireg_t)-1;
509 1.20 jmcneill }
510 1.20 jmcneill #endif
511 1.20 jmcneill
512 1.42 dyoung pci_conf_lock(&ocl, pci_conf_selector(tag, reg));
513 1.39 dyoung data = inl(pci_conf_port(tag, reg));
514 1.42 dyoung pci_conf_unlock(&ocl);
515 1.39 dyoung return data;
516 1.1 fvdl }
517 1.1 fvdl
518 1.1 fvdl void
519 1.43 dyoung pci_conf_write(pci_chipset_tag_t pc, pcitag_t tag, int reg, pcireg_t data)
520 1.1 fvdl {
521 1.47 dyoung pci_chipset_tag_t ipc;
522 1.42 dyoung struct pci_conf_lock ocl;
523 1.1 fvdl
524 1.31 dyoung KASSERT((reg & 0x3) == 0);
525 1.40 dyoung
526 1.47 dyoung for (ipc = pc; ipc != NULL; ipc = ipc->pc_super) {
527 1.47 dyoung if ((ipc->pc_present & PCI_OVERRIDE_CONF_WRITE) == 0)
528 1.47 dyoung continue;
529 1.47 dyoung (*ipc->pc_ov->ov_conf_write)(ipc->pc_ctx, pc, tag, reg,
530 1.47 dyoung data);
531 1.47 dyoung return;
532 1.40 dyoung }
533 1.40 dyoung
534 1.20 jmcneill #if defined(__i386__) && defined(XBOX)
535 1.20 jmcneill if (arch_i386_is_xbox) {
536 1.20 jmcneill int bus, dev, fn;
537 1.20 jmcneill pci_decompose_tag(pc, tag, &bus, &dev, &fn);
538 1.20 jmcneill if (bus == 0 && dev == 0 && (fn == 1 || fn == 2))
539 1.20 jmcneill return;
540 1.20 jmcneill }
541 1.20 jmcneill #endif
542 1.20 jmcneill
543 1.42 dyoung pci_conf_lock(&ocl, pci_conf_selector(tag, reg));
544 1.39 dyoung outl(pci_conf_port(tag, reg), data);
545 1.42 dyoung pci_conf_unlock(&ocl);
546 1.38 dyoung }
547 1.1 fvdl
548 1.38 dyoung void
549 1.38 dyoung pci_mode_set(int mode)
550 1.38 dyoung {
551 1.38 dyoung KASSERT(pci_mode == -1 || pci_mode == mode);
552 1.1 fvdl
553 1.38 dyoung pci_mode = mode;
554 1.1 fvdl }
555 1.1 fvdl
556 1.1 fvdl int
557 1.33 cegger pci_mode_detect(void)
558 1.1 fvdl {
559 1.33 cegger uint32_t sav, val;
560 1.1 fvdl int i;
561 1.1 fvdl pcireg_t idreg;
562 1.1 fvdl
563 1.1 fvdl if (pci_mode != -1)
564 1.1 fvdl return pci_mode;
565 1.1 fvdl
566 1.1 fvdl /*
567 1.1 fvdl * We try to divine which configuration mode the host bridge wants.
568 1.1 fvdl */
569 1.1 fvdl
570 1.1 fvdl sav = inl(PCI_MODE1_ADDRESS_REG);
571 1.1 fvdl
572 1.1 fvdl pci_mode = 1; /* assume this for now */
573 1.1 fvdl /*
574 1.1 fvdl * catch some known buggy implementations of mode 1
575 1.1 fvdl */
576 1.27 dyoung for (i = 0; i < __arraycount(pcim1_quirk_tbl); i++) {
577 1.1 fvdl pcitag_t t;
578 1.1 fvdl
579 1.1 fvdl if (!pcim1_quirk_tbl[i].tag)
580 1.1 fvdl break;
581 1.1 fvdl t.mode1 = pcim1_quirk_tbl[i].tag;
582 1.1 fvdl idreg = pci_conf_read(0, t, PCI_ID_REG); /* needs "pci_mode" */
583 1.1 fvdl if (idreg == pcim1_quirk_tbl[i].id) {
584 1.1 fvdl #ifdef DEBUG
585 1.1 fvdl printf("known mode 1 PCI chipset (%08x)\n",
586 1.1 fvdl idreg);
587 1.1 fvdl #endif
588 1.1 fvdl return (pci_mode);
589 1.1 fvdl }
590 1.1 fvdl }
591 1.1 fvdl
592 1.1 fvdl /*
593 1.1 fvdl * Strong check for standard compliant mode 1:
594 1.1 fvdl * 1. bit 31 ("enable") can be set
595 1.1 fvdl * 2. byte/word access does not affect register
596 1.1 fvdl */
597 1.1 fvdl outl(PCI_MODE1_ADDRESS_REG, PCI_MODE1_ENABLE);
598 1.1 fvdl outb(PCI_MODE1_ADDRESS_REG + 3, 0);
599 1.1 fvdl outw(PCI_MODE1_ADDRESS_REG + 2, 0);
600 1.1 fvdl val = inl(PCI_MODE1_ADDRESS_REG);
601 1.1 fvdl if ((val & 0x80fffffc) != PCI_MODE1_ENABLE) {
602 1.1 fvdl #ifdef DEBUG
603 1.1 fvdl printf("pci_mode_detect: mode 1 enable failed (%x)\n",
604 1.1 fvdl val);
605 1.1 fvdl #endif
606 1.1 fvdl goto not1;
607 1.1 fvdl }
608 1.1 fvdl outl(PCI_MODE1_ADDRESS_REG, 0);
609 1.1 fvdl val = inl(PCI_MODE1_ADDRESS_REG);
610 1.1 fvdl if ((val & 0x80fffffc) != 0)
611 1.1 fvdl goto not1;
612 1.1 fvdl return (pci_mode);
613 1.1 fvdl not1:
614 1.1 fvdl outl(PCI_MODE1_ADDRESS_REG, sav);
615 1.1 fvdl
616 1.1 fvdl /*
617 1.1 fvdl * This mode 2 check is quite weak (and known to give false
618 1.1 fvdl * positives on some Compaq machines).
619 1.1 fvdl * However, this doesn't matter, because this is the
620 1.1 fvdl * last test, and simply no PCI devices will be found if
621 1.1 fvdl * this happens.
622 1.1 fvdl */
623 1.1 fvdl outb(PCI_MODE2_ENABLE_REG, 0);
624 1.1 fvdl outb(PCI_MODE2_FORWARD_REG, 0);
625 1.1 fvdl if (inb(PCI_MODE2_ENABLE_REG) != 0 ||
626 1.1 fvdl inb(PCI_MODE2_FORWARD_REG) != 0)
627 1.1 fvdl goto not2;
628 1.1 fvdl return (pci_mode = 2);
629 1.1 fvdl not2:
630 1.1 fvdl
631 1.1 fvdl return (pci_mode = 0);
632 1.1 fvdl }
633 1.1 fvdl
634 1.1 fvdl /*
635 1.1 fvdl * Determine which flags should be passed to the primary PCI bus's
636 1.1 fvdl * autoconfiguration node. We use this to detect broken chipsets
637 1.1 fvdl * which cannot safely use memory-mapped device access.
638 1.1 fvdl */
639 1.1 fvdl int
640 1.35 cegger pci_bus_flags(void)
641 1.1 fvdl {
642 1.45 dyoung int rval = PCI_FLAGS_IO_OKAY | PCI_FLAGS_MEM_OKAY |
643 1.1 fvdl PCI_FLAGS_MRL_OKAY | PCI_FLAGS_MRM_OKAY | PCI_FLAGS_MWI_OKAY;
644 1.1 fvdl int device, maxndevs;
645 1.1 fvdl pcitag_t tag;
646 1.1 fvdl pcireg_t id;
647 1.1 fvdl
648 1.1 fvdl maxndevs = pci_bus_maxdevs(NULL, 0);
649 1.1 fvdl
650 1.1 fvdl for (device = 0; device < maxndevs; device++) {
651 1.1 fvdl tag = pci_make_tag(NULL, 0, device, 0);
652 1.1 fvdl id = pci_conf_read(NULL, tag, PCI_ID_REG);
653 1.1 fvdl
654 1.1 fvdl /* Invalid vendor ID value? */
655 1.1 fvdl if (PCI_VENDOR(id) == PCI_VENDOR_INVALID)
656 1.1 fvdl continue;
657 1.1 fvdl /* XXX Not invalid, but we've done this ~forever. */
658 1.1 fvdl if (PCI_VENDOR(id) == 0)
659 1.1 fvdl continue;
660 1.1 fvdl
661 1.1 fvdl switch (PCI_VENDOR(id)) {
662 1.1 fvdl case PCI_VENDOR_SIS:
663 1.1 fvdl switch (PCI_PRODUCT(id)) {
664 1.1 fvdl case PCI_PRODUCT_SIS_85C496:
665 1.1 fvdl goto disable_mem;
666 1.1 fvdl }
667 1.1 fvdl break;
668 1.1 fvdl }
669 1.1 fvdl }
670 1.1 fvdl
671 1.1 fvdl return (rval);
672 1.1 fvdl
673 1.1 fvdl disable_mem:
674 1.1 fvdl printf("Warning: broken PCI-Host bridge detected; "
675 1.1 fvdl "disabling memory-mapped access\n");
676 1.45 dyoung rval &= ~(PCI_FLAGS_MEM_OKAY|PCI_FLAGS_MRL_OKAY|PCI_FLAGS_MRM_OKAY|
677 1.1 fvdl PCI_FLAGS_MWI_OKAY);
678 1.1 fvdl return (rval);
679 1.1 fvdl }
680 1.11 sekiya
681 1.11 sekiya void
682 1.11 sekiya pci_device_foreach(pci_chipset_tag_t pc, int maxbus,
683 1.11 sekiya void (*func)(pci_chipset_tag_t, pcitag_t, void *), void *context)
684 1.11 sekiya {
685 1.11 sekiya pci_device_foreach_min(pc, 0, maxbus, func, context);
686 1.11 sekiya }
687 1.11 sekiya
688 1.11 sekiya void
689 1.11 sekiya pci_device_foreach_min(pci_chipset_tag_t pc, int minbus, int maxbus,
690 1.11 sekiya void (*func)(pci_chipset_tag_t, pcitag_t, void *), void *context)
691 1.11 sekiya {
692 1.11 sekiya const struct pci_quirkdata *qd;
693 1.11 sekiya int bus, device, function, maxdevs, nfuncs;
694 1.11 sekiya pcireg_t id, bhlcr;
695 1.11 sekiya pcitag_t tag;
696 1.11 sekiya
697 1.11 sekiya for (bus = minbus; bus <= maxbus; bus++) {
698 1.11 sekiya maxdevs = pci_bus_maxdevs(pc, bus);
699 1.11 sekiya for (device = 0; device < maxdevs; device++) {
700 1.11 sekiya tag = pci_make_tag(pc, bus, device, 0);
701 1.11 sekiya id = pci_conf_read(pc, tag, PCI_ID_REG);
702 1.11 sekiya
703 1.11 sekiya /* Invalid vendor ID value? */
704 1.11 sekiya if (PCI_VENDOR(id) == PCI_VENDOR_INVALID)
705 1.11 sekiya continue;
706 1.11 sekiya /* XXX Not invalid, but we've done this ~forever. */
707 1.11 sekiya if (PCI_VENDOR(id) == 0)
708 1.11 sekiya continue;
709 1.11 sekiya
710 1.11 sekiya qd = pci_lookup_quirkdata(PCI_VENDOR(id),
711 1.11 sekiya PCI_PRODUCT(id));
712 1.11 sekiya
713 1.11 sekiya bhlcr = pci_conf_read(pc, tag, PCI_BHLC_REG);
714 1.11 sekiya if (PCI_HDRTYPE_MULTIFN(bhlcr) ||
715 1.11 sekiya (qd != NULL &&
716 1.11 sekiya (qd->quirks & PCI_QUIRK_MULTIFUNCTION) != 0))
717 1.11 sekiya nfuncs = 8;
718 1.11 sekiya else
719 1.11 sekiya nfuncs = 1;
720 1.11 sekiya
721 1.11 sekiya for (function = 0; function < nfuncs; function++) {
722 1.11 sekiya tag = pci_make_tag(pc, bus, device, function);
723 1.11 sekiya id = pci_conf_read(pc, tag, PCI_ID_REG);
724 1.11 sekiya
725 1.11 sekiya /* Invalid vendor ID value? */
726 1.11 sekiya if (PCI_VENDOR(id) == PCI_VENDOR_INVALID)
727 1.11 sekiya continue;
728 1.11 sekiya /*
729 1.11 sekiya * XXX Not invalid, but we've done this
730 1.11 sekiya * ~forever.
731 1.11 sekiya */
732 1.11 sekiya if (PCI_VENDOR(id) == 0)
733 1.11 sekiya continue;
734 1.11 sekiya (*func)(pc, tag, context);
735 1.11 sekiya }
736 1.11 sekiya }
737 1.11 sekiya }
738 1.11 sekiya }
739 1.11 sekiya
740 1.11 sekiya void
741 1.11 sekiya pci_bridge_foreach(pci_chipset_tag_t pc, int minbus, int maxbus,
742 1.11 sekiya void (*func)(pci_chipset_tag_t, pcitag_t, void *), void *ctx)
743 1.11 sekiya {
744 1.11 sekiya struct pci_bridge_hook_arg bridge_hook;
745 1.11 sekiya
746 1.11 sekiya bridge_hook.func = func;
747 1.11 sekiya bridge_hook.arg = ctx;
748 1.11 sekiya
749 1.11 sekiya pci_device_foreach_min(pc, minbus, maxbus, pci_bridge_hook,
750 1.11 sekiya &bridge_hook);
751 1.11 sekiya }
752 1.11 sekiya
753 1.11 sekiya static void
754 1.11 sekiya pci_bridge_hook(pci_chipset_tag_t pc, pcitag_t tag, void *ctx)
755 1.11 sekiya {
756 1.11 sekiya struct pci_bridge_hook_arg *bridge_hook = (void *)ctx;
757 1.11 sekiya pcireg_t reg;
758 1.11 sekiya
759 1.11 sekiya reg = pci_conf_read(pc, tag, PCI_CLASS_REG);
760 1.11 sekiya if (PCI_CLASS(reg) == PCI_CLASS_BRIDGE &&
761 1.11 sekiya (PCI_SUBCLASS(reg) == PCI_SUBCLASS_BRIDGE_PCI ||
762 1.11 sekiya PCI_SUBCLASS(reg) == PCI_SUBCLASS_BRIDGE_CARDBUS)) {
763 1.11 sekiya (*bridge_hook->func)(pc, tag, bridge_hook->arg);
764 1.11 sekiya }
765 1.11 sekiya }
766 1.43 dyoung
767 1.43 dyoung static const void *
768 1.43 dyoung bit_to_function_pointer(const struct pci_overrides *ov, uint64_t bit)
769 1.43 dyoung {
770 1.43 dyoung switch (bit) {
771 1.43 dyoung case PCI_OVERRIDE_CONF_READ:
772 1.43 dyoung return ov->ov_conf_read;
773 1.43 dyoung case PCI_OVERRIDE_CONF_WRITE:
774 1.43 dyoung return ov->ov_conf_write;
775 1.43 dyoung case PCI_OVERRIDE_INTR_MAP:
776 1.43 dyoung return ov->ov_intr_map;
777 1.43 dyoung case PCI_OVERRIDE_INTR_STRING:
778 1.43 dyoung return ov->ov_intr_string;
779 1.43 dyoung case PCI_OVERRIDE_INTR_EVCNT:
780 1.43 dyoung return ov->ov_intr_evcnt;
781 1.43 dyoung case PCI_OVERRIDE_INTR_ESTABLISH:
782 1.43 dyoung return ov->ov_intr_establish;
783 1.43 dyoung case PCI_OVERRIDE_INTR_DISESTABLISH:
784 1.43 dyoung return ov->ov_intr_disestablish;
785 1.43 dyoung case PCI_OVERRIDE_MAKE_TAG:
786 1.43 dyoung return ov->ov_make_tag;
787 1.43 dyoung case PCI_OVERRIDE_DECOMPOSE_TAG:
788 1.43 dyoung return ov->ov_decompose_tag;
789 1.43 dyoung default:
790 1.43 dyoung return NULL;
791 1.43 dyoung }
792 1.43 dyoung }
793 1.43 dyoung
794 1.43 dyoung void
795 1.43 dyoung pci_chipset_tag_destroy(pci_chipset_tag_t pc)
796 1.43 dyoung {
797 1.43 dyoung kmem_free(pc, sizeof(struct pci_chipset_tag));
798 1.43 dyoung }
799 1.43 dyoung
800 1.43 dyoung int
801 1.43 dyoung pci_chipset_tag_create(pci_chipset_tag_t opc, const uint64_t present,
802 1.43 dyoung const struct pci_overrides *ov, void *ctx, pci_chipset_tag_t *pcp)
803 1.43 dyoung {
804 1.43 dyoung uint64_t bit, bits, nbits;
805 1.43 dyoung pci_chipset_tag_t pc;
806 1.43 dyoung const void *fp;
807 1.43 dyoung
808 1.43 dyoung if (ov == NULL || present == 0)
809 1.43 dyoung return EINVAL;
810 1.43 dyoung
811 1.43 dyoung pc = kmem_alloc(sizeof(struct pci_chipset_tag), KM_SLEEP);
812 1.43 dyoung
813 1.43 dyoung if (pc == NULL)
814 1.43 dyoung return ENOMEM;
815 1.43 dyoung
816 1.43 dyoung pc->pc_super = opc;
817 1.43 dyoung
818 1.43 dyoung for (bits = present; bits != 0; bits = nbits) {
819 1.43 dyoung nbits = bits & (bits - 1);
820 1.43 dyoung bit = nbits ^ bits;
821 1.43 dyoung if ((fp = bit_to_function_pointer(ov, bit)) == NULL) {
822 1.51 dyoung #ifdef DEBUG
823 1.43 dyoung printf("%s: missing bit %" PRIx64 "\n", __func__, bit);
824 1.51 dyoung #endif
825 1.43 dyoung goto einval;
826 1.43 dyoung }
827 1.43 dyoung }
828 1.43 dyoung
829 1.43 dyoung pc->pc_ov = ov;
830 1.43 dyoung pc->pc_present = present;
831 1.43 dyoung pc->pc_ctx = ctx;
832 1.43 dyoung
833 1.43 dyoung *pcp = pc;
834 1.43 dyoung
835 1.43 dyoung return 0;
836 1.43 dyoung einval:
837 1.43 dyoung kmem_free(pc, sizeof(struct pci_chipset_tag));
838 1.43 dyoung return EINVAL;
839 1.43 dyoung }
840 1.52 dyoung
841 1.52 dyoung static void
842 1.52 dyoung x86_genfb_set_mapreg(void *opaque, int index, int r, int g, int b)
843 1.52 dyoung {
844 1.52 dyoung outb(0x3c0 + VGA_DAC_ADDRW, index);
845 1.52 dyoung outb(0x3c0 + VGA_DAC_PALETTE, (uint8_t)r >> 2);
846 1.52 dyoung outb(0x3c0 + VGA_DAC_PALETTE, (uint8_t)g >> 2);
847 1.52 dyoung outb(0x3c0 + VGA_DAC_PALETTE, (uint8_t)b >> 2);
848 1.52 dyoung }
849 1.52 dyoung
850 1.52 dyoung static bool
851 1.52 dyoung x86_genfb_setmode(struct genfb_softc *sc, int newmode)
852 1.52 dyoung {
853 1.52 dyoung #if NGENFB > 0
854 1.52 dyoung static int curmode = WSDISPLAYIO_MODE_EMUL;
855 1.52 dyoung
856 1.52 dyoung switch (newmode) {
857 1.52 dyoung case WSDISPLAYIO_MODE_EMUL:
858 1.52 dyoung x86_genfb_mtrr_init(sc->sc_fboffset,
859 1.52 dyoung sc->sc_height * sc->sc_stride);
860 1.52 dyoung #if NACPICA > 0 && defined(VGA_POST)
861 1.52 dyoung if (curmode != newmode) {
862 1.52 dyoung if (vga_posth != NULL && acpi_md_vesa_modenum != 0) {
863 1.52 dyoung vga_post_set_vbe(vga_posth,
864 1.52 dyoung acpi_md_vesa_modenum);
865 1.52 dyoung }
866 1.52 dyoung }
867 1.52 dyoung #endif
868 1.52 dyoung break;
869 1.52 dyoung }
870 1.52 dyoung
871 1.52 dyoung curmode = newmode;
872 1.52 dyoung #endif
873 1.52 dyoung return true;
874 1.52 dyoung }
875 1.52 dyoung
876 1.52 dyoung static bool
877 1.52 dyoung x86_genfb_suspend(device_t dev, const pmf_qual_t *qual)
878 1.52 dyoung {
879 1.52 dyoung return true;
880 1.52 dyoung }
881 1.52 dyoung
882 1.52 dyoung static bool
883 1.52 dyoung x86_genfb_resume(device_t dev, const pmf_qual_t *qual)
884 1.52 dyoung {
885 1.52 dyoung #if NGENFB > 0
886 1.52 dyoung struct pci_genfb_softc *psc = device_private(dev);
887 1.52 dyoung
888 1.52 dyoung #if NACPICA > 0 && defined(VGA_POST)
889 1.52 dyoung if (vga_posth != NULL && acpi_md_vbios_reset == 2) {
890 1.52 dyoung vga_post_call(vga_posth);
891 1.52 dyoung if (acpi_md_vesa_modenum != 0)
892 1.52 dyoung vga_post_set_vbe(vga_posth, acpi_md_vesa_modenum);
893 1.52 dyoung }
894 1.52 dyoung #endif
895 1.52 dyoung genfb_restore_palette(&psc->sc_gen);
896 1.52 dyoung #endif
897 1.52 dyoung
898 1.52 dyoung return true;
899 1.52 dyoung }
900 1.52 dyoung
901 1.52 dyoung device_t
902 1.52 dyoung device_pci_register(device_t dev, void *aux)
903 1.52 dyoung {
904 1.52 dyoung static bool found_console = false;
905 1.52 dyoung
906 1.52 dyoung device_pci_props_register(dev, aux);
907 1.52 dyoung
908 1.52 dyoung /*
909 1.52 dyoung * Handle network interfaces here, the attachment information is
910 1.52 dyoung * not available driver-independently later.
911 1.52 dyoung *
912 1.52 dyoung * For disks, there is nothing useful available at attach time.
913 1.52 dyoung */
914 1.52 dyoung if (device_class(dev) == DV_IFNET) {
915 1.52 dyoung struct btinfo_netif *bin = lookup_bootinfo(BTINFO_NETIF);
916 1.52 dyoung if (bin == NULL)
917 1.52 dyoung return NULL;
918 1.52 dyoung
919 1.52 dyoung /*
920 1.52 dyoung * We don't check the driver name against the device name
921 1.52 dyoung * passed by the boot ROM. The ROM should stay usable if
922 1.52 dyoung * the driver becomes obsolete. The physical attachment
923 1.52 dyoung * information (checked below) must be sufficient to
924 1.52 dyoung * idenfity the device.
925 1.52 dyoung */
926 1.52 dyoung if (bin->bus == BI_BUS_PCI &&
927 1.52 dyoung device_is_a(device_parent(dev), "pci")) {
928 1.52 dyoung struct pci_attach_args *paa = aux;
929 1.52 dyoung int b, d, f;
930 1.52 dyoung
931 1.52 dyoung /*
932 1.52 dyoung * Calculate BIOS representation of:
933 1.52 dyoung *
934 1.52 dyoung * <bus,device,function>
935 1.52 dyoung *
936 1.52 dyoung * and compare.
937 1.52 dyoung */
938 1.52 dyoung pci_decompose_tag(paa->pa_pc, paa->pa_tag, &b, &d, &f);
939 1.52 dyoung if (bin->addr.tag == ((b << 8) | (d << 3) | f))
940 1.52 dyoung return dev;
941 1.52 dyoung }
942 1.52 dyoung }
943 1.52 dyoung if (device_parent(dev) && device_is_a(device_parent(dev), "pci") &&
944 1.52 dyoung found_console == false) {
945 1.52 dyoung struct btinfo_framebuffer *fbinfo;
946 1.52 dyoung struct pci_attach_args *pa = aux;
947 1.52 dyoung prop_dictionary_t dict;
948 1.52 dyoung
949 1.52 dyoung if (PCI_CLASS(pa->pa_class) == PCI_CLASS_DISPLAY) {
950 1.52 dyoung #if NWSDISPLAY > 0 && NGENFB > 0
951 1.52 dyoung extern struct vcons_screen x86_genfb_console_screen;
952 1.52 dyoung struct rasops_info *ri;
953 1.52 dyoung
954 1.52 dyoung ri = &x86_genfb_console_screen.scr_ri;
955 1.52 dyoung #endif
956 1.52 dyoung
957 1.52 dyoung fbinfo = lookup_bootinfo(BTINFO_FRAMEBUFFER);
958 1.52 dyoung dict = device_properties(dev);
959 1.52 dyoung /*
960 1.52 dyoung * framebuffer drivers other than genfb can work
961 1.52 dyoung * without the address property
962 1.52 dyoung */
963 1.52 dyoung if (fbinfo != NULL) {
964 1.52 dyoung if (fbinfo->physaddr != 0) {
965 1.52 dyoung prop_dictionary_set_uint32(dict, "width",
966 1.52 dyoung fbinfo->width);
967 1.52 dyoung prop_dictionary_set_uint32(dict, "height",
968 1.52 dyoung fbinfo->height);
969 1.52 dyoung prop_dictionary_set_uint8(dict, "depth",
970 1.52 dyoung fbinfo->depth);
971 1.52 dyoung prop_dictionary_set_uint16(dict, "linebytes",
972 1.52 dyoung fbinfo->stride);
973 1.52 dyoung
974 1.52 dyoung prop_dictionary_set_uint64(dict, "address",
975 1.52 dyoung fbinfo->physaddr);
976 1.52 dyoung #if NWSDISPLAY > 0 && NGENFB > 0
977 1.52 dyoung if (ri->ri_bits != NULL) {
978 1.52 dyoung prop_dictionary_set_uint64(dict,
979 1.52 dyoung "virtual_address",
980 1.52 dyoung (vaddr_t)ri->ri_bits);
981 1.52 dyoung }
982 1.52 dyoung #endif
983 1.52 dyoung }
984 1.52 dyoung #if notyet
985 1.52 dyoung prop_dictionary_set_bool(dict, "splash",
986 1.52 dyoung fbinfo->flags & BI_FB_SPLASH ?
987 1.52 dyoung true : false);
988 1.52 dyoung #endif
989 1.52 dyoung if (fbinfo->depth == 8) {
990 1.52 dyoung gfb_cb.gcc_cookie = NULL;
991 1.52 dyoung gfb_cb.gcc_set_mapreg =
992 1.52 dyoung x86_genfb_set_mapreg;
993 1.52 dyoung prop_dictionary_set_uint64(dict,
994 1.52 dyoung "cmap_callback",
995 1.52 dyoung (uint64_t)(uintptr_t)&gfb_cb);
996 1.52 dyoung }
997 1.52 dyoung if (fbinfo->physaddr != 0) {
998 1.52 dyoung mode_cb.gmc_setmode = x86_genfb_setmode;
999 1.52 dyoung prop_dictionary_set_uint64(dict,
1000 1.52 dyoung "mode_callback",
1001 1.52 dyoung (uint64_t)(uintptr_t)&mode_cb);
1002 1.52 dyoung }
1003 1.52 dyoung
1004 1.52 dyoung #if NWSDISPLAY > 0 && NGENFB > 0
1005 1.52 dyoung if (device_is_a(dev, "genfb")) {
1006 1.52 dyoung x86_genfb_set_console_dev(dev);
1007 1.52 dyoung #ifdef DDB
1008 1.52 dyoung db_trap_callback =
1009 1.52 dyoung x86_genfb_ddb_trap_callback;
1010 1.52 dyoung #endif
1011 1.52 dyoung }
1012 1.52 dyoung #endif
1013 1.52 dyoung }
1014 1.52 dyoung prop_dictionary_set_bool(dict, "is_console", true);
1015 1.52 dyoung prop_dictionary_set_bool(dict, "clear-screen", false);
1016 1.52 dyoung #if NWSDISPLAY > 0 && NGENFB > 0
1017 1.52 dyoung prop_dictionary_set_uint16(dict, "cursor-row",
1018 1.52 dyoung x86_genfb_console_screen.scr_ri.ri_crow);
1019 1.52 dyoung #endif
1020 1.52 dyoung #if notyet
1021 1.52 dyoung prop_dictionary_set_bool(dict, "splash",
1022 1.52 dyoung fbinfo->flags & BI_FB_SPLASH ? true : false);
1023 1.52 dyoung #endif
1024 1.52 dyoung pmf_cb.gpc_suspend = x86_genfb_suspend;
1025 1.52 dyoung pmf_cb.gpc_resume = x86_genfb_resume;
1026 1.52 dyoung prop_dictionary_set_uint64(dict,
1027 1.52 dyoung "pmf_callback", (uint64_t)(uintptr_t)&pmf_cb);
1028 1.52 dyoung #ifdef VGA_POST
1029 1.52 dyoung vga_posth = vga_post_init(pa->pa_bus, pa->pa_device,
1030 1.52 dyoung pa->pa_function);
1031 1.52 dyoung #endif
1032 1.52 dyoung found_console = true;
1033 1.52 dyoung return NULL;
1034 1.52 dyoung }
1035 1.52 dyoung }
1036 1.52 dyoung return NULL;
1037 1.52 dyoung }
1038