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