radeondrmkmsfb.c revision 1.2
1 /* $NetBSD: radeondrmkmsfb.c,v 1.2 2014/07/25 16:35:43 riastradh Exp $ */ 2 3 /*- 4 * Copyright (c) 2014 The NetBSD Foundation, Inc. 5 * All rights reserved. 6 * 7 * This code is derived from software contributed to The NetBSD Foundation 8 * by Taylor R. Campbell. 9 * 10 * Redistribution and use in source and binary forms, with or without 11 * modification, are permitted provided that the following conditions 12 * are met: 13 * 1. Redistributions of source code must retain the above copyright 14 * notice, this list of conditions and the following disclaimer. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 19 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 29 * POSSIBILITY OF SUCH DAMAGE. 30 */ 31 32 33 #include <sys/cdefs.h> 34 __KERNEL_RCSID(0, "$NetBSD: radeondrmkmsfb.c,v 1.2 2014/07/25 16:35:43 riastradh Exp $"); 35 36 #ifdef _KERNEL_OPT 37 #include "vga.h" 38 #endif 39 40 #include <sys/types.h> 41 #include <sys/device.h> 42 43 #include <dev/pci/pciio.h> 44 #include <dev/pci/pcireg.h> 45 #include <dev/pci/pcivar.h> 46 47 #include <dev/pci/wsdisplay_pci.h> 48 #include <dev/wsfb/genfbvar.h> 49 50 #if NVGA > 0 51 /* 52 * XXX All we really need is vga_is_console from vgavar.h, but the 53 * header files are missing their own dependencies, so we need to 54 * explicitly drag in the other crap. 55 */ 56 #include <dev/ic/mc6845reg.h> 57 #include <dev/ic/pcdisplayvar.h> 58 #include <dev/ic/vgareg.h> 59 #include <dev/ic/vgavar.h> 60 #endif 61 62 #include <drm/drmP.h> 63 #include <drm/drm_fb_helper.h> 64 65 #include <radeon.h> 66 #include "radeon_drv.h" 67 #include "radeon_task.h" 68 #include "radeondrmkmsfb.h" 69 70 struct radeonfb_softc { 71 /* XXX genfb requires the genfb_softc to be first. */ 72 struct genfb_softc sc_genfb; 73 device_t sc_dev; 74 struct radeonfb_attach_args sc_rfa; 75 struct radeon_task sc_setconfig_task; 76 bool sc_scheduled:1; 77 bool sc_attached:1; 78 }; 79 80 static int radeonfb_match(device_t, cfdata_t, void *); 81 static void radeonfb_attach(device_t, device_t, void *); 82 static int radeonfb_detach(device_t, int); 83 84 static void radeonfb_setconfig_task(struct radeon_task *); 85 86 static int radeonfb_genfb_ioctl(void *, void *, unsigned long, void *, 87 int, struct lwp *); 88 static paddr_t radeonfb_genfb_mmap(void *, void *, off_t, int); 89 static int radeonfb_genfb_enable_polling(void *); 90 static int radeonfb_genfb_disable_polling(void *); 91 92 CFATTACH_DECL_NEW(radeondrmkmsfb, sizeof(struct radeonfb_softc), 93 radeonfb_match, radeonfb_attach, radeonfb_detach, NULL); 94 95 static int 96 radeonfb_match(device_t parent, cfdata_t match, void *aux) 97 { 98 99 return 1; 100 } 101 102 static void 103 radeonfb_attach(device_t parent, device_t self, void *aux) 104 { 105 struct radeonfb_softc *const sc = device_private(self); 106 const struct radeonfb_attach_args *const rfa = aux; 107 int error; 108 109 sc->sc_dev = self; 110 sc->sc_rfa = *rfa; 111 sc->sc_scheduled = false; 112 sc->sc_attached = false; 113 114 aprint_naive("\n"); 115 aprint_normal("\n"); 116 117 radeon_task_init(&sc->sc_setconfig_task, &radeonfb_setconfig_task); 118 error = radeon_task_schedule(parent, &sc->sc_setconfig_task); 119 if (error) { 120 aprint_error_dev(self, "failed to schedule mode set: %d\n", 121 error); 122 goto fail0; 123 } 124 sc->sc_scheduled = true; 125 126 /* Success! */ 127 return; 128 129 fail0: return; 130 } 131 132 static int 133 radeonfb_detach(device_t self, int flags) 134 { 135 struct radeonfb_softc *const sc = device_private(self); 136 137 if (sc->sc_scheduled) 138 return EBUSY; 139 140 if (sc->sc_attached) { 141 /* XXX genfb detach? Help? */ 142 sc->sc_attached = false; 143 } 144 145 return 0; 146 } 147 148 static void 149 radeonfb_setconfig_task(struct radeon_task *task) 150 { 151 struct radeonfb_softc *const sc = container_of(task, 152 struct radeonfb_softc, sc_setconfig_task); 153 const prop_dictionary_t dict = device_properties(sc->sc_dev); 154 const struct radeonfb_attach_args *const rfa = &sc->sc_rfa; 155 const struct drm_fb_helper_surface_size *const sizes = 156 &rfa->rfa_fb_sizes; 157 enum { CONS_VGA, CONS_GENFB, CONS_NONE } what_was_cons; 158 static const struct genfb_ops zero_genfb_ops; 159 struct genfb_ops genfb_ops = zero_genfb_ops; 160 int error; 161 162 KASSERT(sc->sc_scheduled); 163 164 /* XXX Ugh... Pass these parameters some other way! */ 165 prop_dictionary_set_uint32(dict, "width", sizes->fb_width); 166 prop_dictionary_set_uint32(dict, "height", sizes->fb_height); 167 prop_dictionary_set_uint8(dict, "depth", sizes->surface_bpp); 168 prop_dictionary_set_uint16(dict, "linebytes", 169 roundup2((sizes->fb_width * howmany(sizes->surface_bpp, 8)), 64)); 170 prop_dictionary_set_uint32(dict, "address", 0); /* XXX >32-bit */ 171 CTASSERT(sizeof(uintptr_t) <= sizeof(uint64_t)); 172 prop_dictionary_set_uint64(dict, "virtual_address", 173 (uint64_t)(uintptr_t)rfa->rfa_fb_ptr); 174 175 /* XXX Whattakludge! */ 176 #if NVGA > 0 177 if (vga_is_console(rfa->rfa_fb_helper->dev->pdev->pd_pa.pa_iot, -1)) { 178 what_was_cons = CONS_VGA; 179 prop_dictionary_set_bool(dict, "is_console", true); 180 vga_cndetach(); 181 } else 182 #endif 183 if (genfb_is_console() && genfb_is_enabled()) { 184 what_was_cons = CONS_GENFB; 185 prop_dictionary_set_bool(dict, "is_console", true); 186 } else { 187 what_was_cons = CONS_NONE; 188 prop_dictionary_set_bool(dict, "is_console", false); 189 } 190 191 sc->sc_genfb.sc_dev = sc->sc_dev; 192 genfb_init(&sc->sc_genfb); 193 genfb_ops.genfb_ioctl = radeonfb_genfb_ioctl; 194 genfb_ops.genfb_mmap = radeonfb_genfb_mmap; 195 genfb_ops.genfb_enable_polling = radeonfb_genfb_enable_polling; 196 genfb_ops.genfb_disable_polling = radeonfb_genfb_disable_polling; 197 198 error = genfb_attach(&sc->sc_genfb, &genfb_ops); 199 if (error) { 200 aprint_error_dev(sc->sc_dev, "failed to attach genfb: %d\n", 201 error); 202 goto fail0; 203 } 204 sc->sc_attached = true; 205 206 drm_fb_helper_set_config(sc->sc_rfa.rfa_fb_helper); 207 208 /* Success! */ 209 sc->sc_scheduled = false; 210 return; 211 212 fail0: /* XXX Restore console... */ 213 switch (what_was_cons) { 214 case CONS_VGA: 215 break; 216 case CONS_GENFB: 217 break; 218 case CONS_NONE: 219 break; 220 default: 221 break; 222 } 223 } 224 225 static int 226 radeonfb_genfb_ioctl(void *v, void *vs, unsigned long cmd, void *data, int flag, 227 struct lwp *l) 228 { 229 struct genfb_softc *const genfb = v; 230 struct radeonfb_softc *const sc = container_of(genfb, 231 struct radeonfb_softc, sc_genfb); 232 struct drm_device *const dev = sc->sc_rfa.rfa_fb_helper->dev; 233 const struct pci_attach_args *const pa = &dev->pdev->pd_pa; 234 235 switch (cmd) { 236 case WSDISPLAYIO_GTYPE: 237 *(unsigned int *)data = WSDISPLAY_TYPE_PCIVGA; 238 return 0; 239 240 /* PCI config read/write passthrough. */ 241 case PCI_IOC_CFGREAD: 242 case PCI_IOC_CFGWRITE: 243 return pci_devioctl(pa->pa_pc, pa->pa_tag, cmd, data, flag, l); 244 245 case WSDISPLAYIO_GET_BUSID: 246 return wsdisplayio_busid_pci(dev->dev, pa->pa_pc, pa->pa_tag, 247 data); 248 249 default: 250 return EPASSTHROUGH; 251 } 252 } 253 254 static paddr_t 255 radeonfb_genfb_mmap(void *v, void *vs, off_t offset, int prot) 256 { 257 struct genfb_softc *const genfb = v; 258 struct radeonfb_softc *const sc = container_of(genfb, 259 struct radeonfb_softc, sc_genfb); 260 struct drm_fb_helper *const helper = sc->sc_rfa.rfa_fb_helper; 261 struct drm_framebuffer *const fb = helper->fb; 262 struct radeon_framebuffer *const rfb = container_of(fb, 263 struct radeon_framebuffer, base); 264 struct drm_gem_object *const gobj = rfb->obj; 265 struct radeon_bo *const rbo = gem_to_radeon_bo(gobj); 266 struct drm_device *const dev = helper->dev; 267 const struct pci_attach_args *const pa = &dev->pdev->pd_pa; 268 unsigned int i; 269 270 if (offset < 0) 271 return -1; 272 273 /* Treat low memory as the framebuffer itself. */ 274 if (offset < genfb->sc_fbsize) { 275 const unsigned num_pages __diagused = rbo->tbo.num_pages; 276 bus_addr_t addr; 277 int flags = 0; 278 279 KASSERT(genfb->sc_fbsize == (num_pages << PAGE_SHIFT)); 280 KASSERT(num_pages == rbo->tbo.ttm->num_pages); 281 addr = page_to_phys(rbo->tbo.ttm->pages[offset >> PAGE_SHIFT]); 282 /* XXX CACHEABLE/ PREFETCHABLE? WC? WB? */ 283 if (ISSET(rbo->tbo.mem.placement, TTM_PL_FLAG_CACHED)) 284 flags |= BUS_SPACE_MAP_PREFETCHABLE; 285 /* 286 * XXX Urk. We assume bus_space_mmap can cope with 287 * normal system RAM addresses. 288 */ 289 return bus_space_mmap(rbo->tbo.bdev->memt, addr, 0, prot, 290 flags); 291 } 292 293 /* XXX Cargo-culted from genfb_pci. */ 294 if (kauth_authorize_machdep(kauth_cred_get(), 295 KAUTH_MACHDEP_UNMANAGEDMEM, NULL, NULL, NULL, NULL) != 0) { 296 aprint_normal_dev(dev->dev, "mmap at %"PRIxMAX" rejected\n", 297 (uintmax_t)offset); 298 return -1; 299 } 300 301 for (i = 0; PCI_BAR(i) <= PCI_MAPREG_ROM; i++) { 302 pcireg_t type; 303 bus_addr_t addr; 304 bus_size_t size; 305 int flags; 306 307 /* Interrogate the BAR. */ 308 if (!pci_mapreg_probe(pa->pa_pc, pa->pa_tag, PCI_BAR(i), 309 &type)) 310 continue; 311 if (PCI_MAPREG_TYPE(type) != PCI_MAPREG_TYPE_MEM) 312 continue; 313 if (pci_mapreg_info(pa->pa_pc, pa->pa_tag, PCI_BAR(i), type, 314 &addr, &size, &flags)) 315 continue; 316 317 /* Try to map it if it's in range. */ 318 if ((addr <= offset) && (offset < (addr + size))) 319 return bus_space_mmap(pa->pa_memt, addr, 320 (offset - addr), prot, flags); 321 322 /* Skip a slot if this was a 64-bit BAR. */ 323 if ((PCI_MAPREG_TYPE(type) == PCI_MAPREG_TYPE_MEM) && 324 (PCI_MAPREG_MEM_TYPE(type) == PCI_MAPREG_MEM_TYPE_64BIT)) 325 i += 1; 326 } 327 328 /* Failure! */ 329 return -1; 330 } 331 332 static int 333 radeonfb_genfb_enable_polling(void *cookie) 334 { 335 struct genfb_softc *const genfb = cookie; 336 struct radeonfb_softc *const sc = container_of(genfb, 337 struct radeonfb_softc, sc_genfb); 338 339 return drm_fb_helper_debug_enter_fb(sc->sc_rfa.rfa_fb_helper); 340 } 341 342 static int 343 radeonfb_genfb_disable_polling(void *cookie) 344 { 345 struct genfb_softc *const genfb = cookie; 346 struct radeonfb_softc *const sc = container_of(genfb, 347 struct radeonfb_softc, sc_genfb); 348 349 return drm_fb_helper_debug_leave_fb(sc->sc_rfa.rfa_fb_helper); 350 } 351
Indexes created Tue Sep 30 10:09:55 GMT 2025