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