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_aperture.h> 34 #include <drm/drm_atomic_helper.h> 35 #include <drm/drm_crtc_helper.h> 36 #include <drm/drm_drv.h> 37 #include <drm/drm_gem_vram_helper.h> 38 #include <drm/drm_probe_helper.h> 39 40 #include "ast_drv.h" 41 42 int ast_modeset = -1; 43 44 MODULE_PARM_DESC(modeset, "Disable/Enable modesetting"); 45 module_param_named(modeset, ast_modeset, int, 0400); 46 47 /* 48 * DRM driver 49 */ 50 51 DEFINE_DRM_GEM_FOPS(ast_fops); 52 53 static const struct drm_driver ast_driver = { 54 .driver_features = DRIVER_ATOMIC | 55 DRIVER_GEM | 56 DRIVER_MODESET, 57 58 .fops = &ast_fops, 59 .name = DRIVER_NAME, 60 .desc = DRIVER_DESC, 61 .date = DRIVER_DATE, 62 .major = DRIVER_MAJOR, 63 .minor = DRIVER_MINOR, 64 .patchlevel = DRIVER_PATCHLEVEL, 65 66 DRM_GEM_VRAM_DRIVER 67 }; 68 69 /* 70 * PCI driver 71 */ 72 73 #define PCI_VENDOR_ASPEED 0x1a03 74 75 #define AST_VGA_DEVICE(id, info) { \ 76 .class = PCI_BASE_CLASS_DISPLAY << 16, \ 77 .class_mask = 0xff0000, \ 78 .vendor = PCI_VENDOR_ASPEED, \ 79 .device = id, \ 80 .subvendor = PCI_ANY_ID, \ 81 .subdevice = PCI_ANY_ID, \ 82 .driver_data = (unsigned long) info } 83 84 static const struct pci_device_id ast_pciidlist[] = { 85 AST_VGA_DEVICE(PCI_CHIP_AST2000, NULL), 86 AST_VGA_DEVICE(PCI_CHIP_AST2100, NULL), 87 {0, 0, 0}, 88 }; 89 90 MODULE_DEVICE_TABLE(pci, ast_pciidlist); 91 92 static int ast_remove_conflicting_framebuffers(struct pci_dev *pdev) 93 { 94 bool primary = false; 95 resource_size_t base, size; 96 97 base = pci_resource_start(pdev, 0); 98 size = pci_resource_len(pdev, 0); 99 #ifdef CONFIG_X86 100 primary = pdev->resource[PCI_ROM_RESOURCE].flags & IORESOURCE_ROM_SHADOW; 101 #endif 102 103 return drm_aperture_remove_conflicting_framebuffers(base, size, primary, "astdrmfb"); 104 } 105 106 static int ast_pci_probe(struct pci_dev *pdev, const struct pci_device_id *ent) 107 { 108 struct ast_private *ast; 109 struct drm_device *dev; 110 int ret; 111 112 ret = ast_remove_conflicting_framebuffers(pdev); 113 if (ret) 114 return ret; 115 116 ret = pcim_enable_device(pdev); 117 if (ret) 118 return ret; 119 120 ast = ast_device_create(&ast_driver, pdev, ent->driver_data); 121 if (IS_ERR(ast)) 122 return PTR_ERR(ast); 123 dev = &ast->base; 124 125 ret = drm_dev_register(dev, ent->driver_data); 126 if (ret) 127 return ret; 128 129 drm_fbdev_generic_setup(dev, 32); 130 131 return 0; 132 } 133 134 static void ast_pci_remove(struct pci_dev *pdev) 135 { 136 struct drm_device *dev = pci_get_drvdata(pdev); 137 138 drm_dev_unregister(dev); 139 drm_atomic_helper_shutdown(dev); 140 } 141 142 static int ast_drm_freeze(struct drm_device *dev) 143 { 144 int error; 145 146 error = drm_mode_config_helper_suspend(dev); 147 if (error) 148 return error; 149 pci_save_state(to_pci_dev(dev->dev)); 150 return 0; 151 } 152 153 static int ast_drm_thaw(struct drm_device *dev) 154 { 155 ast_post_gpu(dev); 156 157 return drm_mode_config_helper_resume(dev); 158 } 159 160 static int ast_drm_resume(struct drm_device *dev) 161 { 162 int ret; 163 164 if (pci_enable_device(to_pci_dev(dev->dev))) 165 return -EIO; 166 167 ret = ast_drm_thaw(dev); 168 if (ret) 169 return ret; 170 return 0; 171 } 172 173 static int ast_pm_suspend(struct device *dev) 174 { 175 struct pci_dev *pdev = to_pci_dev(dev); 176 struct drm_device *ddev = pci_get_drvdata(pdev); 177 int error; 178 179 error = ast_drm_freeze(ddev); 180 if (error) 181 return error; 182 183 pci_disable_device(pdev); 184 pci_set_power_state(pdev, PCI_D3hot); 185 return 0; 186 } 187 188 static int ast_pm_resume(struct device *dev) 189 { 190 struct pci_dev *pdev = to_pci_dev(dev); 191 struct drm_device *ddev = pci_get_drvdata(pdev); 192 return ast_drm_resume(ddev); 193 } 194 195 static int ast_pm_freeze(struct device *dev) 196 { 197 struct pci_dev *pdev = to_pci_dev(dev); 198 struct drm_device *ddev = pci_get_drvdata(pdev); 199 return ast_drm_freeze(ddev); 200 } 201 202 static int ast_pm_thaw(struct device *dev) 203 { 204 struct pci_dev *pdev = to_pci_dev(dev); 205 struct drm_device *ddev = pci_get_drvdata(pdev); 206 return ast_drm_thaw(ddev); 207 } 208 209 static int ast_pm_poweroff(struct device *dev) 210 { 211 struct pci_dev *pdev = to_pci_dev(dev); 212 struct drm_device *ddev = pci_get_drvdata(pdev); 213 214 return ast_drm_freeze(ddev); 215 } 216 217 static const struct dev_pm_ops ast_pm_ops = { 218 .suspend = ast_pm_suspend, 219 .resume = ast_pm_resume, 220 .freeze = ast_pm_freeze, 221 .thaw = ast_pm_thaw, 222 .poweroff = ast_pm_poweroff, 223 .restore = ast_pm_resume, 224 }; 225 226 static struct pci_driver ast_pci_driver = { 227 .name = DRIVER_NAME, 228 .id_table = ast_pciidlist, 229 .probe = ast_pci_probe, 230 .remove = ast_pci_remove, 231 .driver.pm = &ast_pm_ops, 232 }; 233 234 static int __init ast_init(void) 235 { 236 if (vgacon_text_force() && ast_modeset == -1) 237 return -EINVAL; 238 239 if (ast_modeset == 0) 240 return -EINVAL; 241 return pci_register_driver(&ast_pci_driver); 242 } 243 static void __exit ast_exit(void) 244 { 245 pci_unregister_driver(&ast_pci_driver); 246 } 247 248 module_init(ast_init); 249 module_exit(ast_exit); 250 251 MODULE_AUTHOR(DRIVER_AUTHOR); 252 MODULE_DESCRIPTION(DRIVER_DESC); 253 MODULE_LICENSE("GPL and additional rights"); 254