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