185397f6bSThomas Zimmermann // SPDX-License-Identifier: GPL-2.0-only
285397f6bSThomas Zimmermann 
385397f6bSThomas Zimmermann #include <linux/pci.h>
485397f6bSThomas Zimmermann 
585397f6bSThomas Zimmermann #include <drm/drm_drv.h>
685397f6bSThomas Zimmermann 
785397f6bSThomas Zimmermann #include "mgag200_drv.h"
885397f6bSThomas Zimmermann 
9*1ee181feSThomas Zimmermann void mgag200_g200eh_init_registers(struct mga_device *mdev)
10*1ee181feSThomas Zimmermann {
11*1ee181feSThomas Zimmermann 	static const u8 dacvalue[] = {
12*1ee181feSThomas Zimmermann 		MGAG200_DAC_DEFAULT(0x00, 0xc9,
13*1ee181feSThomas Zimmermann 				    MGA1064_MISC_CTL_VGA8 | MGA1064_MISC_CTL_DAC_RAM_CS,
14*1ee181feSThomas Zimmermann 				    0x00, 0x00, 0x00)
15*1ee181feSThomas Zimmermann 	};
16*1ee181feSThomas Zimmermann 
17*1ee181feSThomas Zimmermann 	size_t i;
18*1ee181feSThomas Zimmermann 
19*1ee181feSThomas Zimmermann 	for (i = 0; i < ARRAY_SIZE(dacvalue); i++) {
20*1ee181feSThomas Zimmermann 		if ((i <= 0x17) ||
21*1ee181feSThomas Zimmermann 		    (i == 0x1b) ||
22*1ee181feSThomas Zimmermann 		    (i == 0x1c) ||
23*1ee181feSThomas Zimmermann 		    ((i >= 0x1f) && (i <= 0x29)) ||
24*1ee181feSThomas Zimmermann 		    ((i >= 0x30) && (i <= 0x37)) ||
25*1ee181feSThomas Zimmermann 		    ((i >= 0x44) && (i <= 0x4e)))
26*1ee181feSThomas Zimmermann 			continue;
27*1ee181feSThomas Zimmermann 		WREG_DAC(i, dacvalue[i]);
28*1ee181feSThomas Zimmermann 	}
29*1ee181feSThomas Zimmermann 
30*1ee181feSThomas Zimmermann 	mgag200_init_registers(mdev);
31*1ee181feSThomas Zimmermann }
32*1ee181feSThomas Zimmermann 
3385397f6bSThomas Zimmermann /*
3485397f6bSThomas Zimmermann  * DRM device
3585397f6bSThomas Zimmermann  */
3685397f6bSThomas Zimmermann 
37b9a577a4SThomas Zimmermann static const struct mgag200_device_info mgag200_g200eh_device_info =
38da1efdb2SThomas Zimmermann 	MGAG200_DEVICE_INFO_INIT(2048, 2048, 37500, false, 1, 0, false);
39b9a577a4SThomas Zimmermann 
4085397f6bSThomas Zimmermann struct mga_device *mgag200_g200eh_device_create(struct pci_dev *pdev, const struct drm_driver *drv,
4121e74bf9SThomas Zimmermann 						enum mga_type type)
4285397f6bSThomas Zimmermann {
4385397f6bSThomas Zimmermann 	struct mga_device *mdev;
4485397f6bSThomas Zimmermann 	struct drm_device *dev;
45d45e32c9SThomas Zimmermann 	resource_size_t vram_available;
4685397f6bSThomas Zimmermann 	int ret;
4785397f6bSThomas Zimmermann 
4885397f6bSThomas Zimmermann 	mdev = devm_drm_dev_alloc(&pdev->dev, drv, struct mga_device, base);
4985397f6bSThomas Zimmermann 	if (IS_ERR(mdev))
5085397f6bSThomas Zimmermann 		return mdev;
5185397f6bSThomas Zimmermann 	dev = &mdev->base;
5285397f6bSThomas Zimmermann 
5385397f6bSThomas Zimmermann 	pci_set_drvdata(pdev, dev);
5485397f6bSThomas Zimmermann 
55ce19021fSThomas Zimmermann 	ret = mgag200_init_pci_options(pdev, 0x00000120, 0x0000b000);
56ce19021fSThomas Zimmermann 	if (ret)
57ce19021fSThomas Zimmermann 		return ERR_PTR(ret);
58ce19021fSThomas Zimmermann 
59b62d943eSThomas Zimmermann 	ret = mgag200_device_preinit(mdev);
6085397f6bSThomas Zimmermann 	if (ret)
6185397f6bSThomas Zimmermann 		return ERR_PTR(ret);
6285397f6bSThomas Zimmermann 
6321e74bf9SThomas Zimmermann 	ret = mgag200_device_init(mdev, type, &mgag200_g200eh_device_info);
6485397f6bSThomas Zimmermann 	if (ret)
6585397f6bSThomas Zimmermann 		return ERR_PTR(ret);
6685397f6bSThomas Zimmermann 
67*1ee181feSThomas Zimmermann 	mgag200_g200eh_init_registers(mdev);
68*1ee181feSThomas Zimmermann 
69d45e32c9SThomas Zimmermann 	vram_available = mgag200_device_probe_vram(mdev);
70d45e32c9SThomas Zimmermann 
71d45e32c9SThomas Zimmermann 	ret = mgag200_modeset_init(mdev, vram_available);
7285397f6bSThomas Zimmermann 	if (ret)
7385397f6bSThomas Zimmermann 		return ERR_PTR(ret);
7485397f6bSThomas Zimmermann 
7585397f6bSThomas Zimmermann 	return mdev;
7685397f6bSThomas Zimmermann }
77