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 
91ee181feSThomas Zimmermann void mgag200_g200eh_init_registers(struct mga_device *mdev)
101ee181feSThomas Zimmermann {
111ee181feSThomas Zimmermann 	static const u8 dacvalue[] = {
121ee181feSThomas Zimmermann 		MGAG200_DAC_DEFAULT(0x00, 0xc9,
131ee181feSThomas Zimmermann 				    MGA1064_MISC_CTL_VGA8 | MGA1064_MISC_CTL_DAC_RAM_CS,
141ee181feSThomas Zimmermann 				    0x00, 0x00, 0x00)
151ee181feSThomas Zimmermann 	};
161ee181feSThomas Zimmermann 
171ee181feSThomas Zimmermann 	size_t i;
181ee181feSThomas Zimmermann 
191ee181feSThomas Zimmermann 	for (i = 0; i < ARRAY_SIZE(dacvalue); i++) {
201ee181feSThomas Zimmermann 		if ((i <= 0x17) ||
211ee181feSThomas Zimmermann 		    (i == 0x1b) ||
221ee181feSThomas Zimmermann 		    (i == 0x1c) ||
231ee181feSThomas Zimmermann 		    ((i >= 0x1f) && (i <= 0x29)) ||
241ee181feSThomas Zimmermann 		    ((i >= 0x30) && (i <= 0x37)) ||
251ee181feSThomas Zimmermann 		    ((i >= 0x44) && (i <= 0x4e)))
261ee181feSThomas Zimmermann 			continue;
271ee181feSThomas Zimmermann 		WREG_DAC(i, dacvalue[i]);
281ee181feSThomas Zimmermann 	}
291ee181feSThomas Zimmermann 
301ee181feSThomas Zimmermann 	mgag200_init_registers(mdev);
311ee181feSThomas Zimmermann }
321ee181feSThomas 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 
40*f639f74aSThomas Zimmermann static const struct mgag200_device_funcs mgag200_g200eh_device_funcs = {
41*f639f74aSThomas Zimmermann };
42*f639f74aSThomas Zimmermann 
4385397f6bSThomas Zimmermann struct mga_device *mgag200_g200eh_device_create(struct pci_dev *pdev, const struct drm_driver *drv,
4421e74bf9SThomas Zimmermann 						enum mga_type type)
4585397f6bSThomas Zimmermann {
4685397f6bSThomas Zimmermann 	struct mga_device *mdev;
4785397f6bSThomas Zimmermann 	struct drm_device *dev;
48d45e32c9SThomas Zimmermann 	resource_size_t vram_available;
4985397f6bSThomas Zimmermann 	int ret;
5085397f6bSThomas Zimmermann 
5185397f6bSThomas Zimmermann 	mdev = devm_drm_dev_alloc(&pdev->dev, drv, struct mga_device, base);
5285397f6bSThomas Zimmermann 	if (IS_ERR(mdev))
5385397f6bSThomas Zimmermann 		return mdev;
5485397f6bSThomas Zimmermann 	dev = &mdev->base;
5585397f6bSThomas Zimmermann 
5685397f6bSThomas Zimmermann 	pci_set_drvdata(pdev, dev);
5785397f6bSThomas Zimmermann 
58ce19021fSThomas Zimmermann 	ret = mgag200_init_pci_options(pdev, 0x00000120, 0x0000b000);
59ce19021fSThomas Zimmermann 	if (ret)
60ce19021fSThomas Zimmermann 		return ERR_PTR(ret);
61ce19021fSThomas Zimmermann 
62b62d943eSThomas Zimmermann 	ret = mgag200_device_preinit(mdev);
6385397f6bSThomas Zimmermann 	if (ret)
6485397f6bSThomas Zimmermann 		return ERR_PTR(ret);
6585397f6bSThomas Zimmermann 
66*f639f74aSThomas Zimmermann 	ret = mgag200_device_init(mdev, type, &mgag200_g200eh_device_info,
67*f639f74aSThomas Zimmermann 				  &mgag200_g200eh_device_funcs);
6885397f6bSThomas Zimmermann 	if (ret)
6985397f6bSThomas Zimmermann 		return ERR_PTR(ret);
7085397f6bSThomas Zimmermann 
711ee181feSThomas Zimmermann 	mgag200_g200eh_init_registers(mdev);
721ee181feSThomas Zimmermann 
73d45e32c9SThomas Zimmermann 	vram_available = mgag200_device_probe_vram(mdev);
74d45e32c9SThomas Zimmermann 
75d45e32c9SThomas Zimmermann 	ret = mgag200_modeset_init(mdev, vram_available);
7685397f6bSThomas Zimmermann 	if (ret)
7785397f6bSThomas Zimmermann 		return ERR_PTR(ret);
7885397f6bSThomas Zimmermann 
7985397f6bSThomas Zimmermann 	return mdev;
8085397f6bSThomas Zimmermann }
81