Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* drm_pci.h -- PCI DMA memory management wrappers for DRM -*- linux-c -*- */ |
2 | /** | |
3 | * \file drm_pci.c | |
4 | * \brief Functions and ioctls to manage PCI memory | |
5 | * | |
6 | * \warning These interfaces aren't stable yet. | |
7 | * | |
8 | * \todo Implement the remaining ioctl's for the PCI pools. | |
9 | * \todo The wrappers here are so thin that they would be better off inlined.. | |
10 | * | |
96de0e25 | 11 | * \author José Fonseca <jrfonseca@tungstengraphics.com> |
1da177e4 LT |
12 | * \author Leif Delgass <ldelgass@retinalburn.net> |
13 | */ | |
14 | ||
15 | /* | |
96de0e25 | 16 | * Copyright 2003 José Fonseca. |
1da177e4 LT |
17 | * Copyright 2003 Leif Delgass. |
18 | * All Rights Reserved. | |
19 | * | |
20 | * Permission is hereby granted, free of charge, to any person obtaining a | |
21 | * copy of this software and associated documentation files (the "Software"), | |
22 | * to deal in the Software without restriction, including without limitation | |
23 | * the rights to use, copy, modify, merge, publish, distribute, sublicense, | |
24 | * and/or sell copies of the Software, and to permit persons to whom the | |
25 | * Software is furnished to do so, subject to the following conditions: | |
26 | * | |
27 | * The above copyright notice and this permission notice (including the next | |
28 | * paragraph) shall be included in all copies or substantial portions of the | |
29 | * Software. | |
30 | * | |
31 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR | |
32 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, | |
33 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE | |
34 | * AUTHORS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN | |
35 | * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION | |
36 | * WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. | |
37 | */ | |
38 | ||
39 | #include <linux/pci.h> | |
5a0e3ad6 | 40 | #include <linux/slab.h> |
195b3a2d | 41 | #include <linux/dma-mapping.h> |
1da177e4 LT |
42 | #include "drmP.h" |
43 | ||
44 | /**********************************************************************/ | |
45 | /** \name PCI memory */ | |
46 | /*@{*/ | |
47 | ||
48 | /** | |
49 | * \brief Allocate a PCI consistent memory block, for DMA. | |
50 | */ | |
e6be8d9d | 51 | drm_dma_handle_t *drm_pci_alloc(struct drm_device * dev, size_t size, size_t align) |
1da177e4 | 52 | { |
9c8da5eb | 53 | drm_dma_handle_t *dmah; |
ddf19b97 DA |
54 | #if 1 |
55 | unsigned long addr; | |
56 | size_t sz; | |
57 | #endif | |
1da177e4 LT |
58 | |
59 | /* pci_alloc_consistent only guarantees alignment to the smallest | |
60 | * PAGE_SIZE order which is greater than or equal to the requested size. | |
61 | * Return NULL here for now to make sure nobody tries for larger alignment | |
62 | */ | |
63 | if (align > size) | |
64 | return NULL; | |
65 | ||
9c8da5eb DA |
66 | dmah = kmalloc(sizeof(drm_dma_handle_t), GFP_KERNEL); |
67 | if (!dmah) | |
68 | return NULL; | |
b5e89ed5 | 69 | |
9c8da5eb | 70 | dmah->size = size; |
ddf19b97 | 71 | dmah->vaddr = dma_alloc_coherent(&dev->pdev->dev, size, &dmah->busaddr, GFP_KERNEL | __GFP_COMP); |
1da177e4 | 72 | |
9c8da5eb DA |
73 | if (dmah->vaddr == NULL) { |
74 | kfree(dmah); | |
1da177e4 | 75 | return NULL; |
9c8da5eb | 76 | } |
1da177e4 | 77 | |
9c8da5eb | 78 | memset(dmah->vaddr, 0, size); |
1da177e4 | 79 | |
ddf19b97 DA |
80 | /* XXX - Is virt_to_page() legal for consistent mem? */ |
81 | /* Reserve */ | |
82 | for (addr = (unsigned long)dmah->vaddr, sz = size; | |
83 | sz > 0; addr += PAGE_SIZE, sz -= PAGE_SIZE) { | |
84 | SetPageReserved(virt_to_page(addr)); | |
85 | } | |
86 | ||
9c8da5eb | 87 | return dmah; |
1da177e4 | 88 | } |
b5e89ed5 | 89 | |
1da177e4 LT |
90 | EXPORT_SYMBOL(drm_pci_alloc); |
91 | ||
92 | /** | |
ddf19b97 | 93 | * \brief Free a PCI consistent memory block without freeing its descriptor. |
9c8da5eb DA |
94 | * |
95 | * This function is for internal use in the Linux-specific DRM core code. | |
1da177e4 | 96 | */ |
84b1fd10 | 97 | void __drm_pci_free(struct drm_device * dev, drm_dma_handle_t * dmah) |
1da177e4 | 98 | { |
ddf19b97 DA |
99 | #if 1 |
100 | unsigned long addr; | |
101 | size_t sz; | |
102 | #endif | |
1da177e4 | 103 | |
9a298b2a | 104 | if (dmah->vaddr) { |
ddf19b97 DA |
105 | /* XXX - Is virt_to_page() legal for consistent mem? */ |
106 | /* Unreserve */ | |
107 | for (addr = (unsigned long)dmah->vaddr, sz = dmah->size; | |
108 | sz > 0; addr += PAGE_SIZE, sz -= PAGE_SIZE) { | |
109 | ClearPageReserved(virt_to_page(addr)); | |
110 | } | |
111 | dma_free_coherent(&dev->pdev->dev, dmah->size, dmah->vaddr, | |
112 | dmah->busaddr); | |
1da177e4 | 113 | } |
1da177e4 | 114 | } |
9c8da5eb DA |
115 | |
116 | /** | |
117 | * \brief Free a PCI consistent memory block | |
118 | */ | |
84b1fd10 | 119 | void drm_pci_free(struct drm_device * dev, drm_dma_handle_t * dmah) |
9c8da5eb DA |
120 | { |
121 | __drm_pci_free(dev, dmah); | |
122 | kfree(dmah); | |
123 | } | |
b5e89ed5 | 124 | |
1da177e4 LT |
125 | EXPORT_SYMBOL(drm_pci_free); |
126 | ||
dcdb1674 | 127 | #ifdef CONFIG_PCI |
8410ea3b DA |
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 | return pci_domain_nr(dev->pdev->bus); | |
141 | } | |
142 | ||
143 | static int drm_pci_get_irq(struct drm_device *dev) | |
144 | { | |
145 | return dev->pdev->irq; | |
146 | } | |
147 | ||
148 | static const char *drm_pci_get_name(struct drm_device *dev) | |
149 | { | |
150 | struct pci_driver *pdriver = dev->driver->kdriver.pci; | |
151 | return pdriver->name; | |
152 | } | |
153 | ||
154 | int drm_pci_set_busid(struct drm_device *dev, struct drm_master *master) | |
155 | { | |
156 | int len, ret; | |
157 | struct pci_driver *pdriver = dev->driver->kdriver.pci; | |
158 | master->unique_len = 40; | |
159 | master->unique_size = master->unique_len; | |
160 | master->unique = kmalloc(master->unique_size, GFP_KERNEL); | |
161 | if (master->unique == NULL) | |
162 | return -ENOMEM; | |
163 | ||
164 | ||
165 | len = snprintf(master->unique, master->unique_len, | |
166 | "pci:%04x:%02x:%02x.%d", | |
167 | drm_get_pci_domain(dev), | |
168 | dev->pdev->bus->number, | |
169 | PCI_SLOT(dev->pdev->devfn), | |
170 | PCI_FUNC(dev->pdev->devfn)); | |
171 | ||
172 | if (len >= master->unique_len) { | |
173 | DRM_ERROR("buffer overflow"); | |
174 | ret = -EINVAL; | |
175 | goto err; | |
176 | } else | |
177 | master->unique_len = len; | |
178 | ||
179 | dev->devname = | |
180 | kmalloc(strlen(pdriver->name) + | |
181 | master->unique_len + 2, GFP_KERNEL); | |
182 | ||
183 | if (dev->devname == NULL) { | |
184 | ret = -ENOMEM; | |
185 | goto err; | |
186 | } | |
187 | ||
188 | sprintf(dev->devname, "%s@%s", pdriver->name, | |
189 | master->unique); | |
190 | ||
191 | return 0; | |
192 | err: | |
193 | return ret; | |
194 | } | |
195 | ||
196 | int drm_pci_set_unique(struct drm_device *dev, | |
197 | struct drm_master *master, | |
198 | struct drm_unique *u) | |
199 | { | |
200 | int domain, bus, slot, func, ret; | |
201 | const char *bus_name; | |
202 | ||
203 | master->unique_len = u->unique_len; | |
204 | master->unique_size = u->unique_len + 1; | |
205 | master->unique = kmalloc(master->unique_size, GFP_KERNEL); | |
206 | if (!master->unique) { | |
207 | ret = -ENOMEM; | |
208 | goto err; | |
209 | } | |
210 | ||
211 | if (copy_from_user(master->unique, u->unique, master->unique_len)) { | |
212 | ret = -EFAULT; | |
213 | goto err; | |
214 | } | |
215 | ||
216 | master->unique[master->unique_len] = '\0'; | |
217 | ||
218 | bus_name = dev->driver->bus->get_name(dev); | |
219 | dev->devname = kmalloc(strlen(bus_name) + | |
220 | strlen(master->unique) + 2, GFP_KERNEL); | |
221 | if (!dev->devname) { | |
222 | ret = -ENOMEM; | |
223 | goto err; | |
224 | } | |
225 | ||
226 | sprintf(dev->devname, "%s@%s", bus_name, | |
227 | master->unique); | |
228 | ||
229 | /* Return error if the busid submitted doesn't match the device's actual | |
230 | * busid. | |
231 | */ | |
232 | ret = sscanf(master->unique, "PCI:%d:%d:%d", &bus, &slot, &func); | |
233 | if (ret != 3) { | |
234 | ret = -EINVAL; | |
235 | goto err; | |
236 | } | |
237 | ||
238 | domain = bus >> 8; | |
239 | bus &= 0xff; | |
240 | ||
241 | if ((domain != drm_get_pci_domain(dev)) || | |
242 | (bus != dev->pdev->bus->number) || | |
243 | (slot != PCI_SLOT(dev->pdev->devfn)) || | |
244 | (func != PCI_FUNC(dev->pdev->devfn))) { | |
245 | ret = -EINVAL; | |
246 | goto err; | |
247 | } | |
248 | return 0; | |
249 | err: | |
250 | return ret; | |
251 | } | |
252 | ||
253 | ||
254 | int drm_pci_irq_by_busid(struct drm_device *dev, struct drm_irq_busid *p) | |
255 | { | |
256 | if ((p->busnum >> 8) != drm_get_pci_domain(dev) || | |
257 | (p->busnum & 0xff) != dev->pdev->bus->number || | |
258 | p->devnum != PCI_SLOT(dev->pdev->devfn) || p->funcnum != PCI_FUNC(dev->pdev->devfn)) | |
259 | return -EINVAL; | |
260 | ||
261 | p->irq = dev->pdev->irq; | |
262 | ||
263 | DRM_DEBUG("%d:%d:%d => IRQ %d\n", p->busnum, p->devnum, p->funcnum, | |
264 | p->irq); | |
265 | return 0; | |
266 | } | |
267 | ||
268 | int drm_pci_agp_init(struct drm_device *dev) | |
269 | { | |
270 | if (drm_core_has_AGP(dev)) { | |
271 | if (drm_pci_device_is_agp(dev)) | |
272 | dev->agp = drm_agp_init(dev); | |
273 | if (drm_core_check_feature(dev, DRIVER_REQUIRE_AGP) | |
274 | && (dev->agp == NULL)) { | |
275 | DRM_ERROR("Cannot initialize the agpgart module.\n"); | |
276 | return -EINVAL; | |
277 | } | |
278 | if (drm_core_has_MTRR(dev)) { | |
279 | if (dev->agp) | |
280 | dev->agp->agp_mtrr = | |
281 | mtrr_add(dev->agp->agp_info.aper_base, | |
282 | dev->agp->agp_info.aper_size * | |
283 | 1024 * 1024, MTRR_TYPE_WRCOMB, 1); | |
284 | } | |
285 | } | |
286 | return 0; | |
287 | } | |
288 | ||
289 | static struct drm_bus drm_pci_bus = { | |
290 | .bus_type = DRIVER_BUS_PCI, | |
291 | .get_irq = drm_pci_get_irq, | |
292 | .get_name = drm_pci_get_name, | |
293 | .set_busid = drm_pci_set_busid, | |
294 | .set_unique = drm_pci_set_unique, | |
295 | .agp_init = drm_pci_agp_init, | |
296 | }; | |
297 | ||
dcdb1674 JC |
298 | /** |
299 | * Register. | |
300 | * | |
301 | * \param pdev - PCI device structure | |
302 | * \param ent entry from the PCI ID table with device type flags | |
303 | * \return zero on success or a negative number on failure. | |
304 | * | |
305 | * Attempt to gets inter module "drm" information. If we are first | |
306 | * then register the character device and inter module information. | |
307 | * Try and register, if we fail to register, backout previous work. | |
308 | */ | |
309 | int drm_get_pci_dev(struct pci_dev *pdev, const struct pci_device_id *ent, | |
310 | struct drm_driver *driver) | |
311 | { | |
312 | struct drm_device *dev; | |
313 | int ret; | |
314 | ||
315 | DRM_DEBUG("\n"); | |
316 | ||
317 | dev = kzalloc(sizeof(*dev), GFP_KERNEL); | |
318 | if (!dev) | |
319 | return -ENOMEM; | |
320 | ||
321 | ret = pci_enable_device(pdev); | |
322 | if (ret) | |
323 | goto err_g1; | |
324 | ||
325 | pci_set_master(pdev); | |
326 | ||
327 | dev->pdev = pdev; | |
328 | dev->dev = &pdev->dev; | |
329 | ||
330 | dev->pci_device = pdev->device; | |
331 | dev->pci_vendor = pdev->vendor; | |
332 | ||
333 | #ifdef __alpha__ | |
334 | dev->hose = pdev->sysdata; | |
335 | #endif | |
336 | ||
b64c115e DA |
337 | mutex_lock(&drm_global_mutex); |
338 | ||
dcdb1674 JC |
339 | if ((ret = drm_fill_in_dev(dev, ent, driver))) { |
340 | printk(KERN_ERR "DRM: Fill_in_dev failed.\n"); | |
341 | goto err_g2; | |
342 | } | |
343 | ||
344 | if (drm_core_check_feature(dev, DRIVER_MODESET)) { | |
345 | pci_set_drvdata(pdev, dev); | |
346 | ret = drm_get_minor(dev, &dev->control, DRM_MINOR_CONTROL); | |
347 | if (ret) | |
348 | goto err_g2; | |
349 | } | |
350 | ||
351 | if ((ret = drm_get_minor(dev, &dev->primary, DRM_MINOR_LEGACY))) | |
352 | goto err_g3; | |
353 | ||
354 | if (dev->driver->load) { | |
355 | ret = dev->driver->load(dev, ent->driver_data); | |
356 | if (ret) | |
357 | goto err_g4; | |
358 | } | |
359 | ||
360 | /* setup the grouping for the legacy output */ | |
361 | if (drm_core_check_feature(dev, DRIVER_MODESET)) { | |
362 | ret = drm_mode_group_init_legacy_group(dev, | |
363 | &dev->primary->mode_group); | |
364 | if (ret) | |
365 | goto err_g4; | |
366 | } | |
367 | ||
368 | list_add_tail(&dev->driver_item, &driver->device_list); | |
369 | ||
370 | DRM_INFO("Initialized %s %d.%d.%d %s for %s on minor %d\n", | |
371 | driver->name, driver->major, driver->minor, driver->patchlevel, | |
372 | driver->date, pci_name(pdev), dev->primary->index); | |
373 | ||
b64c115e | 374 | mutex_unlock(&drm_global_mutex); |
dcdb1674 JC |
375 | return 0; |
376 | ||
377 | err_g4: | |
378 | drm_put_minor(&dev->primary); | |
379 | err_g3: | |
380 | if (drm_core_check_feature(dev, DRIVER_MODESET)) | |
381 | drm_put_minor(&dev->control); | |
382 | err_g2: | |
383 | pci_disable_device(pdev); | |
384 | err_g1: | |
385 | kfree(dev); | |
b64c115e | 386 | mutex_unlock(&drm_global_mutex); |
dcdb1674 JC |
387 | return ret; |
388 | } | |
389 | EXPORT_SYMBOL(drm_get_pci_dev); | |
390 | ||
391 | /** | |
8410ea3b | 392 | * PCI device initialization. Called direct from modules at load time. |
dcdb1674 JC |
393 | * |
394 | * \return zero on success or a negative number on failure. | |
395 | * | |
396 | * Initializes a drm_device structures,registering the | |
397 | * stubs and initializing the AGP device. | |
398 | * | |
399 | * Expands the \c DRIVER_PREINIT and \c DRIVER_POST_INIT macros before and | |
400 | * after the initialization for driver customization. | |
401 | */ | |
8410ea3b | 402 | int drm_pci_init(struct drm_driver *driver, struct pci_driver *pdriver) |
dcdb1674 JC |
403 | { |
404 | struct pci_dev *pdev = NULL; | |
405 | const struct pci_device_id *pid; | |
406 | int i; | |
407 | ||
8410ea3b DA |
408 | DRM_DEBUG("\n"); |
409 | ||
410 | INIT_LIST_HEAD(&driver->device_list); | |
411 | driver->kdriver.pci = pdriver; | |
412 | driver->bus = &drm_pci_bus; | |
413 | ||
dcdb1674 | 414 | if (driver->driver_features & DRIVER_MODESET) |
8410ea3b | 415 | return pci_register_driver(pdriver); |
dcdb1674 JC |
416 | |
417 | /* If not using KMS, fall back to stealth mode manual scanning. */ | |
8410ea3b DA |
418 | for (i = 0; pdriver->id_table[i].vendor != 0; i++) { |
419 | pid = &pdriver->id_table[i]; | |
dcdb1674 JC |
420 | |
421 | /* Loop around setting up a DRM device for each PCI device | |
422 | * matching our ID and device class. If we had the internal | |
423 | * function that pci_get_subsys and pci_get_class used, we'd | |
424 | * be able to just pass pid in instead of doing a two-stage | |
425 | * thing. | |
426 | */ | |
427 | pdev = NULL; | |
428 | while ((pdev = | |
429 | pci_get_subsys(pid->vendor, pid->device, pid->subvendor, | |
430 | pid->subdevice, pdev)) != NULL) { | |
431 | if ((pdev->class & pid->class_mask) != pid->class) | |
432 | continue; | |
433 | ||
434 | /* stealth mode requires a manual probe */ | |
435 | pci_dev_get(pdev); | |
436 | drm_get_pci_dev(pdev, pid, driver); | |
437 | } | |
438 | } | |
439 | return 0; | |
440 | } | |
441 | ||
442 | #else | |
443 | ||
8410ea3b | 444 | int drm_pci_init(struct drm_driver *driver, struct pci_driver *pdriver) |
dcdb1674 JC |
445 | { |
446 | return -1; | |
447 | } | |
448 | ||
449 | #endif | |
8410ea3b DA |
450 | |
451 | EXPORT_SYMBOL(drm_pci_init); | |
452 | ||
1da177e4 | 453 | /*@}*/ |
8410ea3b DA |
454 | void drm_pci_exit(struct drm_driver *driver, struct pci_driver *pdriver) |
455 | { | |
456 | struct drm_device *dev, *tmp; | |
457 | DRM_DEBUG("\n"); | |
458 | ||
459 | if (driver->driver_features & DRIVER_MODESET) { | |
460 | pci_unregister_driver(pdriver); | |
461 | } else { | |
462 | list_for_each_entry_safe(dev, tmp, &driver->device_list, driver_item) | |
463 | drm_put_dev(dev); | |
464 | } | |
465 | DRM_INFO("Module unloaded\n"); | |
466 | } | |
467 | EXPORT_SYMBOL(drm_pci_exit); |