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