[deliverable/linux.git] / drivers / gpu / drm / bochs / bochs_drv.c

/*
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 */

#include <linux/mm.h>
#include <linux/module.h>
#include <linux/slab.h>

#include "bochs.h"

static bool enable_fbdev = true;
module_param_named(fbdev, enable_fbdev, bool, 0444);
MODULE_PARM_DESC(fbdev, "register fbdev device");

/* ---------------------------------------------------------------------- */
/* drm interface                                                          */

static int bochs_unload(struct drm_device *dev)
{
	struct bochs_device *bochs = dev->dev_private;

	bochs_fbdev_fini(bochs);
	bochs_kms_fini(bochs);
	bochs_mm_fini(bochs);
	bochs_hw_fini(dev);
	kfree(bochs);
	dev->dev_private = NULL;
	return 0;
}

static int bochs_load(struct drm_device *dev, unsigned long flags)
{
	struct bochs_device *bochs;
	int ret;

	bochs = kzalloc(sizeof(*bochs), GFP_KERNEL);
	if (bochs == NULL)
		return -ENOMEM;
	dev->dev_private = bochs;
	bochs->dev = dev;

	ret = bochs_hw_init(dev, flags);
	if (ret)
		goto err;

	ret = bochs_mm_init(bochs);
	if (ret)
		goto err;

	ret = bochs_kms_init(bochs);
	if (ret)
		goto err;

	if (enable_fbdev)
		bochs_fbdev_init(bochs);

	return 0;

err:
	bochs_unload(dev);
	return ret;
}

static const struct file_operations bochs_fops = {
	.owner		= THIS_MODULE,
	.open		= drm_open,
	.release	= drm_release,
	.unlocked_ioctl	= drm_ioctl,
#ifdef CONFIG_COMPAT
	.compat_ioctl	= drm_compat_ioctl,
#endif
	.poll		= drm_poll,
	.read		= drm_read,
	.llseek		= no_llseek,
	.mmap           = bochs_mmap,
};

static struct drm_driver bochs_driver = {
	.driver_features	= DRIVER_GEM | DRIVER_MODESET,
	.load			= bochs_load,
	.unload			= bochs_unload,
	.fops			= &bochs_fops,
	.name			= "bochs-drm",
	.desc			= "bochs dispi vga interface (qemu stdvga)",
	.date			= "20130925",
	.major			= 1,
	.minor			= 0,
	.gem_free_object        = bochs_gem_free_object,
	.dumb_create            = bochs_dumb_create,
	.dumb_map_offset        = bochs_dumb_mmap_offset,
	.dumb_destroy           = drm_gem_dumb_destroy,
};

/* ---------------------------------------------------------------------- */
/* pm interface                                                           */

#ifdef CONFIG_PM_SLEEP
static int bochs_pm_suspend(struct device *dev)
{
	struct pci_dev *pdev = to_pci_dev(dev);
	struct drm_device *drm_dev = pci_get_drvdata(pdev);
	struct bochs_device *bochs = drm_dev->dev_private;

	drm_kms_helper_poll_disable(drm_dev);

	if (bochs->fb.initialized) {
		console_lock();
		fb_set_suspend(bochs->fb.helper.fbdev, 1);
		console_unlock();
	}

	return 0;
}

static int bochs_pm_resume(struct device *dev)
{
	struct pci_dev *pdev = to_pci_dev(dev);
	struct drm_device *drm_dev = pci_get_drvdata(pdev);
	struct bochs_device *bochs = drm_dev->dev_private;

	drm_helper_resume_force_mode(drm_dev);

	if (bochs->fb.initialized) {
		console_lock();
		fb_set_suspend(bochs->fb.helper.fbdev, 0);
		console_unlock();
	}

	drm_kms_helper_poll_enable(drm_dev);
	return 0;
}
#endif

static const struct dev_pm_ops bochs_pm_ops = {
	SET_SYSTEM_SLEEP_PM_OPS(bochs_pm_suspend,
				bochs_pm_resume)
};

/* ---------------------------------------------------------------------- */
/* pci interface                                                          */

static int bochs_kick_out_firmware_fb(struct pci_dev *pdev)
{
	struct apertures_struct *ap;

	ap = alloc_apertures(1);
	if (!ap)
		return -ENOMEM;

	ap->ranges[0].base = pci_resource_start(pdev, 0);
	ap->ranges[0].size = pci_resource_len(pdev, 0);
	remove_conflicting_framebuffers(ap, "bochsdrmfb", false);
	kfree(ap);

	return 0;
}

static int bochs_pci_probe(struct pci_dev *pdev,
			   const struct pci_device_id *ent)
{
	int ret;

	ret = bochs_kick_out_firmware_fb(pdev);
	if (ret)
		return ret;

	return drm_get_pci_dev(pdev, ent, &bochs_driver);
}

static void bochs_pci_remove(struct pci_dev *pdev)
{
	struct drm_device *dev = pci_get_drvdata(pdev);

	drm_put_dev(dev);
}

static DEFINE_PCI_DEVICE_TABLE(bochs_pci_tbl) = {
	{
		.vendor      = 0x1234,
		.device      = 0x1111,
		.subvendor   = 0x1af4,
		.subdevice   = 0x1100,
		.driver_data = BOCHS_QEMU_STDVGA,
	},
	{
		.vendor      = 0x1234,
		.device      = 0x1111,
		.subvendor   = PCI_ANY_ID,
		.subdevice   = PCI_ANY_ID,
		.driver_data = BOCHS_UNKNOWN,
	},
	{ /* end of list */ }
};

static struct pci_driver bochs_pci_driver = {
	.name =		"bochs-drm",
	.id_table =	bochs_pci_tbl,
	.probe =	bochs_pci_probe,
	.remove =	bochs_pci_remove,
	.driver.pm =    &bochs_pm_ops,
};

/* ---------------------------------------------------------------------- */
/* module init/exit                                                       */

static int __init bochs_init(void)
{
	return drm_pci_init(&bochs_driver, &bochs_pci_driver);
}

static void __exit bochs_exit(void)
{
	drm_pci_exit(&bochs_driver, &bochs_pci_driver);
}

module_init(bochs_init);
module_exit(bochs_exit);

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