Home | History | Annotate | Line # | Download | only in vboxvideo
      1 /*	$NetBSD: vbox_drv.c,v 1.2 2021/12/18 23:45:44 riastradh Exp $	*/
      2 
      3 // SPDX-License-Identifier: MIT
      4 /*
      5  * Copyright (C) 2013-2017 Oracle Corporation
      6  * This file is based on ast_drv.c
      7  * Copyright 2012 Red Hat Inc.
      8  * Authors: Dave Airlie <airlied (at) redhat.com>
      9  *          Michael Thayer <michael.thayer (at) oracle.com,
     10  *          Hans de Goede <hdegoede (at) redhat.com>
     11  */
     12 #include <sys/cdefs.h>
     13 __KERNEL_RCSID(0, "$NetBSD: vbox_drv.c,v 1.2 2021/12/18 23:45:44 riastradh Exp $");
     14 
     15 #include <linux/console.h>
     16 #include <linux/module.h>
     17 #include <linux/pci.h>
     18 #include <linux/vt_kern.h>
     19 
     20 #include <drm/drm_crtc_helper.h>
     21 #include <drm/drm_drv.h>
     22 #include <drm/drm_fb_helper.h>
     23 #include <drm/drm_file.h>
     24 #include <drm/drm_ioctl.h>
     25 
     26 #include "vbox_drv.h"
     27 
     28 static int vbox_modeset = -1;
     29 
     30 MODULE_PARM_DESC(modeset, "Disable/Enable modesetting");
     31 module_param_named(modeset, vbox_modeset, int, 0400);
     32 
     33 static struct drm_driver driver;
     34 
     35 static const struct pci_device_id pciidlist[] = {
     36 	{ PCI_DEVICE(0x80ee, 0xbeef) },
     37 	{ }
     38 };
     39 MODULE_DEVICE_TABLE(pci, pciidlist);
     40 
     41 static int vbox_pci_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
     42 {
     43 	struct vbox_private *vbox;
     44 	int ret = 0;
     45 
     46 	if (!vbox_check_supported(VBE_DISPI_ID_HGSMI))
     47 		return -ENODEV;
     48 
     49 	vbox = kzalloc(sizeof(*vbox), GFP_KERNEL);
     50 	if (!vbox)
     51 		return -ENOMEM;
     52 
     53 	ret = drm_dev_init(&vbox->ddev, &driver, &pdev->dev);
     54 	if (ret) {
     55 		kfree(vbox);
     56 		return ret;
     57 	}
     58 
     59 	vbox->ddev.pdev = pdev;
     60 	vbox->ddev.dev_private = vbox;
     61 	pci_set_drvdata(pdev, vbox);
     62 	mutex_init(&vbox->hw_mutex);
     63 
     64 	ret = pci_enable_device(pdev);
     65 	if (ret)
     66 		goto err_dev_put;
     67 
     68 	ret = vbox_hw_init(vbox);
     69 	if (ret)
     70 		goto err_pci_disable;
     71 
     72 	ret = vbox_mm_init(vbox);
     73 	if (ret)
     74 		goto err_hw_fini;
     75 
     76 	ret = vbox_mode_init(vbox);
     77 	if (ret)
     78 		goto err_mm_fini;
     79 
     80 	ret = vbox_irq_init(vbox);
     81 	if (ret)
     82 		goto err_mode_fini;
     83 
     84 	ret = drm_fbdev_generic_setup(&vbox->ddev, 32);
     85 	if (ret)
     86 		goto err_irq_fini;
     87 
     88 	ret = drm_dev_register(&vbox->ddev, 0);
     89 	if (ret)
     90 		goto err_irq_fini;
     91 
     92 	return 0;
     93 
     94 err_irq_fini:
     95 	vbox_irq_fini(vbox);
     96 err_mode_fini:
     97 	vbox_mode_fini(vbox);
     98 err_mm_fini:
     99 	vbox_mm_fini(vbox);
    100 err_hw_fini:
    101 	vbox_hw_fini(vbox);
    102 err_pci_disable:
    103 	pci_disable_device(pdev);
    104 err_dev_put:
    105 	drm_dev_put(&vbox->ddev);
    106 	return ret;
    107 }
    108 
    109 static void vbox_pci_remove(struct pci_dev *pdev)
    110 {
    111 	struct vbox_private *vbox = pci_get_drvdata(pdev);
    112 
    113 	drm_dev_unregister(&vbox->ddev);
    114 	vbox_irq_fini(vbox);
    115 	vbox_mode_fini(vbox);
    116 	vbox_mm_fini(vbox);
    117 	vbox_hw_fini(vbox);
    118 	drm_dev_put(&vbox->ddev);
    119 }
    120 
    121 #ifdef CONFIG_PM_SLEEP
    122 static int vbox_pm_suspend(struct device *dev)
    123 {
    124 	struct vbox_private *vbox = dev_get_drvdata(dev);
    125 	int error;
    126 
    127 	error = drm_mode_config_helper_suspend(&vbox->ddev);
    128 	if (error)
    129 		return error;
    130 
    131 	pci_save_state(vbox->ddev.pdev);
    132 	pci_disable_device(vbox->ddev.pdev);
    133 	pci_set_power_state(vbox->ddev.pdev, PCI_D3hot);
    134 
    135 	return 0;
    136 }
    137 
    138 static int vbox_pm_resume(struct device *dev)
    139 {
    140 	struct vbox_private *vbox = dev_get_drvdata(dev);
    141 
    142 	if (pci_enable_device(vbox->ddev.pdev))
    143 		return -EIO;
    144 
    145 	return drm_mode_config_helper_resume(&vbox->ddev);
    146 }
    147 
    148 static int vbox_pm_freeze(struct device *dev)
    149 {
    150 	struct vbox_private *vbox = dev_get_drvdata(dev);
    151 
    152 	return drm_mode_config_helper_suspend(&vbox->ddev);
    153 }
    154 
    155 static int vbox_pm_thaw(struct device *dev)
    156 {
    157 	struct vbox_private *vbox = dev_get_drvdata(dev);
    158 
    159 	return drm_mode_config_helper_resume(&vbox->ddev);
    160 }
    161 
    162 static int vbox_pm_poweroff(struct device *dev)
    163 {
    164 	struct vbox_private *vbox = dev_get_drvdata(dev);
    165 
    166 	return drm_mode_config_helper_suspend(&vbox->ddev);
    167 }
    168 
    169 static const struct dev_pm_ops vbox_pm_ops = {
    170 	.suspend = vbox_pm_suspend,
    171 	.resume = vbox_pm_resume,
    172 	.freeze = vbox_pm_freeze,
    173 	.thaw = vbox_pm_thaw,
    174 	.poweroff = vbox_pm_poweroff,
    175 	.restore = vbox_pm_resume,
    176 };
    177 #endif
    178 
    179 static struct pci_driver vbox_pci_driver = {
    180 	.name = DRIVER_NAME,
    181 	.id_table = pciidlist,
    182 	.probe = vbox_pci_probe,
    183 	.remove = vbox_pci_remove,
    184 #ifdef CONFIG_PM_SLEEP
    185 	.driver.pm = &vbox_pm_ops,
    186 #endif
    187 };
    188 
    189 DEFINE_DRM_GEM_FOPS(vbox_fops);
    190 
    191 static struct drm_driver driver = {
    192 	.driver_features =
    193 	    DRIVER_MODESET | DRIVER_GEM | DRIVER_ATOMIC,
    194 
    195 	.lastclose = drm_fb_helper_lastclose,
    196 
    197 	.fops = &vbox_fops,
    198 	.irq_handler = vbox_irq_handler,
    199 	.name = DRIVER_NAME,
    200 	.desc = DRIVER_DESC,
    201 	.date = DRIVER_DATE,
    202 	.major = DRIVER_MAJOR,
    203 	.minor = DRIVER_MINOR,
    204 	.patchlevel = DRIVER_PATCHLEVEL,
    205 
    206 	DRM_GEM_VRAM_DRIVER,
    207 };
    208 
    209 static int __init vbox_init(void)
    210 {
    211 #ifdef CONFIG_VGA_CONSOLE
    212 	if (vgacon_text_force() && vbox_modeset == -1)
    213 		return -EINVAL;
    214 #endif
    215 
    216 	if (vbox_modeset == 0)
    217 		return -EINVAL;
    218 
    219 	return pci_register_driver(&vbox_pci_driver);
    220 }
    221 
    222 static void __exit vbox_exit(void)
    223 {
    224 	pci_unregister_driver(&vbox_pci_driver);
    225 }
    226 
    227 module_init(vbox_init);
    228 module_exit(vbox_exit);
    229 
    230 MODULE_AUTHOR("Oracle Corporation");
    231 MODULE_AUTHOR("Hans de Goede <hdegoede (at) redhat.com>");
    232 MODULE_DESCRIPTION(DRIVER_DESC);
    233 MODULE_LICENSE("GPL and additional rights");
    234