drivers/gpu/drm/ast/ast_drv.c

   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 <[email protected]>
  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 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(dev->pdev);
 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(dev->pdev))
 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");