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/list.h>
28#include <linux/mutex.h>
29#include <linux/pci.h>
30#include <linux/slab.h>
31
32#include <drm/drm.h>
33#include <drm/drm_drv.h>
34#include <drm/drm_print.h>
35
36#include "drm_internal.h"
37#include "drm_legacy.h"
38
39#ifdef CONFIG_DRM_LEGACY
40
41static LIST_HEAD(legacy_dev_list);
42static DEFINE_MUTEX(legacy_dev_list_lock);
43#endif
44
45static int drm_get_pci_domain(struct drm_device *dev)
46{
47#ifndef __alpha__
48
49
50
51
52 if (dev->if_version < 0x10004)
53 return 0;
54#endif
55
56 return pci_domain_nr(to_pci_dev(dev->dev)->bus);
57}
58
59int drm_pci_set_busid(struct drm_device *dev, struct drm_master *master)
60{
61 struct pci_dev *pdev = to_pci_dev(dev->dev);
62
63 master->unique = kasprintf(GFP_KERNEL, "pci:%04x:%02x:%02x.%d",
64 drm_get_pci_domain(dev),
65 pdev->bus->number,
66 PCI_SLOT(pdev->devfn),
67 PCI_FUNC(pdev->devfn));
68 if (!master->unique)
69 return -ENOMEM;
70
71 master->unique_len = strlen(master->unique);
72 return 0;
73}
74
75#ifdef CONFIG_DRM_LEGACY
76
77static int drm_legacy_pci_irq_by_busid(struct drm_device *dev, struct drm_irq_busid *p)
78{
79 struct pci_dev *pdev = to_pci_dev(dev->dev);
80
81 if ((p->busnum >> 8) != drm_get_pci_domain(dev) ||
82 (p->busnum & 0xff) != pdev->bus->number ||
83 p->devnum != PCI_SLOT(pdev->devfn) || p->funcnum != PCI_FUNC(pdev->devfn))
84 return -EINVAL;
85
86 p->irq = pdev->irq;
87
88 DRM_DEBUG("%d:%d:%d => IRQ %d\n", p->busnum, p->devnum, p->funcnum,
89 p->irq);
90 return 0;
91}
92
93
94
95
96
97
98
99
100
101
102
103
104
105int drm_legacy_irq_by_busid(struct drm_device *dev, void *data,
106 struct drm_file *file_priv)
107{
108 struct drm_irq_busid *p = data;
109
110 if (!drm_core_check_feature(dev, DRIVER_LEGACY))
111 return -EOPNOTSUPP;
112
113
114 if (WARN_ON(!dev_is_pci(dev->dev)))
115 return -EINVAL;
116
117 if (!drm_core_check_feature(dev, DRIVER_HAVE_IRQ))
118 return -EOPNOTSUPP;
119
120 return drm_legacy_pci_irq_by_busid(dev, p);
121}
122
123void drm_legacy_pci_agp_destroy(struct drm_device *dev)
124{
125 if (dev->agp) {
126 arch_phys_wc_del(dev->agp->agp_mtrr);
127 drm_legacy_agp_clear(dev);
128 kfree(dev->agp);
129 dev->agp = NULL;
130 }
131}
132
133static void drm_legacy_pci_agp_init(struct drm_device *dev)
134{
135 if (drm_core_check_feature(dev, DRIVER_USE_AGP)) {
136 if (pci_find_capability(to_pci_dev(dev->dev), PCI_CAP_ID_AGP))
137 dev->agp = drm_legacy_agp_init(dev);
138 if (dev->agp) {
139 dev->agp->agp_mtrr = arch_phys_wc_add(
140 dev->agp->agp_info.aper_base,
141 dev->agp->agp_info.aper_size *
142 1024 * 1024);
143 }
144 }
145}
146
147static int drm_legacy_get_pci_dev(struct pci_dev *pdev,
148 const struct pci_device_id *ent,
149 const struct drm_driver *driver)
150{
151 struct drm_device *dev;
152 int ret;
153
154 DRM_DEBUG("\n");
155
156 dev = drm_dev_alloc(driver, &pdev->dev);
157 if (IS_ERR(dev))
158 return PTR_ERR(dev);
159
160 ret = pci_enable_device(pdev);
161 if (ret)
162 goto err_free;
163
164#ifdef __alpha__
165 dev->hose = pdev->sysdata;
166#endif
167
168 drm_legacy_pci_agp_init(dev);
169
170 ret = drm_dev_register(dev, ent->driver_data);
171 if (ret)
172 goto err_agp;
173
174 if (drm_core_check_feature(dev, DRIVER_LEGACY)) {
175 mutex_lock(&legacy_dev_list_lock);
176 list_add_tail(&dev->legacy_dev_list, &legacy_dev_list);
177 mutex_unlock(&legacy_dev_list_lock);
178 }
179
180 return 0;
181
182err_agp:
183 drm_legacy_pci_agp_destroy(dev);
184 pci_disable_device(pdev);
185err_free:
186 drm_dev_put(dev);
187 return ret;
188}
189
190
191
192
193
194
195
196
197
198
199int drm_legacy_pci_init(const struct drm_driver *driver,
200 struct pci_driver *pdriver)
201{
202 struct pci_dev *pdev = NULL;
203 const struct pci_device_id *pid;
204 int i;
205
206 DRM_DEBUG("\n");
207
208 if (WARN_ON(!(driver->driver_features & DRIVER_LEGACY)))
209 return -EINVAL;
210
211
212 for (i = 0; pdriver->id_table[i].vendor != 0; i++) {
213 pid = &pdriver->id_table[i];
214
215
216
217
218
219
220
221 pdev = NULL;
222 while ((pdev =
223 pci_get_subsys(pid->vendor, pid->device, pid->subvendor,
224 pid->subdevice, pdev)) != NULL) {
225 if ((pdev->class & pid->class_mask) != pid->class)
226 continue;
227
228
229 pci_dev_get(pdev);
230 drm_legacy_get_pci_dev(pdev, pid, driver);
231 }
232 }
233 return 0;
234}
235EXPORT_SYMBOL(drm_legacy_pci_init);
236
237
238
239
240
241
242
243
244
245void drm_legacy_pci_exit(const struct drm_driver *driver,
246 struct pci_driver *pdriver)
247{
248 struct drm_device *dev, *tmp;
249
250 DRM_DEBUG("\n");
251
252 if (!(driver->driver_features & DRIVER_LEGACY)) {
253 WARN_ON(1);
254 } else {
255 mutex_lock(&legacy_dev_list_lock);
256 list_for_each_entry_safe(dev, tmp, &legacy_dev_list,
257 legacy_dev_list) {
258 if (dev->driver == driver) {
259 list_del(&dev->legacy_dev_list);
260 drm_put_dev(dev);
261 }
262 }
263 mutex_unlock(&legacy_dev_list_lock);
264 }
265 DRM_INFO("Module unloaded\n");
266}
267EXPORT_SYMBOL(drm_legacy_pci_exit);
268
269#endif
270