Home | History | Annotate | Line # | Download | only in pci
genfb_pci.c revision 1.13
      1 /*	$NetBSD: genfb_pci.c,v 1.13 2009/02/15 18:41:49 jmcneill Exp $ */
      2 
      3 /*-
      4  * Copyright (c) 2007 Michael Lorenz
      5  * All rights reserved.
      6  *
      7  * Redistribution and use in source and binary forms, with or without
      8  * modification, are permitted provided that the following conditions
      9  * are met:
     10  * 1. Redistributions of source code must retain the above copyright
     11  *    notice, this list of conditions and the following disclaimer.
     12  * 2. Redistributions in binary form must reproduce the above copyright
     13  *    notice, this list of conditions and the following disclaimer in the
     14  *    documentation and/or other materials provided with the distribution.
     15  *
     16  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     17  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     18  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     19  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     20  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     21  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     22  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     23  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     24  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     25  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     26  * POSSIBILITY OF SUCH DAMAGE.
     27  */
     28 
     29 #include <sys/cdefs.h>
     30 __KERNEL_RCSID(0, "$NetBSD: genfb_pci.c,v 1.13 2009/02/15 18:41:49 jmcneill Exp $");
     31 
     32 #include <sys/param.h>
     33 #include <sys/systm.h>
     34 #include <sys/kernel.h>
     35 #include <sys/device.h>
     36 #include <sys/proc.h>
     37 #include <sys/mutex.h>
     38 #include <sys/ioctl.h>
     39 #include <sys/kernel.h>
     40 #include <sys/systm.h>
     41 #include <sys/kauth.h>
     42 
     43 #include <dev/pci/pcidevs.h>
     44 #include <dev/pci/pcireg.h>
     45 #include <dev/pci/pcivar.h>
     46 #include <dev/pci/pciio.h>
     47 
     48 #include <dev/wsfb/genfbvar.h>
     49 
     50 #include "opt_wsfb.h"
     51 #include "opt_genfb.h"
     52 
     53 #ifdef GENFB_PCI_DEBUG
     54 # define DPRINTF printf
     55 #else
     56 # define DPRINTF while (0) printf
     57 #endif
     58 
     59 struct range {
     60 	bus_addr_t offset;
     61 	bus_size_t size;
     62 	int flags;
     63 };
     64 
     65 struct pci_genfb_softc {
     66 	struct genfb_softc sc_gen;
     67 
     68 	pci_chipset_tag_t sc_pc;
     69 	pcitag_t sc_pcitag;
     70 	bus_space_tag_t sc_memt;
     71 	bus_space_tag_t sc_iot;
     72 	bus_space_handle_t sc_memh;
     73 	pcireg_t sc_bars[9];
     74 	struct range sc_ranges[8];
     75 	int sc_ranges_used;
     76 	int sc_want_wsfb;
     77 };
     78 
     79 static int	pci_genfb_match(struct device *, struct cfdata *, void *);
     80 static void	pci_genfb_attach(struct device *, struct device *, void *);
     81 static int	pci_genfb_ioctl(void *, void *, u_long, void *, int,
     82 		    struct lwp *);
     83 static paddr_t	pci_genfb_mmap(void *, void *, off_t, int);
     84 static int	pci_genfb_borrow(void *, bus_addr_t, bus_space_handle_t *);
     85 static int	pci_genfb_drm_print(void *, const char *);
     86 
     87 CFATTACH_DECL(genfb_pci, sizeof(struct pci_genfb_softc),
     88     pci_genfb_match, pci_genfb_attach, NULL, NULL);
     89 
     90 static int
     91 pci_genfb_match(struct device *parent, struct cfdata *match, void *aux)
     92 {
     93 	struct pci_attach_args *pa = aux;
     94 	int matchlvl = 1;
     95 
     96 	if (genfb_is_console())
     97 		matchlvl = 5;	/* beat VGA */
     98 
     99 	if (PCI_VENDOR(pa->pa_id) == PCI_VENDOR_APPLE &&
    100 	    PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_APPLE_CONTROL)
    101 		return matchlvl;
    102 
    103 	if (PCI_CLASS(pa->pa_class) == PCI_CLASS_DISPLAY)
    104 		return matchlvl;
    105 
    106 	return 0;
    107 }
    108 
    109 static void
    110 pci_genfb_attach(struct device *parent, struct device *self, void *aux)
    111 {
    112 	struct pci_genfb_softc *sc = (struct pci_genfb_softc *)self;
    113 	struct pci_attach_args *pa = aux;
    114 	struct genfb_ops ops;
    115 	int idx, bar, type;
    116 	char devinfo[256];
    117 
    118 	pci_devinfo(pa->pa_id, pa->pa_class, 0, devinfo, sizeof(devinfo));
    119 	printf(": %s\n", devinfo);
    120 
    121 	sc->sc_memt = pa->pa_memt;
    122 	sc->sc_iot = pa->pa_iot;
    123 	sc->sc_pc = pa->pa_pc;
    124 	sc->sc_pcitag = pa->pa_tag;
    125 	sc->sc_want_wsfb = 0;
    126 
    127 	genfb_init(&sc->sc_gen);
    128 
    129 	if ((sc->sc_gen.sc_width == 0) || (sc->sc_gen.sc_fbsize == 0)) {
    130 		aprint_error("%s: bogus parameters, unable to continue\n",
    131 		    device_xname(self));
    132 		return;
    133 	}
    134 
    135 	if (bus_space_map(sc->sc_memt, sc->sc_gen.sc_fboffset,
    136 	    sc->sc_gen.sc_fbsize, BUS_SPACE_MAP_LINEAR, &sc->sc_memh) != 0) {
    137 
    138 		aprint_error_dev(self, "unable to map the framebuffer\n");
    139 		return;
    140 	}
    141 	sc->sc_gen.sc_fbaddr = bus_space_vaddr(sc->sc_memt, sc->sc_memh);
    142 
    143 	/* mmap()able bus ranges */
    144 	idx = 0;
    145 	bar = 0x10;
    146 	while (bar < 0x30) {
    147 
    148 		type = pci_mapreg_type(sc->sc_pc, sc->sc_pcitag, bar);
    149 		if ((type == PCI_MAPREG_TYPE_MEM) ||
    150 		    (type == PCI_MAPREG_TYPE_ROM)) {
    151 
    152 			pci_mapreg_info(sc->sc_pc, sc->sc_pcitag, bar, type,
    153 			    &sc->sc_ranges[idx].offset,
    154 			    &sc->sc_ranges[idx].size,
    155 			    &sc->sc_ranges[idx].flags);
    156 			idx++;
    157 		}
    158 		sc->sc_bars[(bar - 0x10) >> 2] =
    159 		    pci_conf_read(sc->sc_pc, sc->sc_pcitag, bar);
    160 		bar += 4;
    161 	}
    162 	sc->sc_ranges_used = idx;
    163 
    164 	ops.genfb_ioctl = pci_genfb_ioctl;
    165 	ops.genfb_mmap = pci_genfb_mmap;
    166 	ops.genfb_borrow = pci_genfb_borrow;
    167 
    168 	if (genfb_attach(&sc->sc_gen, &ops) == 0) {
    169 
    170 		/* now try to attach a DRM */
    171 		config_found_ia(self, "drm", aux, pci_genfb_drm_print);
    172 	}
    173 }
    174 
    175 static int
    176 pci_genfb_drm_print(void *aux, const char *pnp)
    177 {
    178 	if (pnp)
    179 		aprint_normal("drm at %s", pnp);
    180 	return (UNCONF);
    181 }
    182 
    183 
    184 static int
    185 pci_genfb_ioctl(void *v, void *vs, u_long cmd, void *data, int flag,
    186     struct lwp *l)
    187 {
    188 	struct pci_genfb_softc *sc = v;
    189 
    190 	switch (cmd) {
    191 		case WSDISPLAYIO_GTYPE:
    192 			*(u_int *)data = WSDISPLAY_TYPE_PCIMISC;
    193 			return 0;
    194 
    195 		/* PCI config read/write passthrough. */
    196 		case PCI_IOC_CFGREAD:
    197 		case PCI_IOC_CFGWRITE:
    198 			return (pci_devioctl(sc->sc_pc, sc->sc_pcitag,
    199 			    cmd, data, flag, l));
    200 		case WSDISPLAYIO_SMODE:
    201 			{
    202 				int new_mode = *(int*)data, i;
    203 				if (new_mode == WSDISPLAYIO_MODE_EMUL) {
    204 					for (i = 0; i < 9; i++)
    205 						pci_conf_write(sc->sc_pc,
    206 						     sc->sc_pcitag,
    207 						     0x10 + (i << 2),
    208 						     sc->sc_bars[i]);
    209 				}
    210 			}
    211 			return 0;
    212 	}
    213 
    214 	return EPASSTHROUGH;
    215 }
    216 
    217 static paddr_t
    218 pci_genfb_mmap(void *v, void *vs, off_t offset, int prot)
    219 {
    220 	struct pci_genfb_softc *sc = v;
    221 	struct range *r;
    222 	struct lwp *me;
    223 	int i;
    224 
    225 	if (offset == 0)
    226 		sc->sc_want_wsfb = 1;
    227 
    228 	/*
    229 	 * regular fb mapping at 0
    230 	 * since some Sun firmware likes to put PCI resources low enough
    231 	 * to collide with the wsfb mapping we only allow it after asking
    232 	 * for offset 0
    233 	 */
    234 	DPRINTF("%s: %08x limit %08x\n", __func__, (uint32_t)offset,
    235 	    (uint32_t)sc->sc_gen.sc_fbsize);
    236 	if ((offset >= 0) && (offset < sc->sc_gen.sc_fbsize) &&
    237 	    (sc->sc_want_wsfb == 1)) {
    238 
    239 		return bus_space_mmap(sc->sc_memt, sc->sc_gen.sc_fboffset,
    240 		   offset, prot, BUS_SPACE_MAP_LINEAR);
    241 	}
    242 
    243 	/*
    244 	 * restrict all other mappings to processes with superuser privileges
    245 	 * or the kernel itself
    246 	 */
    247 	me = curlwp;
    248 	if (me != NULL) {
    249 		if (kauth_authorize_generic(me->l_cred, KAUTH_GENERIC_ISSUSER,
    250 		    NULL) != 0) {
    251 			aprint_normal_dev(&sc->sc_gen.sc_dev, "mmap() rejected.\n");
    252 			return -1;
    253 		}
    254 	}
    255 
    256 #ifdef WSFB_FAKE_VGA_FB
    257 	if ((offset >= 0xa0000) && (offset < 0xbffff)) {
    258 
    259 		return bus_space_mmap(sc->sc_memt, sc->sc_gen.sc_fboffset,
    260 		   offset - 0xa0000, prot, BUS_SPACE_MAP_LINEAR);
    261 	}
    262 #endif
    263 
    264 	/*
    265 	 * XXX this should be generalized, let's just
    266 	 * #define PCI_IOAREA_PADDR
    267 	 * #define PCI_IOAREA_OFFSET
    268 	 * #define PCI_IOAREA_SIZE
    269 	 * somewhere in a MD header and compile this code only if all are
    270 	 * present
    271 	 */
    272 #ifdef PCI_MAGIC_IO_RANGE
    273 	/* allow to map our IO space */
    274 	if ((offset >= PCI_MAGIC_IO_RANGE) &&
    275 	    (offset < PCI_MAGIC_IO_RANGE + 0x10000)) {
    276 		return bus_space_mmap(sc->sc_iot, offset - PCI_MAGIC_IO_RANGE,
    277 		    0, prot, BUS_SPACE_MAP_LINEAR);
    278 	}
    279 #endif
    280 
    281 	/* allow to mmap() our BARs */
    282 	/* maybe the ROM BAR too? */
    283 	for (i = 0; i < sc->sc_ranges_used; i++) {
    284 
    285 		r = &sc->sc_ranges[i];
    286 		if ((offset >= r->offset) && (offset < (r->offset + r->size))) {
    287 			return bus_space_mmap(sc->sc_memt, offset, 0, prot,
    288 			    r->flags);
    289 		}
    290 	}
    291 
    292 	return -1;
    293 }
    294 
    295 int
    296 pci_genfb_borrow(void *opaque, bus_addr_t addr, bus_space_handle_t *hdlp)
    297 {
    298 	struct pci_genfb_softc *sc = opaque;
    299 
    300 	if (sc == NULL)
    301 		return 0;
    302 	if (!sc->sc_gen.sc_fboffset)
    303 		return 0;
    304 	if (sc->sc_gen.sc_fboffset != addr)
    305 		return 0;
    306 	*hdlp = sc->sc_memh;
    307 	return 1;
    308 }
    309