xref: /linux/drivers/gpu/drm/mgag200/mgag200_drv.c (revision 2c1ed907520c50326b8f604907a8478b27881a2e)
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Copyright 2012 Red Hat
4  *
5  * Authors: Matthew Garrett
6  *          Dave Airlie
7  */
8 
9 #include <linux/aperture.h>
10 #include <linux/module.h>
11 #include <linux/pci.h>
12 
13 #include <drm/clients/drm_client_setup.h>
14 #include <drm/drm_atomic_helper.h>
15 #include <drm/drm_drv.h>
16 #include <drm/drm_fbdev_shmem.h>
17 #include <drm/drm_file.h>
18 #include <drm/drm_fourcc.h>
19 #include <drm/drm_ioctl.h>
20 #include <drm/drm_managed.h>
21 #include <drm/drm_module.h>
22 #include <drm/drm_pciids.h>
23 
24 #include "mgag200_drv.h"
25 
26 static int mgag200_modeset = -1;
27 MODULE_PARM_DESC(modeset, "Disable/Enable modesetting");
28 module_param_named(modeset, mgag200_modeset, int, 0400);
29 
mgag200_init_pci_options(struct pci_dev * pdev,u32 option,u32 option2)30 int mgag200_init_pci_options(struct pci_dev *pdev, u32 option, u32 option2)
31 {
32 	struct device *dev = &pdev->dev;
33 	int err;
34 
35 	err = pci_write_config_dword(pdev, PCI_MGA_OPTION, option);
36 	if (err != PCIBIOS_SUCCESSFUL) {
37 		dev_err(dev, "pci_write_config_dword(PCI_MGA_OPTION) failed: %d\n", err);
38 		return pcibios_err_to_errno(err);
39 	}
40 
41 	err = pci_write_config_dword(pdev, PCI_MGA_OPTION2, option2);
42 	if (err != PCIBIOS_SUCCESSFUL) {
43 		dev_err(dev, "pci_write_config_dword(PCI_MGA_OPTION2) failed: %d\n", err);
44 		return pcibios_err_to_errno(err);
45 	}
46 
47 	return 0;
48 }
49 
mgag200_probe_vram(void __iomem * mem,resource_size_t size)50 resource_size_t mgag200_probe_vram(void __iomem *mem, resource_size_t size)
51 {
52 	int offset;
53 	int orig;
54 	int test1, test2;
55 	int orig1, orig2;
56 	size_t vram_size;
57 
58 	/* Probe */
59 	orig = ioread16(mem);
60 	iowrite16(0, mem);
61 
62 	vram_size = size;
63 
64 	for (offset = 0x100000; offset < vram_size; offset += 0x4000) {
65 		orig1 = ioread8(mem + offset);
66 		orig2 = ioread8(mem + offset + 0x100);
67 
68 		iowrite16(0xaa55, mem + offset);
69 		iowrite16(0xaa55, mem + offset + 0x100);
70 
71 		test1 = ioread16(mem + offset);
72 		test2 = ioread16(mem);
73 
74 		iowrite16(orig1, mem + offset);
75 		iowrite16(orig2, mem + offset + 0x100);
76 
77 		if (test1 != 0xaa55)
78 			break;
79 
80 		if (test2)
81 			break;
82 	}
83 
84 	iowrite16(orig, mem);
85 
86 	return offset - 65536;
87 }
88 
89 /*
90  * DRM driver
91  */
92 
93 DEFINE_DRM_GEM_FOPS(mgag200_driver_fops);
94 
95 static const struct drm_driver mgag200_driver = {
96 	.driver_features = DRIVER_ATOMIC | DRIVER_GEM | DRIVER_MODESET,
97 	.fops = &mgag200_driver_fops,
98 	.name = DRIVER_NAME,
99 	.desc = DRIVER_DESC,
100 	.major = DRIVER_MAJOR,
101 	.minor = DRIVER_MINOR,
102 	.patchlevel = DRIVER_PATCHLEVEL,
103 	DRM_GEM_SHMEM_DRIVER_OPS,
104 	DRM_FBDEV_SHMEM_DRIVER_OPS,
105 };
106 
107 /*
108  * DRM device
109  */
110 
mgag200_device_probe_vram(struct mga_device * mdev)111 resource_size_t mgag200_device_probe_vram(struct mga_device *mdev)
112 {
113 	return mgag200_probe_vram(mdev->vram, resource_size(mdev->vram_res));
114 }
115 
mgag200_device_preinit(struct mga_device * mdev)116 int mgag200_device_preinit(struct mga_device *mdev)
117 {
118 	struct drm_device *dev = &mdev->base;
119 	struct pci_dev *pdev = to_pci_dev(dev->dev);
120 	resource_size_t start, len;
121 	struct resource *res;
122 
123 	/* BAR 1 contains registers */
124 
125 	start = pci_resource_start(pdev, 1);
126 	len = pci_resource_len(pdev, 1);
127 
128 	res = devm_request_mem_region(dev->dev, start, len, "mgadrmfb_mmio");
129 	if (!res) {
130 		drm_err(dev, "devm_request_mem_region(MMIO) failed\n");
131 		return -ENXIO;
132 	}
133 	mdev->rmmio_res = res;
134 
135 	mdev->rmmio = pcim_iomap(pdev, 1, 0);
136 	if (!mdev->rmmio)
137 		return -ENOMEM;
138 
139 	/* BAR 0 is VRAM */
140 
141 	start = pci_resource_start(pdev, 0);
142 	len = pci_resource_len(pdev, 0);
143 
144 	res = devm_request_mem_region(dev->dev, start, len, "mgadrmfb_vram");
145 	if (!res) {
146 		drm_err(dev, "devm_request_mem_region(VRAM) failed\n");
147 		return -ENXIO;
148 	}
149 	mdev->vram_res = res;
150 
151 #if defined(CONFIG_DRM_MGAG200_DISABLE_WRITECOMBINE)
152 	mdev->vram = devm_ioremap(dev->dev, res->start, resource_size(res));
153 	if (!mdev->vram)
154 		return -ENOMEM;
155 #else
156 	mdev->vram = devm_ioremap_wc(dev->dev, res->start, resource_size(res));
157 	if (!mdev->vram)
158 		return -ENOMEM;
159 
160 	/* Don't fail on errors, but performance might be reduced. */
161 	devm_arch_phys_wc_add(dev->dev, res->start, resource_size(res));
162 #endif
163 
164 	return 0;
165 }
166 
mgag200_device_init(struct mga_device * mdev,const struct mgag200_device_info * info,const struct mgag200_device_funcs * funcs)167 int mgag200_device_init(struct mga_device *mdev,
168 			const struct mgag200_device_info *info,
169 			const struct mgag200_device_funcs *funcs)
170 {
171 	struct drm_device *dev = &mdev->base;
172 	u8 crtcext3, misc;
173 	int ret;
174 
175 	mdev->info = info;
176 	mdev->funcs = funcs;
177 
178 	ret = drmm_mutex_init(dev, &mdev->rmmio_lock);
179 	if (ret)
180 		return ret;
181 
182 	mutex_lock(&mdev->rmmio_lock);
183 
184 	RREG_ECRT(0x03, crtcext3);
185 	crtcext3 |= MGAREG_CRTCEXT3_MGAMODE;
186 	WREG_ECRT(0x03, crtcext3);
187 
188 	WREG_ECRT(0x04, 0x00);
189 
190 	misc = RREG8(MGA_MISC_IN);
191 	misc |= MGAREG_MISC_RAMMAPEN |
192 		MGAREG_MISC_HIGH_PG_SEL;
193 	WREG8(MGA_MISC_OUT, misc);
194 
195 	mutex_unlock(&mdev->rmmio_lock);
196 
197 	WREG32(MGAREG_IEN, 0);
198 
199 	return 0;
200 }
201 
202 /*
203  * PCI driver
204  */
205 
206 static const struct pci_device_id mgag200_pciidlist[] = {
207 	{ PCI_VENDOR_ID_MATROX, 0x520, PCI_ANY_ID, PCI_ANY_ID, 0, 0, G200_PCI },
208 	{ PCI_VENDOR_ID_MATROX, 0x521, PCI_ANY_ID, PCI_ANY_ID, 0, 0, G200_AGP },
209 	{ PCI_VENDOR_ID_MATROX, 0x522, PCI_ANY_ID, PCI_ANY_ID, 0, 0, G200_SE_A },
210 	{ PCI_VENDOR_ID_MATROX, 0x524, PCI_ANY_ID, PCI_ANY_ID, 0, 0, G200_SE_B },
211 	{ PCI_VENDOR_ID_MATROX, 0x530, PCI_ANY_ID, PCI_ANY_ID, 0, 0, G200_EV },
212 	{ PCI_VENDOR_ID_MATROX, 0x532, PCI_ANY_ID, PCI_ANY_ID, 0, 0, G200_WB },
213 	{ PCI_VENDOR_ID_MATROX, 0x533, PCI_ANY_ID, PCI_ANY_ID, 0, 0, G200_EH },
214 	{ PCI_VENDOR_ID_MATROX, 0x534, PCI_ANY_ID, PCI_ANY_ID, 0, 0, G200_ER },
215 	{ PCI_VENDOR_ID_MATROX, 0x536, PCI_ANY_ID, PCI_ANY_ID, 0, 0, G200_EW3 },
216 	{ PCI_VENDOR_ID_MATROX, 0x538, PCI_ANY_ID, PCI_ANY_ID, 0, 0, G200_EH3 },
217 	{0,}
218 };
219 
220 MODULE_DEVICE_TABLE(pci, mgag200_pciidlist);
221 
222 static int
mgag200_pci_probe(struct pci_dev * pdev,const struct pci_device_id * ent)223 mgag200_pci_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
224 {
225 	enum mga_type type = (enum mga_type)ent->driver_data;
226 	struct mga_device *mdev;
227 	struct drm_device *dev;
228 	int ret;
229 
230 	ret = aperture_remove_conflicting_pci_devices(pdev, mgag200_driver.name);
231 	if (ret)
232 		return ret;
233 
234 	ret = pcim_enable_device(pdev);
235 	if (ret)
236 		return ret;
237 
238 	switch (type) {
239 	case G200_PCI:
240 	case G200_AGP:
241 		mdev = mgag200_g200_device_create(pdev, &mgag200_driver);
242 		break;
243 	case G200_SE_A:
244 	case G200_SE_B:
245 		mdev = mgag200_g200se_device_create(pdev, &mgag200_driver, type);
246 		break;
247 	case G200_WB:
248 		mdev = mgag200_g200wb_device_create(pdev, &mgag200_driver);
249 		break;
250 	case G200_EV:
251 		mdev = mgag200_g200ev_device_create(pdev, &mgag200_driver);
252 		break;
253 	case G200_EH:
254 		mdev = mgag200_g200eh_device_create(pdev, &mgag200_driver);
255 		break;
256 	case G200_EH3:
257 		mdev = mgag200_g200eh3_device_create(pdev, &mgag200_driver);
258 		break;
259 	case G200_ER:
260 		mdev = mgag200_g200er_device_create(pdev, &mgag200_driver);
261 		break;
262 	case G200_EW3:
263 		mdev = mgag200_g200ew3_device_create(pdev, &mgag200_driver);
264 		break;
265 	default:
266 		dev_err(&pdev->dev, "Device type %d is unsupported\n", type);
267 		return -ENODEV;
268 	}
269 	if (IS_ERR(mdev))
270 		return PTR_ERR(mdev);
271 	dev = &mdev->base;
272 
273 	ret = drm_dev_register(dev, 0);
274 	if (ret)
275 		return ret;
276 
277 	/*
278 	 * FIXME: A 24-bit color depth does not work with 24 bpp on
279 	 * G200ER. Force 32 bpp.
280 	 */
281 	drm_client_setup_with_fourcc(dev, DRM_FORMAT_XRGB8888);
282 
283 	return 0;
284 }
285 
mgag200_pci_remove(struct pci_dev * pdev)286 static void mgag200_pci_remove(struct pci_dev *pdev)
287 {
288 	struct drm_device *dev = pci_get_drvdata(pdev);
289 
290 	drm_dev_unregister(dev);
291 	drm_atomic_helper_shutdown(dev);
292 }
293 
mgag200_pci_shutdown(struct pci_dev * pdev)294 static void mgag200_pci_shutdown(struct pci_dev *pdev)
295 {
296 	drm_atomic_helper_shutdown(pci_get_drvdata(pdev));
297 }
298 
299 static struct pci_driver mgag200_pci_driver = {
300 	.name = DRIVER_NAME,
301 	.id_table = mgag200_pciidlist,
302 	.probe = mgag200_pci_probe,
303 	.remove = mgag200_pci_remove,
304 	.shutdown = mgag200_pci_shutdown,
305 };
306 
307 drm_module_pci_driver_if_modeset(mgag200_pci_driver, mgag200_modeset);
308 
309 MODULE_AUTHOR(DRIVER_AUTHOR);
310 MODULE_DESCRIPTION(DRIVER_DESC);
311 MODULE_LICENSE("GPL");
312