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