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 <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         DRM_VRAM_MM_FILE_OPERATIONS
 209 };
 210
 211 static struct drm_driver driver = {
 212         .driver_features = DRIVER_MODESET | DRIVER_GEM,
 213
 214         .load = ast_driver_load,
 215         .unload = ast_driver_unload,
 216
 217         .fops = &ast_fops,
 218         .name = DRIVER_NAME,
 219         .desc = DRIVER_DESC,
 220         .date = DRIVER_DATE,
 221         .major = DRIVER_MAJOR,
 222         .minor = DRIVER_MINOR,
 223         .patchlevel = DRIVER_PATCHLEVEL,
 224
 225         DRM_GEM_VRAM_DRIVER
 226 };
 227
 228 static int __init ast_init(void)
 229 {
 230         if (vgacon_text_force() && ast_modeset == -1)
 231                 return -EINVAL;
 232
 233         if (ast_modeset == 0)
 234                 return -EINVAL;
 235         return pci_register_driver(&ast_pci_driver);
 236 }
 237 static void __exit ast_exit(void)
 238 {
 239         pci_unregister_driver(&ast_pci_driver);
 240 }
 241
 242 module_init(ast_init);
 243 module_exit(ast_exit);
 244
 245 MODULE_AUTHOR(DRIVER_AUTHOR);
 246 MODULE_DESCRIPTION(DRIVER_DESC);
 247 MODULE_LICENSE("GPL and additional rights");
 248