Home | History | Annotate | Line # | Download | only in pci
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