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 */
drm_pci_alloc(struct drm_device * dev,size_t size,size_t align)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, GFP_KERNEL);
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 */
__drm_legacy_pci_free(struct drm_device * dev,drm_dma_handle_t * dmah)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 */
drm_pci_free(struct drm_device * dev,drm_dma_handle_t * dmah)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
drm_get_pci_domain(struct drm_device * dev)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
drm_pci_set_busid(struct drm_device * dev,struct drm_master * master)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
drm_pci_irq_by_busid(struct drm_device * dev,struct drm_irq_busid * p)161 static int drm_pci_irq_by_busid(struct drm_device *dev, struct drm_irq_busid *p)
162 {
163 if ((p->busnum >> 8) != drm_get_pci_domain(dev) ||
164 (p->busnum & 0xff) != dev->pdev->bus->number ||
165 p->devnum != PCI_SLOT(dev->pdev->devfn) || p->funcnum != PCI_FUNC(dev->pdev->devfn))
166 return -EINVAL;
167
168 p->irq = dev->pdev->irq;
169
170 DRM_DEBUG("%d:%d:%d => IRQ %d\n", p->busnum, p->devnum, p->funcnum,
171 p->irq);
172 return 0;
173 }
174
175 /**
176 * drm_irq_by_busid - Get interrupt from bus ID
177 * @dev: DRM device
178 * @data: IOCTL parameter pointing to a drm_irq_busid structure
179 * @file_priv: DRM file private.
180 *
181 * Finds the PCI device with the specified bus id and gets its IRQ number.
182 * This IOCTL is deprecated, and will now return EINVAL for any busid not equal
183 * to that of the device that this DRM instance attached to.
184 *
185 * Return: 0 on success or a negative error code on failure.
186 */
drm_irq_by_busid(struct drm_device * dev,void * data,struct drm_file * file_priv)187 int drm_irq_by_busid(struct drm_device *dev, void *data,
188 struct drm_file *file_priv)
189 {
190 struct drm_irq_busid *p = data;
191
192 if (!drm_core_check_feature(dev, DRIVER_LEGACY))
193 return -EINVAL;
194
195 /* UMS was only ever support on PCI devices. */
196 if (WARN_ON(!dev->pdev))
197 return -EINVAL;
198
199 if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
200 return -EINVAL;
201
202 return drm_pci_irq_by_busid(dev, p);
203 }
204
205 #ifdef __DragonFly__
206 int
drm_getpciinfo(struct drm_device * dev,void * data,struct drm_file * file_priv)207 drm_getpciinfo(struct drm_device *dev, void *data, struct drm_file *file_priv)
208 {
209 struct drm_pciinfo *info = data;
210
211 info->domain = 0;
212 info->bus = dev->pci_bus;
213 info->dev = PCI_SLOT(dev->pdev->devfn);
214 info->func = PCI_FUNC(dev->pdev->devfn);
215 info->vendor_id = dev->pdev->vendor;
216 info->device_id = dev->pdev->device;
217 info->subvendor_id = dev->pdev->subsystem_vendor;
218 info->subdevice_id = dev->pdev->subsystem_device;
219 info->revision_id = 0;
220
221 return 0;
222 }
223 #endif
224
225 /**
226 * drm_get_pci_dev - Register a PCI device with the DRM subsystem
227 * @pdev: PCI device
228 * @ent: entry from the PCI ID table that matches @pdev
229 * @driver: DRM device driver
230 *
231 * Attempt to gets inter module "drm" information. If we are first
232 * then register the character device and inter module information.
233 * Try and register, if we fail to register, backout previous work.
234 *
235 * NOTE: This function is deprecated, please use drm_dev_alloc() and
236 * drm_dev_register() instead and remove your &drm_driver.load callback.
237 *
238 * Return: 0 on success or a negative error code on failure.
239 */
drm_get_pci_dev(struct pci_dev * pdev,const struct pci_device_id * ent,struct drm_driver * driver)240 int drm_get_pci_dev(struct pci_dev *pdev, const struct pci_device_id *ent,
241 struct drm_driver *driver)
242 {
243 struct drm_device *dev;
244 int ret;
245
246 DRM_DEBUG("\n");
247
248 dev = drm_dev_alloc(driver, &pdev->dev);
249 if (IS_ERR(dev))
250 return PTR_ERR(dev);
251
252 #if 0
253 ret = pci_enable_device(pdev);
254 if (ret)
255 goto err_free;
256 #endif
257
258 dev->pdev = pdev;
259 #ifdef __alpha__
260 dev->hose = pdev->sysdata;
261 #endif
262
263 if (drm_core_check_feature(dev, DRIVER_MODESET))
264 pci_set_drvdata(pdev, dev);
265
266 #if 0
267 drm_pci_agp_init(dev);
268 #endif
269
270 ret = drm_dev_register(dev, ent->driver_data);
271 if (ret)
272 goto err_agp;
273
274 /* No locking needed since shadow-attach is single-threaded since it may
275 * only be called from the per-driver module init hook. */
276 if (drm_core_check_feature(dev, DRIVER_LEGACY))
277 list_add_tail(&dev->legacy_dev_list, &driver->legacy_dev_list);
278
279 return 0;
280
281 err_agp:
282 #if 0
283 drm_pci_agp_destroy(dev);
284 pci_disable_device(pdev);
285 err_free:
286 drm_dev_unref(dev);
287 #endif
288 return ret;
289 }
290 EXPORT_SYMBOL(drm_get_pci_dev);
291
292 /**
293 * drm_legacy_pci_init - shadow-attach a legacy DRM PCI driver
294 * @driver: DRM device driver
295 * @pdriver: PCI device driver
296 *
297 * This is only used by legacy dri1 drivers and deprecated.
298 *
299 * Return: 0 on success or a negative error code on failure.
300 */
drm_legacy_pci_init(struct drm_driver * driver,struct pci_driver * pdriver)301 int drm_legacy_pci_init(struct drm_driver *driver, struct pci_driver *pdriver)
302 {
303 #if 0
304 struct pci_dev *pdev = NULL;
305 const struct pci_device_id *pid;
306 int i;
307 #endif
308
309 DRM_DEBUG("\n");
310
311 if (WARN_ON(!(driver->driver_features & DRIVER_LEGACY)))
312 return -EINVAL;
313
314 #if 0
315 /* If not using KMS, fall back to stealth mode manual scanning. */
316 INIT_LIST_HEAD(&driver->legacy_dev_list);
317 for (i = 0; pdriver->id_table[i].vendor != 0; i++) {
318 pid = &pdriver->id_table[i];
319
320 /* Loop around setting up a DRM device for each PCI device
321 * matching our ID and device class. If we had the internal
322 * function that pci_get_subsys and pci_get_class used, we'd
323 * be able to just pass pid in instead of doing a two-stage
324 * thing.
325 */
326 pdev = NULL;
327 while ((pdev =
328 pci_get_subsys(pid->vendor, pid->device, pid->subvendor,
329 pid->subdevice, pdev)) != NULL) {
330 if ((pdev->class & pid->class_mask) != pid->class)
331 continue;
332
333 /* stealth mode requires a manual probe */
334 pci_dev_get(pdev);
335 drm_get_pci_dev(pdev, pid, driver);
336 }
337 }
338 #endif
339 return 0;
340 }
341 EXPORT_SYMBOL(drm_legacy_pci_init);
342
drm_pcie_get_speed_cap_mask(struct drm_device * dev,u32 * mask)343 int drm_pcie_get_speed_cap_mask(struct drm_device *dev, u32 *mask)
344 {
345 struct pci_dev *root;
346 u32 lnkcap, lnkcap2;
347
348 *mask = 0;
349 if (!dev->pdev)
350 return -EINVAL;
351
352 root = dev->pdev->bus->self;
353
354 /* we've been informed via and serverworks don't make the cut */
355 if (root->vendor == PCI_VENDOR_ID_VIA ||
356 root->vendor == PCI_VENDOR_ID_SERVERWORKS)
357 return -EINVAL;
358
359 pcie_capability_read_dword(root, PCI_EXP_LNKCAP, &lnkcap);
360 pcie_capability_read_dword(root, PCI_EXP_LNKCAP2, &lnkcap2);
361
362 if (lnkcap2) { /* PCIe r3.0-compliant */
363 if (lnkcap2 & PCI_EXP_LNKCAP2_SLS_2_5GB)
364 *mask |= DRM_PCIE_SPEED_25;
365 if (lnkcap2 & PCI_EXP_LNKCAP2_SLS_5_0GB)
366 *mask |= DRM_PCIE_SPEED_50;
367 if (lnkcap2 & PCI_EXP_LNKCAP2_SLS_8_0GB)
368 *mask |= DRM_PCIE_SPEED_80;
369 } else { /* pre-r3.0 */
370 if (lnkcap & PCI_EXP_LNKCAP_SLS_2_5GB)
371 *mask |= DRM_PCIE_SPEED_25;
372 if (lnkcap & PCI_EXP_LNKCAP_SLS_5_0GB)
373 *mask |= (DRM_PCIE_SPEED_25 | DRM_PCIE_SPEED_50);
374 }
375
376 DRM_INFO("probing gen 2 caps for device %x:%x = %x/%x\n", root->vendor, root->device, lnkcap, lnkcap2);
377 return 0;
378 }
379 EXPORT_SYMBOL(drm_pcie_get_speed_cap_mask);
380
drm_pcie_get_max_link_width(struct drm_device * dev,u32 * mlw)381 int drm_pcie_get_max_link_width(struct drm_device *dev, u32 *mlw)
382 {
383 struct pci_dev *root;
384 u32 lnkcap;
385
386 *mlw = 0;
387 if (!dev->pdev)
388 return -EINVAL;
389
390 root = dev->pdev->bus->self;
391
392 pcie_capability_read_dword(root, PCI_EXP_LNKCAP, &lnkcap);
393
394 *mlw = (lnkcap & PCI_EXP_LNKCAP_MLW) >> 4;
395
396 DRM_INFO("probing mlw for device %x:%x = %x\n", root->vendor, root->device, lnkcap);
397 return 0;
398 }
399 EXPORT_SYMBOL(drm_pcie_get_max_link_width);
400
401 #else
402
drm_pci_agp_destroy(struct drm_device * dev)403 void drm_pci_agp_destroy(struct drm_device *dev) {}
404
drm_irq_by_busid(struct drm_device * dev,void * data,struct drm_file * file_priv)405 int drm_irq_by_busid(struct drm_device *dev, void *data,
406 struct drm_file *file_priv)
407 {
408 return -EINVAL;
409 }
410 #endif
411
412 /**
413 * drm_legacy_pci_exit - unregister shadow-attach legacy DRM driver
414 * @driver: DRM device driver
415 * @pdriver: PCI device driver
416 *
417 * Unregister a DRM driver shadow-attached through drm_legacy_pci_init(). This
418 * is deprecated and only used by dri1 drivers.
419 */
drm_legacy_pci_exit(struct drm_driver * driver,struct pci_driver * pdriver)420 void drm_legacy_pci_exit(struct drm_driver *driver, struct pci_driver *pdriver)
421 {
422 struct drm_device *dev, *tmp;
423 DRM_DEBUG("\n");
424
425 if (!(driver->driver_features & DRIVER_LEGACY)) {
426 WARN_ON(1);
427 } else {
428 list_for_each_entry_safe(dev, tmp, &driver->legacy_dev_list,
429 legacy_dev_list) {
430 list_del(&dev->legacy_dev_list);
431 #if 0
432 drm_put_dev(dev);
433 #endif
434 }
435 }
436 DRM_INFO("Module unloaded\n");
437 }
438 EXPORT_SYMBOL(drm_legacy_pci_exit);
439