mgag200_drv.c

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