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_g200wb_init_registers(struct mga_device *mdev)
10*1ee181feSThomas Zimmermann {
11*1ee181feSThomas Zimmermann 	static const u8 dacvalue[] = {
12*1ee181feSThomas Zimmermann 		MGAG200_DAC_DEFAULT(0x07, 0xc9, 0x1f, 0x00, 0x00, 0x00)
13*1ee181feSThomas Zimmermann 	};
14*1ee181feSThomas Zimmermann 
15*1ee181feSThomas Zimmermann 	size_t i;
16*1ee181feSThomas Zimmermann 
17*1ee181feSThomas Zimmermann 	for (i = 0; i < ARRAY_SIZE(dacvalue); i++) {
18*1ee181feSThomas Zimmermann 		if ((i <= 0x17) ||
19*1ee181feSThomas Zimmermann 		    (i == 0x1b) ||
20*1ee181feSThomas Zimmermann 		    (i == 0x1c) ||
21*1ee181feSThomas Zimmermann 		    ((i >= 0x1f) && (i <= 0x29)) ||
22*1ee181feSThomas Zimmermann 		    ((i >= 0x30) && (i <= 0x37)) ||
23*1ee181feSThomas Zimmermann 		    ((i >= 0x44) && (i <= 0x4e)))
24*1ee181feSThomas Zimmermann 			continue;
25*1ee181feSThomas Zimmermann 		WREG_DAC(i, dacvalue[i]);
26*1ee181feSThomas Zimmermann 	}
27*1ee181feSThomas Zimmermann 
28*1ee181feSThomas Zimmermann 	mgag200_init_registers(mdev);
29*1ee181feSThomas Zimmermann }
30*1ee181feSThomas Zimmermann 
3185397f6bSThomas Zimmermann /*
3285397f6bSThomas Zimmermann  * DRM device
3385397f6bSThomas Zimmermann  */
3485397f6bSThomas Zimmermann 
35b9a577a4SThomas Zimmermann static const struct mgag200_device_info mgag200_g200wb_device_info =
36da1efdb2SThomas Zimmermann 	MGAG200_DEVICE_INFO_INIT(1280, 1024, 31877, true, 0, 1, false);
37b9a577a4SThomas Zimmermann 
3885397f6bSThomas Zimmermann struct mga_device *mgag200_g200wb_device_create(struct pci_dev *pdev, const struct drm_driver *drv,
3921e74bf9SThomas Zimmermann 						enum mga_type type)
4085397f6bSThomas Zimmermann {
4185397f6bSThomas Zimmermann 	struct mga_device *mdev;
4285397f6bSThomas Zimmermann 	struct drm_device *dev;
43d45e32c9SThomas Zimmermann 	resource_size_t vram_available;
4485397f6bSThomas Zimmermann 	int ret;
4585397f6bSThomas Zimmermann 
4685397f6bSThomas Zimmermann 	mdev = devm_drm_dev_alloc(&pdev->dev, drv, struct mga_device, base);
4785397f6bSThomas Zimmermann 	if (IS_ERR(mdev))
4885397f6bSThomas Zimmermann 		return mdev;
4985397f6bSThomas Zimmermann 	dev = &mdev->base;
5085397f6bSThomas Zimmermann 
5185397f6bSThomas Zimmermann 	pci_set_drvdata(pdev, dev);
5285397f6bSThomas Zimmermann 
53ce19021fSThomas Zimmermann 	ret = mgag200_init_pci_options(pdev, 0x41049120, 0x0000b000);
54ce19021fSThomas Zimmermann 	if (ret)
55ce19021fSThomas Zimmermann 		return ERR_PTR(ret);
56ce19021fSThomas Zimmermann 
57b62d943eSThomas Zimmermann 	ret = mgag200_device_preinit(mdev);
5885397f6bSThomas Zimmermann 	if (ret)
5985397f6bSThomas Zimmermann 		return ERR_PTR(ret);
6085397f6bSThomas Zimmermann 
6121e74bf9SThomas Zimmermann 	ret = mgag200_device_init(mdev, type, &mgag200_g200wb_device_info);
6285397f6bSThomas Zimmermann 	if (ret)
6385397f6bSThomas Zimmermann 		return ERR_PTR(ret);
6485397f6bSThomas Zimmermann 
65*1ee181feSThomas Zimmermann 	mgag200_g200wb_init_registers(mdev);
66*1ee181feSThomas Zimmermann 
67d45e32c9SThomas Zimmermann 	vram_available = mgag200_device_probe_vram(mdev);
68d45e32c9SThomas Zimmermann 
69d45e32c9SThomas Zimmermann 	ret = mgag200_modeset_init(mdev, vram_available);
7085397f6bSThomas Zimmermann 	if (ret)
7185397f6bSThomas Zimmermann 		return ERR_PTR(ret);
7285397f6bSThomas Zimmermann 
7385397f6bSThomas Zimmermann 	return mdev;
7485397f6bSThomas Zimmermann }
75