Blame view

drivers/gpu/drm/drm_pci.c 11.7 KB
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1
2
3
4
5
6
7
8
9
10
  /* drm_pci.h -- PCI DMA memory management wrappers for DRM -*- linux-c -*- */
  /**
   * \file drm_pci.c
   * \brief Functions and ioctls to manage PCI memory
   *
   * \warning These interfaces aren't stable yet.
   *
   * \todo Implement the remaining ioctl's for the PCI pools.
   * \todo The wrappers here are so thin that they would be better off inlined..
   *
96de0e252   Jan Engelhardt   Convert files to ...
11
   * \author José Fonseca <jrfonseca@tungstengraphics.com>
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
12
13
14
15
   * \author Leif Delgass <ldelgass@retinalburn.net>
   */
  
  /*
96de0e252   Jan Engelhardt   Convert files to ...
16
   * Copyright 2003 José Fonseca.
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
   * Copyright 2003 Leif Delgass.
   * All Rights Reserved.
   *
   * Permission is hereby granted, free of charge, to any person obtaining a
   * copy of this software and associated documentation files (the "Software"),
   * to deal in the Software without restriction, including without limitation
   * the rights to use, copy, modify, merge, publish, distribute, sublicense,
   * and/or sell copies of the Software, and to permit persons to whom the
   * Software is furnished to do so, subject to the following conditions:
   *
   * The above copyright notice and this permission notice (including the next
   * paragraph) shall be included in all copies or substantial portions of the
   * Software.
   *
   * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
   * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
   * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL THE
   * AUTHORS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
   * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
   * WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
   */
  
  #include <linux/pci.h>
5a0e3ad6a   Tejun Heo   include cleanup: ...
40
  #include <linux/slab.h>
195b3a2d5   Dave Airlie   drm: drm_pci need...
41
  #include <linux/dma-mapping.h>
2d1a8a48a   Paul Gortmaker   gpu: Add export.h...
42
  #include <linux/export.h>
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
43
44
45
46
47
48
49
50
51
52
  #include "drmP.h"
  
  /**********************************************************************/
  /** 
  ame PCI memory */
  /*@{*/
  
  /**
   * \brief Allocate a PCI consistent memory block, for DMA.
   */
e6be8d9d1   Zhenyu Wang   drm: remove addre...
53
  drm_dma_handle_t *drm_pci_alloc(struct drm_device * dev, size_t size, size_t align)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
54
  {
9c8da5ebb   Dave Airlie   drm: update suppo...
55
  	drm_dma_handle_t *dmah;
ddf19b973   Dave Airlie   drm: fixup PCI DM...
56
57
58
59
  #if 1
  	unsigned long addr;
  	size_t sz;
  #endif
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
60
61
62
63
64
65
66
  
  	/* pci_alloc_consistent only guarantees alignment to the smallest
  	 * PAGE_SIZE order which is greater than or equal to the requested size.
  	 * Return NULL here for now to make sure nobody tries for larger alignment
  	 */
  	if (align > size)
  		return NULL;
9c8da5ebb   Dave Airlie   drm: update suppo...
67
68
69
  	dmah = kmalloc(sizeof(drm_dma_handle_t), GFP_KERNEL);
  	if (!dmah)
  		return NULL;
b5e89ed53   Dave Airlie   drm: lindent the ...
70

9c8da5ebb   Dave Airlie   drm: update suppo...
71
  	dmah->size = size;
ddf19b973   Dave Airlie   drm: fixup PCI DM...
72
  	dmah->vaddr = dma_alloc_coherent(&dev->pdev->dev, size, &dmah->busaddr, GFP_KERNEL | __GFP_COMP);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
73

9c8da5ebb   Dave Airlie   drm: update suppo...
74
75
  	if (dmah->vaddr == NULL) {
  		kfree(dmah);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
76
  		return NULL;
9c8da5ebb   Dave Airlie   drm: update suppo...
77
  	}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
78

9c8da5ebb   Dave Airlie   drm: update suppo...
79
  	memset(dmah->vaddr, 0, size);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
80

ddf19b973   Dave Airlie   drm: fixup PCI DM...
81
82
83
84
85
86
  	/* XXX - Is virt_to_page() legal for consistent mem? */
  	/* Reserve */
  	for (addr = (unsigned long)dmah->vaddr, sz = size;
  	     sz > 0; addr += PAGE_SIZE, sz -= PAGE_SIZE) {
  		SetPageReserved(virt_to_page(addr));
  	}
9c8da5ebb   Dave Airlie   drm: update suppo...
87
  	return dmah;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
88
  }
b5e89ed53   Dave Airlie   drm: lindent the ...
89

1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
90
91
92
  EXPORT_SYMBOL(drm_pci_alloc);
  
  /**
ddf19b973   Dave Airlie   drm: fixup PCI DM...
93
   * \brief Free a PCI consistent memory block without freeing its descriptor.
9c8da5ebb   Dave Airlie   drm: update suppo...
94
95
   *
   * This function is for internal use in the Linux-specific DRM core code.
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
96
   */
84b1fd103   Dave Airlie   drm: remove drm_f...
97
  void __drm_pci_free(struct drm_device * dev, drm_dma_handle_t * dmah)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
98
  {
ddf19b973   Dave Airlie   drm: fixup PCI DM...
99
100
101
102
  #if 1
  	unsigned long addr;
  	size_t sz;
  #endif
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
103

9a298b2ac   Eric Anholt   drm: Remove memor...
104
  	if (dmah->vaddr) {
ddf19b973   Dave Airlie   drm: fixup PCI DM...
105
106
107
108
109
110
111
112
  		/* XXX - Is virt_to_page() legal for consistent mem? */
  		/* Unreserve */
  		for (addr = (unsigned long)dmah->vaddr, sz = dmah->size;
  		     sz > 0; addr += PAGE_SIZE, sz -= PAGE_SIZE) {
  			ClearPageReserved(virt_to_page(addr));
  		}
  		dma_free_coherent(&dev->pdev->dev, dmah->size, dmah->vaddr,
  				  dmah->busaddr);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
113
  	}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
114
  }
9c8da5ebb   Dave Airlie   drm: update suppo...
115
116
117
118
  
  /**
   * \brief Free a PCI consistent memory block
   */
84b1fd103   Dave Airlie   drm: remove drm_f...
119
  void drm_pci_free(struct drm_device * dev, drm_dma_handle_t * dmah)
9c8da5ebb   Dave Airlie   drm: update suppo...
120
121
122
123
  {
  	__drm_pci_free(dev, dmah);
  	kfree(dmah);
  }
b5e89ed53   Dave Airlie   drm: lindent the ...
124

1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
125
  EXPORT_SYMBOL(drm_pci_free);
dcdb16740   Jordan Crouse   drm: Add support ...
126
  #ifdef CONFIG_PCI
8410ea3b9   Dave Airlie   drm: rework PCI/p...
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
  
  static int drm_get_pci_domain(struct drm_device *dev)
  {
  #ifndef __alpha__
  	/* For historical reasons, drm_get_pci_domain() is busticated
  	 * on most archs and has to remain so for userspace interface
  	 * < 1.4, except on alpha which was right from the beginning
  	 */
  	if (dev->if_version < 0x10004)
  		return 0;
  #endif /* __alpha__ */
  
  	return pci_domain_nr(dev->pdev->bus);
  }
  
  static int drm_pci_get_irq(struct drm_device *dev)
  {
  	return dev->pdev->irq;
  }
  
  static const char *drm_pci_get_name(struct drm_device *dev)
  {
  	struct pci_driver *pdriver = dev->driver->kdriver.pci;
  	return pdriver->name;
  }
  
  int drm_pci_set_busid(struct drm_device *dev, struct drm_master *master)
  {
  	int len, ret;
  	struct pci_driver *pdriver = dev->driver->kdriver.pci;
  	master->unique_len = 40;
  	master->unique_size = master->unique_len;
  	master->unique = kmalloc(master->unique_size, GFP_KERNEL);
  	if (master->unique == NULL)
  		return -ENOMEM;
  
  
  	len = snprintf(master->unique, master->unique_len,
  		       "pci:%04x:%02x:%02x.%d",
  		       drm_get_pci_domain(dev),
  		       dev->pdev->bus->number,
  		       PCI_SLOT(dev->pdev->devfn),
  		       PCI_FUNC(dev->pdev->devfn));
  
  	if (len >= master->unique_len) {
  		DRM_ERROR("buffer overflow");
  		ret = -EINVAL;
  		goto err;
  	} else
  		master->unique_len = len;
  
  	dev->devname =
  		kmalloc(strlen(pdriver->name) +
  			master->unique_len + 2, GFP_KERNEL);
  
  	if (dev->devname == NULL) {
  		ret = -ENOMEM;
  		goto err;
  	}
  
  	sprintf(dev->devname, "%s@%s", pdriver->name,
  		master->unique);
  
  	return 0;
  err:
  	return ret;
  }
  
  int drm_pci_set_unique(struct drm_device *dev,
  		       struct drm_master *master,
  		       struct drm_unique *u)
  {
  	int domain, bus, slot, func, ret;
  	const char *bus_name;
  
  	master->unique_len = u->unique_len;
  	master->unique_size = u->unique_len + 1;
  	master->unique = kmalloc(master->unique_size, GFP_KERNEL);
  	if (!master->unique) {
  		ret = -ENOMEM;
  		goto err;
  	}
  
  	if (copy_from_user(master->unique, u->unique, master->unique_len)) {
  		ret = -EFAULT;
  		goto err;
  	}
  
  	master->unique[master->unique_len] = '\0';
  
  	bus_name = dev->driver->bus->get_name(dev);
  	dev->devname = kmalloc(strlen(bus_name) +
  			       strlen(master->unique) + 2, GFP_KERNEL);
  	if (!dev->devname) {
  		ret = -ENOMEM;
  		goto err;
  	}
  
  	sprintf(dev->devname, "%s@%s", bus_name,
  		master->unique);
  
  	/* Return error if the busid submitted doesn't match the device's actual
  	 * busid.
  	 */
  	ret = sscanf(master->unique, "PCI:%d:%d:%d", &bus, &slot, &func);
  	if (ret != 3) {
  		ret = -EINVAL;
  		goto err;
  	}
  
  	domain = bus >> 8;
  	bus &= 0xff;
  
  	if ((domain != drm_get_pci_domain(dev)) ||
  	    (bus != dev->pdev->bus->number) ||
  	    (slot != PCI_SLOT(dev->pdev->devfn)) ||
  	    (func != PCI_FUNC(dev->pdev->devfn))) {
  		ret = -EINVAL;
  		goto err;
  	}
  	return 0;
  err:
  	return ret;
  }
45e97ab65   Wolfram Sang   drm: populate irq...
251
  static int drm_pci_irq_by_busid(struct drm_device *dev, struct drm_irq_busid *p)
8410ea3b9   Dave Airlie   drm: rework PCI/p...
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
  {
  	if ((p->busnum >> 8) != drm_get_pci_domain(dev) ||
  	    (p->busnum & 0xff) != dev->pdev->bus->number ||
  	    p->devnum != PCI_SLOT(dev->pdev->devfn) || p->funcnum != PCI_FUNC(dev->pdev->devfn))
  		return -EINVAL;
  
  	p->irq = dev->pdev->irq;
  
  	DRM_DEBUG("%d:%d:%d => IRQ %d
  ", p->busnum, p->devnum, p->funcnum,
  		  p->irq);
  	return 0;
  }
  
  int drm_pci_agp_init(struct drm_device *dev)
  {
  	if (drm_core_has_AGP(dev)) {
  		if (drm_pci_device_is_agp(dev))
  			dev->agp = drm_agp_init(dev);
  		if (drm_core_check_feature(dev, DRIVER_REQUIRE_AGP)
  		    && (dev->agp == NULL)) {
  			DRM_ERROR("Cannot initialize the agpgart module.
  ");
  			return -EINVAL;
  		}
  		if (drm_core_has_MTRR(dev)) {
  			if (dev->agp)
  				dev->agp->agp_mtrr =
  					mtrr_add(dev->agp->agp_info.aper_base,
  						 dev->agp->agp_info.aper_size *
  						 1024 * 1024, MTRR_TYPE_WRCOMB, 1);
  		}
  	}
  	return 0;
  }
  
  static struct drm_bus drm_pci_bus = {
  	.bus_type = DRIVER_BUS_PCI,
  	.get_irq = drm_pci_get_irq,
  	.get_name = drm_pci_get_name,
  	.set_busid = drm_pci_set_busid,
  	.set_unique = drm_pci_set_unique,
45e97ab65   Wolfram Sang   drm: populate irq...
294
  	.irq_by_busid = drm_pci_irq_by_busid,
8410ea3b9   Dave Airlie   drm: rework PCI/p...
295
296
  	.agp_init = drm_pci_agp_init,
  };
dcdb16740   Jordan Crouse   drm: Add support ...
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
  /**
   * Register.
   *
   * \param pdev - PCI device structure
   * \param ent entry from the PCI ID table with device type flags
   * \return zero on success or a negative number on failure.
   *
   * Attempt to gets inter module "drm" information. If we are first
   * then register the character device and inter module information.
   * Try and register, if we fail to register, backout previous work.
   */
  int drm_get_pci_dev(struct pci_dev *pdev, const struct pci_device_id *ent,
  		    struct drm_driver *driver)
  {
  	struct drm_device *dev;
  	int ret;
  
  	DRM_DEBUG("
  ");
  
  	dev = kzalloc(sizeof(*dev), GFP_KERNEL);
  	if (!dev)
  		return -ENOMEM;
  
  	ret = pci_enable_device(pdev);
  	if (ret)
  		goto err_g1;
  
  	pci_set_master(pdev);
  
  	dev->pdev = pdev;
  	dev->dev = &pdev->dev;
  
  	dev->pci_device = pdev->device;
  	dev->pci_vendor = pdev->vendor;
  
  #ifdef __alpha__
  	dev->hose = pdev->sysdata;
  #endif
b64c115eb   Dave Airlie   drm: fix race bet...
336
  	mutex_lock(&drm_global_mutex);
dcdb16740   Jordan Crouse   drm: Add support ...
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
  	if ((ret = drm_fill_in_dev(dev, ent, driver))) {
  		printk(KERN_ERR "DRM: Fill_in_dev failed.
  ");
  		goto err_g2;
  	}
  
  	if (drm_core_check_feature(dev, DRIVER_MODESET)) {
  		pci_set_drvdata(pdev, dev);
  		ret = drm_get_minor(dev, &dev->control, DRM_MINOR_CONTROL);
  		if (ret)
  			goto err_g2;
  	}
  
  	if ((ret = drm_get_minor(dev, &dev->primary, DRM_MINOR_LEGACY)))
  		goto err_g3;
  
  	if (dev->driver->load) {
  		ret = dev->driver->load(dev, ent->driver_data);
  		if (ret)
  			goto err_g4;
  	}
  
  	/* setup the grouping for the legacy output */
  	if (drm_core_check_feature(dev, DRIVER_MODESET)) {
  		ret = drm_mode_group_init_legacy_group(dev,
  						&dev->primary->mode_group);
  		if (ret)
  			goto err_g4;
  	}
  
  	list_add_tail(&dev->driver_item, &driver->device_list);
  
  	DRM_INFO("Initialized %s %d.%d.%d %s for %s on minor %d
  ",
  		 driver->name, driver->major, driver->minor, driver->patchlevel,
  		 driver->date, pci_name(pdev), dev->primary->index);
b64c115eb   Dave Airlie   drm: fix race bet...
373
  	mutex_unlock(&drm_global_mutex);
dcdb16740   Jordan Crouse   drm: Add support ...
374
375
376
377
378
379
380
381
382
383
384
  	return 0;
  
  err_g4:
  	drm_put_minor(&dev->primary);
  err_g3:
  	if (drm_core_check_feature(dev, DRIVER_MODESET))
  		drm_put_minor(&dev->control);
  err_g2:
  	pci_disable_device(pdev);
  err_g1:
  	kfree(dev);
b64c115eb   Dave Airlie   drm: fix race bet...
385
  	mutex_unlock(&drm_global_mutex);
dcdb16740   Jordan Crouse   drm: Add support ...
386
387
388
389
390
  	return ret;
  }
  EXPORT_SYMBOL(drm_get_pci_dev);
  
  /**
8410ea3b9   Dave Airlie   drm: rework PCI/p...
391
   * PCI device initialization. Called direct from modules at load time.
dcdb16740   Jordan Crouse   drm: Add support ...
392
393
394
395
396
397
398
399
400
   *
   * \return zero on success or a negative number on failure.
   *
   * Initializes a drm_device structures,registering the
   * stubs and initializing the AGP device.
   *
   * Expands the \c DRIVER_PREINIT and \c DRIVER_POST_INIT macros before and
   * after the initialization for driver customization.
   */
8410ea3b9   Dave Airlie   drm: rework PCI/p...
401
  int drm_pci_init(struct drm_driver *driver, struct pci_driver *pdriver)
dcdb16740   Jordan Crouse   drm: Add support ...
402
403
404
405
  {
  	struct pci_dev *pdev = NULL;
  	const struct pci_device_id *pid;
  	int i;
8410ea3b9   Dave Airlie   drm: rework PCI/p...
406
407
408
409
410
411
  	DRM_DEBUG("
  ");
  
  	INIT_LIST_HEAD(&driver->device_list);
  	driver->kdriver.pci = pdriver;
  	driver->bus = &drm_pci_bus;
dcdb16740   Jordan Crouse   drm: Add support ...
412
  	if (driver->driver_features & DRIVER_MODESET)
8410ea3b9   Dave Airlie   drm: rework PCI/p...
413
  		return pci_register_driver(pdriver);
dcdb16740   Jordan Crouse   drm: Add support ...
414
415
  
  	/* If not using KMS, fall back to stealth mode manual scanning. */
8410ea3b9   Dave Airlie   drm: rework PCI/p...
416
417
  	for (i = 0; pdriver->id_table[i].vendor != 0; i++) {
  		pid = &pdriver->id_table[i];
dcdb16740   Jordan Crouse   drm: Add support ...
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
  
  		/* Loop around setting up a DRM device for each PCI device
  		 * matching our ID and device class.  If we had the internal
  		 * function that pci_get_subsys and pci_get_class used, we'd
  		 * be able to just pass pid in instead of doing a two-stage
  		 * thing.
  		 */
  		pdev = NULL;
  		while ((pdev =
  			pci_get_subsys(pid->vendor, pid->device, pid->subvendor,
  				       pid->subdevice, pdev)) != NULL) {
  			if ((pdev->class & pid->class_mask) != pid->class)
  				continue;
  
  			/* stealth mode requires a manual probe */
  			pci_dev_get(pdev);
  			drm_get_pci_dev(pdev, pid, driver);
  		}
  	}
  	return 0;
  }
  
  #else
8410ea3b9   Dave Airlie   drm: rework PCI/p...
441
  int drm_pci_init(struct drm_driver *driver, struct pci_driver *pdriver)
dcdb16740   Jordan Crouse   drm: Add support ...
442
443
444
445
446
  {
  	return -1;
  }
  
  #endif
8410ea3b9   Dave Airlie   drm: rework PCI/p...
447
448
  
  EXPORT_SYMBOL(drm_pci_init);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
449
  /*@}*/
8410ea3b9   Dave Airlie   drm: rework PCI/p...
450
451
452
453
454
455
456
457
458
459
460
461
462
463
464
465
  void drm_pci_exit(struct drm_driver *driver, struct pci_driver *pdriver)
  {
  	struct drm_device *dev, *tmp;
  	DRM_DEBUG("
  ");
  
  	if (driver->driver_features & DRIVER_MODESET) {
  		pci_unregister_driver(pdriver);
  	} else {
  		list_for_each_entry_safe(dev, tmp, &driver->device_list, driver_item)
  			drm_put_dev(dev);
  	}
  	DRM_INFO("Module unloaded
  ");
  }
  EXPORT_SYMBOL(drm_pci_exit);