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