1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25#include <linux/dma-mapping.h>
26#include <linux/export.h>
27#include <linux/pci.h>
28#include <linux/slab.h>
29
30#include <drm/drm.h>
31#include <drm/drm_agpsupport.h>
32#include <drm/drm_drv.h>
33#include <drm/drm_pci.h>
34#include <drm/drm_print.h>
35
36#include "drm_internal.h"
37#include "drm_legacy.h"
38
39
40
41
42
43
44
45
46
47
48
49
50
51drm_dma_handle_t *drm_pci_alloc(struct drm_device * dev, size_t size, size_t align)
52{
53 drm_dma_handle_t *dmah;
54
55
56
57
58
59 if (align > size)
60 return NULL;
61
62 dmah = kmalloc(sizeof(drm_dma_handle_t), GFP_KERNEL);
63 if (!dmah)
64 return NULL;
65
66 dmah->size = size;
67 dmah->vaddr = dma_alloc_coherent(&dev->pdev->dev, size,
68 &dmah->busaddr,
69 GFP_KERNEL);
70
71 if (dmah->vaddr == NULL) {
72 kfree(dmah);
73 return NULL;
74 }
75
76 return dmah;
77}
78
79EXPORT_SYMBOL(drm_pci_alloc);
80
81
82
83
84
85
86void __drm_legacy_pci_free(struct drm_device * dev, drm_dma_handle_t * dmah)
87{
88 if (dmah->vaddr)
89 dma_free_coherent(&dev->pdev->dev, dmah->size, dmah->vaddr,
90 dmah->busaddr);
91}
92
93
94
95
96
97
98
99
100
101void drm_pci_free(struct drm_device * dev, drm_dma_handle_t * dmah)
102{
103 __drm_legacy_pci_free(dev, dmah);
104 kfree(dmah);
105}
106
107EXPORT_SYMBOL(drm_pci_free);
108
109static int drm_get_pci_domain(struct drm_device *dev)
110{
111#ifndef __alpha__
112
113
114
115
116 if (dev->if_version < 0x10004)
117 return 0;
118#endif
119
120 return pci_domain_nr(dev->pdev->bus);
121}
122
123int drm_pci_set_busid(struct drm_device *dev, struct drm_master *master)
124{
125 master->unique = kasprintf(GFP_KERNEL, "pci:%04x:%02x:%02x.%d",
126 drm_get_pci_domain(dev),
127 dev->pdev->bus->number,
128 PCI_SLOT(dev->pdev->devfn),
129 PCI_FUNC(dev->pdev->devfn));
130 if (!master->unique)
131 return -ENOMEM;
132
133 master->unique_len = strlen(master->unique);
134 return 0;
135}
136
137static int drm_pci_irq_by_busid(struct drm_device *dev, struct drm_irq_busid *p)
138{
139 if ((p->busnum >> 8) != drm_get_pci_domain(dev) ||
140 (p->busnum & 0xff) != dev->pdev->bus->number ||
141 p->devnum != PCI_SLOT(dev->pdev->devfn) || p->funcnum != PCI_FUNC(dev->pdev->devfn))
142 return -EINVAL;
143
144 p->irq = dev->pdev->irq;
145
146 DRM_DEBUG("%d:%d:%d => IRQ %d\n", p->busnum, p->devnum, p->funcnum,
147 p->irq);
148 return 0;
149}
150
151
152
153
154
155
156
157
158
159
160
161
162
163int drm_irq_by_busid(struct drm_device *dev, void *data,
164 struct drm_file *file_priv)
165{
166 struct drm_irq_busid *p = data;
167
168 if (!drm_core_check_feature(dev, DRIVER_LEGACY))
169 return -EOPNOTSUPP;
170
171
172 if (WARN_ON(!dev->pdev))
173 return -EINVAL;
174
175 if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
176 return -EOPNOTSUPP;
177
178 return drm_pci_irq_by_busid(dev, p);
179}
180
181static void drm_pci_agp_init(struct drm_device *dev)
182{
183 if (drm_core_check_feature(dev, DRIVER_USE_AGP)) {
184 if (pci_find_capability(dev->pdev, PCI_CAP_ID_AGP))
185 dev->agp = drm_agp_init(dev);
186 if (dev->agp) {
187 dev->agp->agp_mtrr = arch_phys_wc_add(
188 dev->agp->agp_info.aper_base,
189 dev->agp->agp_info.aper_size *
190 1024 * 1024);
191 }
192 }
193}
194
195void drm_pci_agp_destroy(struct drm_device *dev)
196{
197 if (dev->agp) {
198 arch_phys_wc_del(dev->agp->agp_mtrr);
199 drm_legacy_agp_clear(dev);
200 kfree(dev->agp);
201 dev->agp = NULL;
202 }
203}
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220int drm_get_pci_dev(struct pci_dev *pdev, const struct pci_device_id *ent,
221 struct drm_driver *driver)
222{
223 struct drm_device *dev;
224 int ret;
225
226 DRM_DEBUG("\n");
227
228 dev = drm_dev_alloc(driver, &pdev->dev);
229 if (IS_ERR(dev))
230 return PTR_ERR(dev);
231
232 ret = pci_enable_device(pdev);
233 if (ret)
234 goto err_free;
235
236 dev->pdev = pdev;
237#ifdef __alpha__
238 dev->hose = pdev->sysdata;
239#endif
240
241 if (drm_core_check_feature(dev, DRIVER_MODESET))
242 pci_set_drvdata(pdev, dev);
243
244 drm_pci_agp_init(dev);
245
246 ret = drm_dev_register(dev, ent->driver_data);
247 if (ret)
248 goto err_agp;
249
250
251
252 if (drm_core_check_feature(dev, DRIVER_LEGACY))
253 list_add_tail(&dev->legacy_dev_list, &driver->legacy_dev_list);
254
255 return 0;
256
257err_agp:
258 drm_pci_agp_destroy(dev);
259 pci_disable_device(pdev);
260err_free:
261 drm_dev_put(dev);
262 return ret;
263}
264EXPORT_SYMBOL(drm_get_pci_dev);
265
266#ifdef CONFIG_DRM_LEGACY
267
268
269
270
271
272
273
274
275
276
277int drm_legacy_pci_init(struct drm_driver *driver, struct pci_driver *pdriver)
278{
279 struct pci_dev *pdev = NULL;
280 const struct pci_device_id *pid;
281 int i;
282
283 DRM_DEBUG("\n");
284
285 if (WARN_ON(!(driver->driver_features & DRIVER_LEGACY)))
286 return -EINVAL;
287
288
289 INIT_LIST_HEAD(&driver->legacy_dev_list);
290 for (i = 0; pdriver->id_table[i].vendor != 0; i++) {
291 pid = &pdriver->id_table[i];
292
293
294
295
296
297
298
299 pdev = NULL;
300 while ((pdev =
301 pci_get_subsys(pid->vendor, pid->device, pid->subvendor,
302 pid->subdevice, pdev)) != NULL) {
303 if ((pdev->class & pid->class_mask) != pid->class)
304 continue;
305
306
307 pci_dev_get(pdev);
308 drm_get_pci_dev(pdev, pid, driver);
309 }
310 }
311 return 0;
312}
313EXPORT_SYMBOL(drm_legacy_pci_init);
314
315
316
317
318
319
320
321
322
323void drm_legacy_pci_exit(struct drm_driver *driver, struct pci_driver *pdriver)
324{
325 struct drm_device *dev, *tmp;
326 DRM_DEBUG("\n");
327
328 if (!(driver->driver_features & DRIVER_LEGACY)) {
329 WARN_ON(1);
330 } else {
331 list_for_each_entry_safe(dev, tmp, &driver->legacy_dev_list,
332 legacy_dev_list) {
333 list_del(&dev->legacy_dev_list);
334 drm_put_dev(dev);
335 }
336 }
337 DRM_INFO("Module unloaded\n");
338}
339EXPORT_SYMBOL(drm_legacy_pci_exit);
340
341#endif
342