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