bochs_drv.c

   1 /*
   2  * This program is free software; you can redistribute it and/or modify
   3  * it under the terms of the GNU General Public License as published by
   4  * the Free Software Foundation; either version 2 of the License, or
   5  * (at your option) any later version.
   6  */
   7
   8 #include <linux/mm.h>
   9 #include <linux/module.h>
  10 #include <linux/slab.h>
  11 #include <drm/drm_fb_helper.h>
  12
  13 #include "bochs.h"
  14
  15 static bool enable_fbdev = true;
  16 module_param_named(fbdev, enable_fbdev, bool, 0444);
  17 MODULE_PARM_DESC(fbdev, "register fbdev device");
  18
  19 /* ---------------------------------------------------------------------- */
  20 /* drm interface                                                          */
  21
  22 static int bochs_unload(struct drm_device *dev)
  23 {
  24         struct bochs_device *bochs = dev->dev_private;
  25
  26         bochs_fbdev_fini(bochs);
  27         bochs_kms_fini(bochs);
  28         bochs_mm_fini(bochs);
  29         bochs_hw_fini(dev);
  30         kfree(bochs);
  31         dev->dev_private = NULL;
  32         return 0;
  33 }
  34
  35 static int bochs_load(struct drm_device *dev, unsigned long flags)
  36 {
  37         struct bochs_device *bochs;
  38         int ret;
  39
  40         bochs = kzalloc(sizeof(*bochs), GFP_KERNEL);
  41         if (bochs == NULL)
  42                 return -ENOMEM;
  43         dev->dev_private = bochs;
  44         bochs->dev = dev;
  45
  46         ret = bochs_hw_init(dev, flags);
  47         if (ret)
  48                 goto err;
  49
  50         ret = bochs_mm_init(bochs);
  51         if (ret)
  52                 goto err;
  53
  54         ret = bochs_kms_init(bochs);
  55         if (ret)
  56                 goto err;
  57
  58         if (enable_fbdev)
  59                 bochs_fbdev_init(bochs);
  60
  61         return 0;
  62
  63 err:
  64         bochs_unload(dev);
  65         return ret;
  66 }
  67
  68 static const struct file_operations bochs_fops = {
  69         .owner          = THIS_MODULE,
  70         .open           = drm_open,
  71         .release        = drm_release,
  72         .unlocked_ioctl = drm_ioctl,
  73 #ifdef CONFIG_COMPAT
  74         .compat_ioctl   = drm_compat_ioctl,
  75 #endif
  76         .poll           = drm_poll,
  77         .read           = drm_read,
  78         .llseek         = no_llseek,
  79         .mmap           = bochs_mmap,
  80 };
  81
  82 static struct drm_driver bochs_driver = {
  83         .driver_features        = DRIVER_GEM | DRIVER_MODESET,
  84         .load                   = bochs_load,
  85         .unload                 = bochs_unload,
  86         .set_busid              = drm_pci_set_busid,
  87         .fops                   = &bochs_fops,
  88         .name                   = "bochs-drm",
  89         .desc                   = "bochs dispi vga interface (qemu stdvga)",
  90         .date                   = "20130925",
  91         .major                  = 1,
  92         .minor                  = 0,
  93         .gem_free_object_unlocked = bochs_gem_free_object,
  94         .dumb_create            = bochs_dumb_create,
  95         .dumb_map_offset        = bochs_dumb_mmap_offset,
  96         .dumb_destroy           = drm_gem_dumb_destroy,
  97 };
  98
  99 /* ---------------------------------------------------------------------- */
 100 /* pm interface                                                           */
 101
 102 #ifdef CONFIG_PM_SLEEP
 103 static int bochs_pm_suspend(struct device *dev)
 104 {
 105         struct pci_dev *pdev = to_pci_dev(dev);
 106         struct drm_device *drm_dev = pci_get_drvdata(pdev);
 107         struct bochs_device *bochs = drm_dev->dev_private;
 108
 109         drm_kms_helper_poll_disable(drm_dev);
 110
 111         if (bochs->fb.initialized) {
 112                 console_lock();
 113                 drm_fb_helper_set_suspend(&bochs->fb.helper, 1);
 114                 console_unlock();
 115         }
 116
 117         return 0;
 118 }
 119
 120 static int bochs_pm_resume(struct device *dev)
 121 {
 122         struct pci_dev *pdev = to_pci_dev(dev);
 123         struct drm_device *drm_dev = pci_get_drvdata(pdev);
 124         struct bochs_device *bochs = drm_dev->dev_private;
 125
 126         drm_helper_resume_force_mode(drm_dev);
 127
 128         if (bochs->fb.initialized) {
 129                 console_lock();
 130                 drm_fb_helper_set_suspend(&bochs->fb.helper, 0);
 131                 console_unlock();
 132         }
 133
 134         drm_kms_helper_poll_enable(drm_dev);
 135         return 0;
 136 }
 137 #endif
 138
 139 static const struct dev_pm_ops bochs_pm_ops = {
 140         SET_SYSTEM_SLEEP_PM_OPS(bochs_pm_suspend,
 141                                 bochs_pm_resume)
 142 };
 143
 144 /* ---------------------------------------------------------------------- */
 145 /* pci interface                                                          */
 146
 147 static int bochs_kick_out_firmware_fb(struct pci_dev *pdev)
 148 {
 149         struct apertures_struct *ap;
 150
 151         ap = alloc_apertures(1);
 152         if (!ap)
 153                 return -ENOMEM;
 154
 155         ap->ranges[0].base = pci_resource_start(pdev, 0);
 156         ap->ranges[0].size = pci_resource_len(pdev, 0);
 157         drm_fb_helper_remove_conflicting_framebuffers(ap, "bochsdrmfb", false);
 158         kfree(ap);
 159
 160         return 0;
 161 }
 162
 163 static int bochs_pci_probe(struct pci_dev *pdev,
 164                            const struct pci_device_id *ent)
 165 {
 166         unsigned long fbsize;
 167         int ret;
 168
 169         fbsize = pci_resource_len(pdev, 0);
 170         if (fbsize < 4 * 1024 * 1024) {
 171                 DRM_ERROR("less than 4 MB video memory, ignoring device\n");
 172                 return -ENOMEM;
 173         }
 174
 175         ret = bochs_kick_out_firmware_fb(pdev);
 176         if (ret)
 177                 return ret;
 178
 179         return drm_get_pci_dev(pdev, ent, &bochs_driver);
 180 }
 181
 182 static void bochs_pci_remove(struct pci_dev *pdev)
 183 {
 184         struct drm_device *dev = pci_get_drvdata(pdev);
 185
 186         drm_put_dev(dev);
 187 }
 188
 189 static const struct pci_device_id bochs_pci_tbl[] = {
 190         {
 191                 .vendor      = 0x1234,
 192                 .device      = 0x1111,
 193                 .subvendor   = PCI_SUBVENDOR_ID_REDHAT_QUMRANET,
 194                 .subdevice   = PCI_SUBDEVICE_ID_QEMU,
 195                 .driver_data = BOCHS_QEMU_STDVGA,
 196         },
 197         {
 198                 .vendor      = 0x1234,
 199                 .device      = 0x1111,
 200                 .subvendor   = PCI_ANY_ID,
 201                 .subdevice   = PCI_ANY_ID,
 202                 .driver_data = BOCHS_UNKNOWN,
 203         },
 204         { /* end of list */ }
 205 };
 206
 207 static struct pci_driver bochs_pci_driver = {
 208         .name =         "bochs-drm",
 209         .id_table =     bochs_pci_tbl,
 210         .probe =        bochs_pci_probe,
 211         .remove =       bochs_pci_remove,
 212         .driver.pm =    &bochs_pm_ops,
 213 };
 214
 215 /* ---------------------------------------------------------------------- */
 216 /* module init/exit                                                       */
 217
 218 static int __init bochs_init(void)
 219 {
 220         return drm_pci_init(&bochs_driver, &bochs_pci_driver);
 221 }
 222
 223 static void __exit bochs_exit(void)
 224 {
 225         drm_pci_exit(&bochs_driver, &bochs_pci_driver);
 226 }
 227
 228 module_init(bochs_init);
 229 module_exit(bochs_exit);
 230
 231 MODULE_DEVICE_TABLE(pci, bochs_pci_tbl);
 232 MODULE_AUTHOR("Gerd Hoffmann <kraxel@redhat.com>");
 233 MODULE_LICENSE("GPL");