1 /* 2 * Copyright 2012 Red Hat Inc. 3 * 4 * Permission is hereby granted, free of charge, to any person obtaining a 5 * copy of this software and associated documentation files (the 6 * "Software"), to deal in the Software without restriction, including 7 * without limitation the rights to use, copy, modify, merge, publish, 8 * distribute, sub license, and/or sell copies of the Software, and to 9 * permit persons to whom the Software is furnished to do so, subject to 10 * the following conditions: 11 * 12 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 13 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 14 * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL 15 * THE COPYRIGHT HOLDERS, AUTHORS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, 16 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR 17 * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE 18 * USE OR OTHER DEALINGS IN THE SOFTWARE. 19 * 20 * The above copyright notice and this permission notice (including the 21 * next paragraph) shall be included in all copies or substantial portions 22 * of the Software. 23 * 24 */ 25 /* 26 * Authors: Dave Airlie <airlied@redhat.com> 27 */ 28 29 #include <linux/console.h> 30 #include <linux/module.h> 31 #include <linux/pci.h> 32 33 #include <drm/drm_crtc_helper.h> 34 #include <drm/drm_drv.h> 35 #include <drm/drm_gem_vram_helper.h> 36 #include <drm/drm_probe_helper.h> 37 38 #include "ast_drv.h" 39 40 int ast_modeset = -1; 41 42 MODULE_PARM_DESC(modeset, "Disable/Enable modesetting"); 43 module_param_named(modeset, ast_modeset, int, 0400); 44 45 #define PCI_VENDOR_ASPEED 0x1a03 46 47 static struct drm_driver driver; 48 49 #define AST_VGA_DEVICE(id, info) { \ 50 .class = PCI_BASE_CLASS_DISPLAY << 16, \ 51 .class_mask = 0xff0000, \ 52 .vendor = PCI_VENDOR_ASPEED, \ 53 .device = id, \ 54 .subvendor = PCI_ANY_ID, \ 55 .subdevice = PCI_ANY_ID, \ 56 .driver_data = (unsigned long) info } 57 58 static const struct pci_device_id pciidlist[] = { 59 AST_VGA_DEVICE(PCI_CHIP_AST2000, NULL), 60 AST_VGA_DEVICE(PCI_CHIP_AST2100, NULL), 61 /* AST_VGA_DEVICE(PCI_CHIP_AST1180, NULL), - don't bind to 1180 for now */ 62 {0, 0, 0}, 63 }; 64 65 MODULE_DEVICE_TABLE(pci, pciidlist); 66 67 static void ast_kick_out_firmware_fb(struct pci_dev *pdev) 68 { 69 struct apertures_struct *ap; 70 bool primary = false; 71 72 ap = alloc_apertures(1); 73 if (!ap) 74 return; 75 76 ap->ranges[0].base = pci_resource_start(pdev, 0); 77 ap->ranges[0].size = pci_resource_len(pdev, 0); 78 79 #ifdef CONFIG_X86 80 primary = pdev->resource[PCI_ROM_RESOURCE].flags & IORESOURCE_ROM_SHADOW; 81 #endif 82 drm_fb_helper_remove_conflicting_framebuffers(ap, "astdrmfb", primary); 83 kfree(ap); 84 } 85 86 static int ast_pci_probe(struct pci_dev *pdev, const struct pci_device_id *ent) 87 { 88 struct drm_device *dev; 89 int ret; 90 91 ast_kick_out_firmware_fb(pdev); 92 93 ret = pci_enable_device(pdev); 94 if (ret) 95 return ret; 96 97 dev = drm_dev_alloc(&driver, &pdev->dev); 98 if (IS_ERR(dev)) { 99 ret = PTR_ERR(dev); 100 goto err_pci_disable_device; 101 } 102 103 dev->pdev = pdev; 104 pci_set_drvdata(pdev, dev); 105 106 ret = ast_driver_load(dev, ent->driver_data); 107 if (ret) 108 goto err_drm_dev_put; 109 110 ret = drm_dev_register(dev, ent->driver_data); 111 if (ret) 112 goto err_ast_driver_unload; 113 114 return 0; 115 116 err_ast_driver_unload: 117 ast_driver_unload(dev); 118 err_drm_dev_put: 119 drm_dev_put(dev); 120 err_pci_disable_device: 121 pci_disable_device(pdev); 122 return ret; 123 124 } 125 126 static void 127 ast_pci_remove(struct pci_dev *pdev) 128 { 129 struct drm_device *dev = pci_get_drvdata(pdev); 130 131 drm_dev_unregister(dev); 132 ast_driver_unload(dev); 133 drm_dev_put(dev); 134 } 135 136 static int ast_drm_freeze(struct drm_device *dev) 137 { 138 int error; 139 140 error = drm_mode_config_helper_suspend(dev); 141 if (error) 142 return error; 143 pci_save_state(dev->pdev); 144 return 0; 145 } 146 147 static int ast_drm_thaw(struct drm_device *dev) 148 { 149 ast_post_gpu(dev); 150 151 return drm_mode_config_helper_resume(dev); 152 } 153 154 static int ast_drm_resume(struct drm_device *dev) 155 { 156 int ret; 157 158 if (pci_enable_device(dev->pdev)) 159 return -EIO; 160 161 ret = ast_drm_thaw(dev); 162 if (ret) 163 return ret; 164 return 0; 165 } 166 167 static int ast_pm_suspend(struct device *dev) 168 { 169 struct pci_dev *pdev = to_pci_dev(dev); 170 struct drm_device *ddev = pci_get_drvdata(pdev); 171 int error; 172 173 error = ast_drm_freeze(ddev); 174 if (error) 175 return error; 176 177 pci_disable_device(pdev); 178 pci_set_power_state(pdev, PCI_D3hot); 179 return 0; 180 } 181 182 static int ast_pm_resume(struct device *dev) 183 { 184 struct pci_dev *pdev = to_pci_dev(dev); 185 struct drm_device *ddev = pci_get_drvdata(pdev); 186 return ast_drm_resume(ddev); 187 } 188 189 static int ast_pm_freeze(struct device *dev) 190 { 191 struct pci_dev *pdev = to_pci_dev(dev); 192 struct drm_device *ddev = pci_get_drvdata(pdev); 193 194 if (!ddev || !ddev->dev_private) 195 return -ENODEV; 196 return ast_drm_freeze(ddev); 197 } 198 199 static int ast_pm_thaw(struct device *dev) 200 { 201 struct pci_dev *pdev = to_pci_dev(dev); 202 struct drm_device *ddev = pci_get_drvdata(pdev); 203 return ast_drm_thaw(ddev); 204 } 205 206 static int ast_pm_poweroff(struct device *dev) 207 { 208 struct pci_dev *pdev = to_pci_dev(dev); 209 struct drm_device *ddev = pci_get_drvdata(pdev); 210 211 return ast_drm_freeze(ddev); 212 } 213 214 static const struct dev_pm_ops ast_pm_ops = { 215 .suspend = ast_pm_suspend, 216 .resume = ast_pm_resume, 217 .freeze = ast_pm_freeze, 218 .thaw = ast_pm_thaw, 219 .poweroff = ast_pm_poweroff, 220 .restore = ast_pm_resume, 221 }; 222 223 static struct pci_driver ast_pci_driver = { 224 .name = DRIVER_NAME, 225 .id_table = pciidlist, 226 .probe = ast_pci_probe, 227 .remove = ast_pci_remove, 228 .driver.pm = &ast_pm_ops, 229 }; 230 231 DEFINE_DRM_GEM_FOPS(ast_fops); 232 233 static struct drm_driver driver = { 234 .driver_features = DRIVER_ATOMIC | 235 DRIVER_GEM | 236 DRIVER_MODESET, 237 238 .fops = &ast_fops, 239 .name = DRIVER_NAME, 240 .desc = DRIVER_DESC, 241 .date = DRIVER_DATE, 242 .major = DRIVER_MAJOR, 243 .minor = DRIVER_MINOR, 244 .patchlevel = DRIVER_PATCHLEVEL, 245 246 DRM_GEM_VRAM_DRIVER 247 }; 248 249 static int __init ast_init(void) 250 { 251 if (vgacon_text_force() && ast_modeset == -1) 252 return -EINVAL; 253 254 if (ast_modeset == 0) 255 return -EINVAL; 256 return pci_register_driver(&ast_pci_driver); 257 } 258 static void __exit ast_exit(void) 259 { 260 pci_unregister_driver(&ast_pci_driver); 261 } 262 263 module_init(ast_init); 264 module_exit(ast_exit); 265 266 MODULE_AUTHOR(DRIVER_AUTHOR); 267 MODULE_DESCRIPTION(DRIVER_DESC); 268 MODULE_LICENSE("GPL and additional rights"); 269 270