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