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