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/drm_pci.h> 30 #include <drm/drmP.h> 31 #include "drm_internal.h" 32 #include "drm_legacy.h" 33 34 /** 35 * drm_pci_alloc - Allocate a PCI consistent memory block, for DMA. 36 * @dev: DRM device 37 * @size: size of block to allocate 38 * @align: alignment of block 39 * 40 * FIXME: This is a needless abstraction of the Linux dma-api and should be 41 * removed. 42 * 43 * Return: A handle to the allocated memory block on success or NULL on 44 * failure. 45 */ 46 drm_dma_handle_t *drm_pci_alloc(struct drm_device * dev, size_t size, size_t align) 47 { 48 drm_dma_handle_t *dmah; 49 unsigned long addr; 50 size_t sz; 51 52 /* pci_alloc_consistent only guarantees alignment to the smallest 53 * PAGE_SIZE order which is greater than or equal to the requested size. 54 * Return NULL here for now to make sure nobody tries for larger alignment 55 */ 56 if (align > size) 57 return NULL; 58 59 dmah = kmalloc(sizeof(drm_dma_handle_t), M_DRM, M_WAITOK | M_NULLOK); 60 if (!dmah) 61 return NULL; 62 63 dmah->size = size; 64 dmah->vaddr = dma_alloc_coherent(&dev->pdev->dev, size, &dmah->busaddr, GFP_KERNEL); 65 66 if (dmah->vaddr == NULL) { 67 kfree(dmah); 68 return NULL; 69 } 70 71 memset(dmah->vaddr, 0, size); 72 73 /* XXX - Is virt_to_page() legal for consistent mem? */ 74 /* Reserve */ 75 for (addr = (unsigned long)dmah->vaddr, sz = size; 76 sz > 0; addr += PAGE_SIZE, sz -= PAGE_SIZE) { 77 #if 0 78 SetPageReserved(virt_to_page((void *)addr)); 79 #endif 80 } 81 82 return dmah; 83 } 84 85 EXPORT_SYMBOL(drm_pci_alloc); 86 87 /* 88 * Free a PCI consistent memory block without freeing its descriptor. 89 * 90 * This function is for internal use in the Linux-specific DRM core code. 91 */ 92 void __drm_legacy_pci_free(struct drm_device * dev, drm_dma_handle_t * dmah) 93 { 94 unsigned long addr; 95 size_t sz; 96 97 if (dmah->vaddr) { 98 /* XXX - Is virt_to_page() legal for consistent mem? */ 99 /* Unreserve */ 100 for (addr = (unsigned long)dmah->vaddr, sz = dmah->size; 101 sz > 0; addr += PAGE_SIZE, sz -= PAGE_SIZE) { 102 #if 0 103 ClearPageReserved(virt_to_page((void *)addr)); 104 #endif 105 } 106 dma_free_coherent(&dev->pdev->dev, dmah->size, dmah->vaddr, 107 dmah->busaddr); 108 } 109 } 110 111 /** 112 * drm_pci_free - Free a PCI consistent memory block 113 * @dev: DRM device 114 * @dmah: handle to memory block 115 * 116 * FIXME: This is a needless abstraction of the Linux dma-api and should be 117 * removed. 118 */ 119 void drm_pci_free(struct drm_device * dev, drm_dma_handle_t * dmah) 120 { 121 __drm_legacy_pci_free(dev, dmah); 122 kfree(dmah); 123 } 124 125 EXPORT_SYMBOL(drm_pci_free); 126 127 #ifdef CONFIG_PCI 128 129 static int drm_get_pci_domain(struct drm_device *dev) 130 { 131 #ifndef __alpha__ 132 /* For historical reasons, drm_get_pci_domain() is busticated 133 * on most archs and has to remain so for userspace interface 134 * < 1.4, except on alpha which was right from the beginning 135 */ 136 if (dev->if_version < 0x10004) 137 return 0; 138 #endif /* __alpha__ */ 139 140 #if 0 141 return pci_domain_nr(dev->pdev->bus); 142 #else 143 return dev->pci_domain; 144 #endif 145 } 146 147 int drm_pci_set_busid(struct drm_device *dev, struct drm_master *master) 148 { 149 master->unique = kasprintf(GFP_KERNEL, "pci:%04x:%02x:%02x.%d", 150 drm_get_pci_domain(dev), 151 dev->pdev->bus->number, 152 PCI_SLOT(dev->pdev->devfn), 153 PCI_FUNC(dev->pdev->devfn)); 154 if (!master->unique) 155 return -ENOMEM; 156 157 master->unique_len = strlen(master->unique); 158 return 0; 159 } 160 EXPORT_SYMBOL(drm_pci_set_busid); 161 162 static int drm_pci_irq_by_busid(struct drm_device *dev, struct drm_irq_busid *p) 163 { 164 if ((p->busnum >> 8) != dev->pci_domain || 165 (p->busnum & 0xff) != dev->pci_bus || 166 p->devnum != dev->pci_slot || p->funcnum != dev->pci_func) 167 return -EINVAL; 168 169 p->irq = dev->pdev->irq; 170 171 DRM_DEBUG("%d:%d:%d => IRQ %d\n", p->busnum, p->devnum, p->funcnum, 172 p->irq); 173 return 0; 174 } 175 176 #ifdef __DragonFly__ 177 int 178 drm_getpciinfo(struct drm_device *dev, void *data, struct drm_file *file_priv) 179 { 180 struct drm_pciinfo *info = data; 181 182 info->domain = 0; 183 info->bus = dev->pci_bus; 184 info->dev = PCI_SLOT(dev->pdev->devfn); 185 info->func = PCI_FUNC(dev->pdev->devfn); 186 info->vendor_id = dev->pdev->vendor; 187 info->device_id = dev->pdev->device; 188 info->subvendor_id = dev->pdev->subsystem_vendor; 189 info->subdevice_id = dev->pdev->subsystem_device; 190 info->revision_id = 0; 191 192 return 0; 193 } 194 #endif 195 196 /** 197 * drm_irq_by_busid - Get interrupt from bus ID 198 * @dev: DRM device 199 * @data: IOCTL parameter pointing to a drm_irq_busid structure 200 * @file_priv: DRM file private. 201 * 202 * Finds the PCI device with the specified bus id and gets its IRQ number. 203 * This IOCTL is deprecated, and will now return EINVAL for any busid not equal 204 * to that of the device that this DRM instance attached to. 205 * 206 * Return: 0 on success or a negative error code on failure. 207 */ 208 int drm_irq_by_busid(struct drm_device *dev, void *data, 209 struct drm_file *file_priv) 210 { 211 struct drm_irq_busid *p = data; 212 213 if (!drm_core_check_feature(dev, DRIVER_LEGACY)) 214 return -EINVAL; 215 216 /* UMS was only ever support on PCI devices. */ 217 if (WARN_ON(!dev->pdev)) 218 return -EINVAL; 219 220 if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ)) 221 return -EINVAL; 222 223 return drm_pci_irq_by_busid(dev, p); 224 } 225 226 /** 227 * drm_get_pci_dev - Register a PCI device with the DRM subsystem 228 * @pdev: PCI device 229 * @ent: entry from the PCI ID table that matches @pdev 230 * @driver: DRM device driver 231 * 232 * Attempt to gets inter module "drm" information. If we are first 233 * then register the character device and inter module information. 234 * Try and register, if we fail to register, backout previous work. 235 * 236 * NOTE: This function is deprecated, please use drm_dev_alloc() and 237 * drm_dev_register() instead and remove your &drm_driver.load callback. 238 * 239 * Return: 0 on success or a negative error code on failure. 240 */ 241 int drm_get_pci_dev(struct pci_dev *pdev, const struct pci_device_id *ent, 242 struct drm_driver *driver) 243 { 244 struct drm_device *dev; 245 int ret; 246 247 DRM_DEBUG("\n"); 248 249 dev = drm_dev_alloc(driver, &pdev->dev); 250 if (IS_ERR(dev)) 251 return PTR_ERR(dev); 252 253 #if 0 254 ret = pci_enable_device(pdev); 255 if (ret) 256 goto err_free; 257 #endif 258 259 dev->pdev = pdev; 260 #ifdef __alpha__ 261 dev->hose = pdev->sysdata; 262 #endif 263 264 if (drm_core_check_feature(dev, DRIVER_MODESET)) 265 pci_set_drvdata(pdev, dev); 266 267 #if 0 268 drm_pci_agp_init(dev); 269 #endif 270 271 ret = drm_dev_register(dev, ent->driver_data); 272 if (ret) 273 goto err_agp; 274 275 /* No locking needed since shadow-attach is single-threaded since it may 276 * only be called from the per-driver module init hook. */ 277 if (drm_core_check_feature(dev, DRIVER_LEGACY)) 278 list_add_tail(&dev->legacy_dev_list, &driver->legacy_dev_list); 279 280 return 0; 281 282 err_agp: 283 #if 0 284 drm_pci_agp_destroy(dev); 285 pci_disable_device(pdev); 286 err_free: 287 drm_dev_unref(dev); 288 #endif 289 return ret; 290 } 291 EXPORT_SYMBOL(drm_get_pci_dev); 292 293 /** 294 * drm_pci_init - Register matching PCI devices with the DRM subsystem 295 * @driver: DRM device driver 296 * @pdriver: PCI device driver 297 * 298 * Initializes a drm_device structures, registering the stubs and initializing 299 * the AGP device. 300 * 301 * NOTE: This function is deprecated. Modern modesetting drm drivers should use 302 * pci_register_driver() directly, this function only provides shadow-binding 303 * support for old legacy drivers on top of that core pci function. 304 * 305 * Return: 0 on success or a negative error code on failure. 306 */ 307 int drm_pci_init(struct drm_driver *driver, struct pci_driver *pdriver) 308 { 309 #if 0 310 struct pci_dev *pdev = NULL; 311 const struct pci_device_id *pid; 312 int i; 313 #endif 314 315 DRM_DEBUG("\n"); 316 317 if (!(driver->driver_features & DRIVER_LEGACY)) 318 return pci_register_driver(pdriver); 319 320 #if 0 321 /* If not using KMS, fall back to stealth mode manual scanning. */ 322 INIT_LIST_HEAD(&driver->legacy_dev_list); 323 for (i = 0; pdriver->id_table[i].vendor != 0; i++) { 324 pid = &pdriver->id_table[i]; 325 326 /* Loop around setting up a DRM device for each PCI device 327 * matching our ID and device class. If we had the internal 328 * function that pci_get_subsys and pci_get_class used, we'd 329 * be able to just pass pid in instead of doing a two-stage 330 * thing. 331 */ 332 pdev = NULL; 333 while ((pdev = 334 pci_get_subsys(pid->vendor, pid->device, pid->subvendor, 335 pid->subdevice, pdev)) != NULL) { 336 if ((pdev->class & pid->class_mask) != pid->class) 337 continue; 338 339 /* stealth mode requires a manual probe */ 340 pci_dev_get(pdev); 341 drm_get_pci_dev(pdev, pid, driver); 342 } 343 } 344 #endif 345 return 0; 346 } 347 348 int drm_pcie_get_speed_cap_mask(struct drm_device *dev, u32 *mask) 349 { 350 device_t root; 351 int pos; 352 u32 lnkcap = 0, lnkcap2 = 0; 353 354 *mask = 0; 355 if (!dev->pdev) 356 return -EINVAL; 357 358 root = device_get_parent(dev->dev->bsddev); 359 360 /* we've been informed via and serverworks don't make the cut */ 361 if (pci_get_vendor(root) == PCI_VENDOR_ID_VIA || 362 pci_get_vendor(root) == PCI_VENDOR_ID_SERVERWORKS) 363 return -EINVAL; 364 365 pos = 0; 366 pci_find_extcap(root, PCIY_EXPRESS, &pos); 367 if (!pos) 368 return -EINVAL; 369 370 lnkcap = pci_read_config(root, pos + PCIER_LINKCAP, 4); 371 lnkcap2 = pci_read_config(root, pos + PCIER_LINK_CAP2, 4); 372 373 lnkcap &= PCIEM_LNKCAP_SPEED_MASK; 374 lnkcap2 &= 0xfe; 375 376 #define PCI_EXP_LNKCAP_SLS_2_5GB PCIEM_LNKCAP_SPEED_2_5 377 #define PCI_EXP_LNKCAP_SLS_5_0GB PCIEM_LNKCAP_SPEED_5 378 #define PCI_EXP_LNKCAP2_SLS_2_5GB 0x02 /* Supported Link Speed 2.5GT/s */ 379 #define PCI_EXP_LNKCAP2_SLS_5_0GB 0x04 /* Supported Link Speed 5.0GT/s */ 380 #define PCI_EXP_LNKCAP2_SLS_8_0GB 0x08 /* Supported Link Speed 8.0GT/s */ 381 382 if (lnkcap2) { /* PCIe r3.0-compliant */ 383 if (lnkcap2 & PCI_EXP_LNKCAP2_SLS_2_5GB) 384 *mask |= DRM_PCIE_SPEED_25; 385 if (lnkcap2 & PCI_EXP_LNKCAP2_SLS_5_0GB) 386 *mask |= DRM_PCIE_SPEED_50; 387 if (lnkcap2 & PCI_EXP_LNKCAP2_SLS_8_0GB) 388 *mask |= DRM_PCIE_SPEED_80; 389 } else { /* pre-r3.0 */ 390 if (lnkcap & PCI_EXP_LNKCAP_SLS_2_5GB) 391 *mask |= DRM_PCIE_SPEED_25; 392 if (lnkcap & PCI_EXP_LNKCAP_SLS_5_0GB) 393 *mask |= (DRM_PCIE_SPEED_25 | DRM_PCIE_SPEED_50); 394 } 395 396 DRM_INFO("probing gen 2 caps for device %x:%x = %x/%x\n", pci_get_vendor(root), pci_get_device(root), lnkcap, lnkcap2); 397 return 0; 398 } 399 EXPORT_SYMBOL(drm_pcie_get_speed_cap_mask); 400 401 static int 402 pcie_capability_read_dword(struct pci_dev *dev, int pos, u32 *dst) 403 { 404 if (pos & 3) 405 return -EINVAL; 406 407 if (!pcie_capability_reg_implemented(dev, pos)) 408 return -EINVAL; 409 410 return pci_read_config_dword(dev, pci_pcie_cap(dev) + pos, dst); 411 } 412 413 int drm_pcie_get_max_link_width(struct drm_device *dev, u32 *mlw) 414 { 415 struct pci_dev *root; 416 u32 lnkcap = 0; 417 418 *mlw = 0; 419 if (!dev->pdev) 420 return -EINVAL; 421 422 root = dev->pdev->bus->self; 423 424 pcie_capability_read_dword(root, PCI_EXP_LNKCAP, &lnkcap); 425 426 *mlw = (lnkcap & PCI_EXP_LNKCAP_MLW) >> 4; 427 428 DRM_INFO("probing mlw for device %x:%x = %x\n", root->vendor, root->device, lnkcap); 429 return 0; 430 } 431 EXPORT_SYMBOL(drm_pcie_get_max_link_width); 432 433 #else 434 435 436 int drm_pci_init(struct drm_driver *driver, struct pci_driver *pdriver) 437 { 438 return -1; 439 } 440 441 void drm_pci_agp_destroy(struct drm_device *dev) {} 442 443 int drm_irq_by_busid(struct drm_device *dev, void *data, 444 struct drm_file *file_priv) 445 { 446 return -EINVAL; 447 } 448 #endif 449 450 EXPORT_SYMBOL(drm_pci_init); 451 452 /** 453 * drm_pci_exit - Unregister matching PCI devices from the DRM subsystem 454 * @driver: DRM device driver 455 * @pdriver: PCI device driver 456 * 457 * Unregisters one or more devices matched by a PCI driver from the DRM 458 * subsystem. 459 * 460 * NOTE: This function is deprecated. Modern modesetting drm drivers should use 461 * pci_unregister_driver() directly, this function only provides shadow-binding 462 * support for old legacy drivers on top of that core pci function. 463 */ 464 void drm_pci_exit(struct drm_driver *driver, struct pci_driver *pdriver) 465 { 466 struct drm_device *dev, *tmp; 467 DRM_DEBUG("\n"); 468 469 if (!(driver->driver_features & DRIVER_LEGACY)) { 470 pci_unregister_driver(pdriver); 471 } else { 472 list_for_each_entry_safe(dev, tmp, &driver->legacy_dev_list, 473 legacy_dev_list) { 474 list_del(&dev->legacy_dev_list); 475 #if 0 476 drm_put_dev(dev); 477 #endif 478 } 479 } 480 DRM_INFO("Module unloaded\n"); 481 } 482 EXPORT_SYMBOL(drm_pci_exit); 483