1 /* 2 * Copyright 2003 José Fonseca. 3 * Copyright 2003 Leif Delgass. 4 * All Rights Reserved. 5 * 6 * Permission is hereby granted, free of charge, to any person obtaining a 7 * copy of this software and associated documentation files (the "Software"), 8 * to deal in the Software without restriction, including without limitation 9 * the rights to use, copy, modify, merge, publish, distribute, sublicense, 10 * and/or sell copies of the Software, and to permit persons to whom the 11 * Software is furnished to do so, subject to the following conditions: 12 * 13 * The above copyright notice and this permission notice (including the next 14 * paragraph) shall be included in all copies or substantial portions of the 15 * Software. 16 * 17 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 18 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 19 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE 20 * AUTHORS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN 21 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION 22 * WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. 23 */ 24 25 #include <linux/pci.h> 26 #include <linux/slab.h> 27 #include <linux/dma-mapping.h> 28 #include <linux/export.h> 29 #include <drm/drmP.h> 30 #include "drm_legacy.h" 31 32 /** 33 * drm_pci_alloc - Allocate a PCI consistent memory block, for DMA. 34 * @dev: DRM device 35 * @size: size of block to allocate 36 * @align: alignment of block 37 * 38 * Return: A handle to the allocated memory block on success or NULL on 39 * failure. 40 */ 41 drm_dma_handle_t *drm_pci_alloc(struct drm_device * dev, size_t size, size_t align) 42 { 43 drm_dma_handle_t *dmah; 44 unsigned long addr; 45 size_t sz; 46 47 /* pci_alloc_consistent only guarantees alignment to the smallest 48 * PAGE_SIZE order which is greater than or equal to the requested size. 49 * Return NULL here for now to make sure nobody tries for larger alignment 50 */ 51 if (align > size) 52 return NULL; 53 54 dmah = kmalloc(sizeof(drm_dma_handle_t), GFP_KERNEL); 55 if (!dmah) 56 return NULL; 57 58 dmah->size = size; 59 dmah->vaddr = dma_alloc_coherent(&dev->pdev->dev, size, &dmah->busaddr, GFP_KERNEL | __GFP_COMP); 60 61 if (dmah->vaddr == NULL) { 62 kfree(dmah); 63 return NULL; 64 } 65 66 memset(dmah->vaddr, 0, size); 67 68 /* XXX - Is virt_to_page() legal for consistent mem? */ 69 /* Reserve */ 70 for (addr = (unsigned long)dmah->vaddr, sz = size; 71 sz > 0; addr += PAGE_SIZE, sz -= PAGE_SIZE) { 72 SetPageReserved(virt_to_page((void *)addr)); 73 } 74 75 return dmah; 76 } 77 78 EXPORT_SYMBOL(drm_pci_alloc); 79 80 /* 81 * Free a PCI consistent memory block without freeing its descriptor. 82 * 83 * This function is for internal use in the Linux-specific DRM core code. 84 */ 85 void __drm_legacy_pci_free(struct drm_device * dev, drm_dma_handle_t * dmah) 86 { 87 unsigned long addr; 88 size_t sz; 89 90 if (dmah->vaddr) { 91 /* XXX - Is virt_to_page() legal for consistent mem? */ 92 /* Unreserve */ 93 for (addr = (unsigned long)dmah->vaddr, sz = dmah->size; 94 sz > 0; addr += PAGE_SIZE, sz -= PAGE_SIZE) { 95 ClearPageReserved(virt_to_page((void *)addr)); 96 } 97 dma_free_coherent(&dev->pdev->dev, dmah->size, dmah->vaddr, 98 dmah->busaddr); 99 } 100 } 101 102 /** 103 * drm_pci_free - Free a PCI consistent memory block 104 * @dev: DRM device 105 * @dmah: handle to memory block 106 */ 107 void drm_pci_free(struct drm_device * dev, drm_dma_handle_t * dmah) 108 { 109 __drm_legacy_pci_free(dev, dmah); 110 kfree(dmah); 111 } 112 113 EXPORT_SYMBOL(drm_pci_free); 114 115 #ifdef CONFIG_PCI 116 117 static int drm_get_pci_domain(struct drm_device *dev) 118 { 119 #ifndef __alpha__ 120 /* For historical reasons, drm_get_pci_domain() is busticated 121 * on most archs and has to remain so for userspace interface 122 * < 1.4, except on alpha which was right from the beginning 123 */ 124 if (dev->if_version < 0x10004) 125 return 0; 126 #endif /* __alpha__ */ 127 128 return pci_domain_nr(dev->pdev->bus); 129 } 130 131 int drm_pci_set_busid(struct drm_device *dev, struct drm_master *master) 132 { 133 master->unique = kasprintf(GFP_KERNEL, "pci:%04x:%02x:%02x.%d", 134 drm_get_pci_domain(dev), 135 dev->pdev->bus->number, 136 PCI_SLOT(dev->pdev->devfn), 137 PCI_FUNC(dev->pdev->devfn)); 138 if (!master->unique) 139 return -ENOMEM; 140 141 master->unique_len = strlen(master->unique); 142 return 0; 143 } 144 EXPORT_SYMBOL(drm_pci_set_busid); 145 146 int drm_pci_set_unique(struct drm_device *dev, 147 struct drm_master *master, 148 struct drm_unique *u) 149 { 150 int domain, bus, slot, func, ret; 151 152 master->unique_len = u->unique_len; 153 master->unique = kmalloc(master->unique_len + 1, GFP_KERNEL); 154 if (!master->unique) { 155 ret = -ENOMEM; 156 goto err; 157 } 158 159 if (copy_from_user(master->unique, u->unique, master->unique_len)) { 160 ret = -EFAULT; 161 goto err; 162 } 163 164 master->unique[master->unique_len] = '\0'; 165 166 /* Return error if the busid submitted doesn't match the device's actual 167 * busid. 168 */ 169 ret = sscanf(master->unique, "PCI:%d:%d:%d", &bus, &slot, &func); 170 if (ret != 3) { 171 ret = -EINVAL; 172 goto err; 173 } 174 175 domain = bus >> 8; 176 bus &= 0xff; 177 178 if ((domain != drm_get_pci_domain(dev)) || 179 (bus != dev->pdev->bus->number) || 180 (slot != PCI_SLOT(dev->pdev->devfn)) || 181 (func != PCI_FUNC(dev->pdev->devfn))) { 182 ret = -EINVAL; 183 goto err; 184 } 185 return 0; 186 err: 187 return ret; 188 } 189 190 static int drm_pci_irq_by_busid(struct drm_device *dev, struct drm_irq_busid *p) 191 { 192 if ((p->busnum >> 8) != drm_get_pci_domain(dev) || 193 (p->busnum & 0xff) != dev->pdev->bus->number || 194 p->devnum != PCI_SLOT(dev->pdev->devfn) || p->funcnum != PCI_FUNC(dev->pdev->devfn)) 195 return -EINVAL; 196 197 p->irq = dev->pdev->irq; 198 199 DRM_DEBUG("%d:%d:%d => IRQ %d\n", p->busnum, p->devnum, p->funcnum, 200 p->irq); 201 return 0; 202 } 203 204 /** 205 * drm_irq_by_busid - Get interrupt from bus ID 206 * @dev: DRM device 207 * @data: IOCTL parameter pointing to a drm_irq_busid structure 208 * @file_priv: DRM file private. 209 * 210 * Finds the PCI device with the specified bus id and gets its IRQ number. 211 * This IOCTL is deprecated, and will now return EINVAL for any busid not equal 212 * to that of the device that this DRM instance attached to. 213 * 214 * Return: 0 on success or a negative error code on failure. 215 */ 216 int drm_irq_by_busid(struct drm_device *dev, void *data, 217 struct drm_file *file_priv) 218 { 219 struct drm_irq_busid *p = data; 220 221 if (drm_core_check_feature(dev, DRIVER_MODESET)) 222 return -EINVAL; 223 224 /* UMS was only ever support on PCI devices. */ 225 if (WARN_ON(!dev->pdev)) 226 return -EINVAL; 227 228 if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ)) 229 return -EINVAL; 230 231 return drm_pci_irq_by_busid(dev, p); 232 } 233 234 static void drm_pci_agp_init(struct drm_device *dev) 235 { 236 if (drm_core_check_feature(dev, DRIVER_USE_AGP)) { 237 if (drm_pci_device_is_agp(dev)) 238 dev->agp = drm_agp_init(dev); 239 if (dev->agp) { 240 dev->agp->agp_mtrr = arch_phys_wc_add( 241 dev->agp->agp_info.aper_base, 242 dev->agp->agp_info.aper_size * 243 1024 * 1024); 244 } 245 } 246 } 247 248 void drm_pci_agp_destroy(struct drm_device *dev) 249 { 250 if (dev->agp) { 251 arch_phys_wc_del(dev->agp->agp_mtrr); 252 drm_agp_clear(dev); 253 kfree(dev->agp); 254 dev->agp = NULL; 255 } 256 } 257 258 /** 259 * drm_get_pci_dev - Register a PCI device with the DRM subsystem 260 * @pdev: PCI device 261 * @ent: entry from the PCI ID table that matches @pdev 262 * @driver: DRM device driver 263 * 264 * Attempt to gets inter module "drm" information. If we are first 265 * then register the character device and inter module information. 266 * Try and register, if we fail to register, backout previous work. 267 * 268 * Return: 0 on success or a negative error code on failure. 269 */ 270 int drm_get_pci_dev(struct pci_dev *pdev, const struct pci_device_id *ent, 271 struct drm_driver *driver) 272 { 273 struct drm_device *dev; 274 int ret; 275 276 DRM_DEBUG("\n"); 277 278 dev = drm_dev_alloc(driver, &pdev->dev); 279 if (!dev) 280 return -ENOMEM; 281 282 ret = pci_enable_device(pdev); 283 if (ret) 284 goto err_free; 285 286 dev->pdev = pdev; 287 #ifdef __alpha__ 288 dev->hose = pdev->sysdata; 289 #endif 290 291 if (drm_core_check_feature(dev, DRIVER_MODESET)) 292 pci_set_drvdata(pdev, dev); 293 294 drm_pci_agp_init(dev); 295 296 ret = drm_dev_register(dev, ent->driver_data); 297 if (ret) 298 goto err_agp; 299 300 DRM_INFO("Initialized %s %d.%d.%d %s for %s on minor %d\n", 301 driver->name, driver->major, driver->minor, driver->patchlevel, 302 driver->date, pci_name(pdev), dev->primary->index); 303 304 /* No locking needed since shadow-attach is single-threaded since it may 305 * only be called from the per-driver module init hook. */ 306 if (!drm_core_check_feature(dev, DRIVER_MODESET)) 307 list_add_tail(&dev->legacy_dev_list, &driver->legacy_dev_list); 308 309 return 0; 310 311 err_agp: 312 drm_pci_agp_destroy(dev); 313 pci_disable_device(pdev); 314 err_free: 315 drm_dev_unref(dev); 316 return ret; 317 } 318 EXPORT_SYMBOL(drm_get_pci_dev); 319 320 /** 321 * drm_pci_init - Register matching PCI devices with the DRM subsystem 322 * @driver: DRM device driver 323 * @pdriver: PCI device driver 324 * 325 * Initializes a drm_device structures, registering the stubs and initializing 326 * the AGP device. 327 * 328 * Return: 0 on success or a negative error code on failure. 329 */ 330 int drm_pci_init(struct drm_driver *driver, struct pci_driver *pdriver) 331 { 332 struct pci_dev *pdev = NULL; 333 const struct pci_device_id *pid; 334 int i; 335 336 DRM_DEBUG("\n"); 337 338 if (driver->driver_features & DRIVER_MODESET) 339 return pci_register_driver(pdriver); 340 341 /* If not using KMS, fall back to stealth mode manual scanning. */ 342 INIT_LIST_HEAD(&driver->legacy_dev_list); 343 for (i = 0; pdriver->id_table[i].vendor != 0; i++) { 344 pid = &pdriver->id_table[i]; 345 346 /* Loop around setting up a DRM device for each PCI device 347 * matching our ID and device class. If we had the internal 348 * function that pci_get_subsys and pci_get_class used, we'd 349 * be able to just pass pid in instead of doing a two-stage 350 * thing. 351 */ 352 pdev = NULL; 353 while ((pdev = 354 pci_get_subsys(pid->vendor, pid->device, pid->subvendor, 355 pid->subdevice, pdev)) != NULL) { 356 if ((pdev->class & pid->class_mask) != pid->class) 357 continue; 358 359 /* stealth mode requires a manual probe */ 360 pci_dev_get(pdev); 361 drm_get_pci_dev(pdev, pid, driver); 362 } 363 } 364 return 0; 365 } 366 367 int drm_pcie_get_speed_cap_mask(struct drm_device *dev, u32 *mask) 368 { 369 struct pci_dev *root; 370 u32 lnkcap, lnkcap2; 371 372 *mask = 0; 373 if (!dev->pdev) 374 return -EINVAL; 375 376 root = dev->pdev->bus->self; 377 378 /* we've been informed via and serverworks don't make the cut */ 379 if (root->vendor == PCI_VENDOR_ID_VIA || 380 root->vendor == PCI_VENDOR_ID_SERVERWORKS) 381 return -EINVAL; 382 383 pcie_capability_read_dword(root, PCI_EXP_LNKCAP, &lnkcap); 384 pcie_capability_read_dword(root, PCI_EXP_LNKCAP2, &lnkcap2); 385 386 if (lnkcap2) { /* PCIe r3.0-compliant */ 387 if (lnkcap2 & PCI_EXP_LNKCAP2_SLS_2_5GB) 388 *mask |= DRM_PCIE_SPEED_25; 389 if (lnkcap2 & PCI_EXP_LNKCAP2_SLS_5_0GB) 390 *mask |= DRM_PCIE_SPEED_50; 391 if (lnkcap2 & PCI_EXP_LNKCAP2_SLS_8_0GB) 392 *mask |= DRM_PCIE_SPEED_80; 393 } else { /* pre-r3.0 */ 394 if (lnkcap & PCI_EXP_LNKCAP_SLS_2_5GB) 395 *mask |= DRM_PCIE_SPEED_25; 396 if (lnkcap & PCI_EXP_LNKCAP_SLS_5_0GB) 397 *mask |= (DRM_PCIE_SPEED_25 | DRM_PCIE_SPEED_50); 398 } 399 400 DRM_INFO("probing gen 2 caps for device %x:%x = %x/%x\n", root->vendor, root->device, lnkcap, lnkcap2); 401 return 0; 402 } 403 EXPORT_SYMBOL(drm_pcie_get_speed_cap_mask); 404 405 #else 406 407 int drm_pci_init(struct drm_driver *driver, struct pci_driver *pdriver) 408 { 409 return -1; 410 } 411 412 void drm_pci_agp_destroy(struct drm_device *dev) {} 413 414 int drm_irq_by_busid(struct drm_device *dev, void *data, 415 struct drm_file *file_priv) 416 { 417 return -EINVAL; 418 } 419 420 int drm_pci_set_unique(struct drm_device *dev, 421 struct drm_master *master, 422 struct drm_unique *u) 423 { 424 return -EINVAL; 425 } 426 #endif 427 428 EXPORT_SYMBOL(drm_pci_init); 429 430 /** 431 * drm_pci_exit - Unregister matching PCI devices from the DRM subsystem 432 * @driver: DRM device driver 433 * @pdriver: PCI device driver 434 * 435 * Unregisters one or more devices matched by a PCI driver from the DRM 436 * subsystem. 437 */ 438 void drm_pci_exit(struct drm_driver *driver, struct pci_driver *pdriver) 439 { 440 struct drm_device *dev, *tmp; 441 DRM_DEBUG("\n"); 442 443 if (driver->driver_features & DRIVER_MODESET) { 444 pci_unregister_driver(pdriver); 445 } else { 446 list_for_each_entry_safe(dev, tmp, &driver->legacy_dev_list, 447 legacy_dev_list) { 448 list_del(&dev->legacy_dev_list); 449 drm_put_dev(dev); 450 } 451 } 452 DRM_INFO("Module unloaded\n"); 453 } 454 EXPORT_SYMBOL(drm_pci_exit); 455