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 
29 #include <linux/module.h>
30 #include <linux/pci.h>
31 
32 #include <drm/drm_aperture.h>
33 #include <drm/drm_atomic_helper.h>
34 #include <drm/drm_drv.h>
35 #include <drm/drm_fbdev_generic.h>
36 #include <drm/drm_gem_shmem_helper.h>
37 #include <drm/drm_module.h>
38 #include <drm/drm_probe_helper.h>
39 
40 #include "ast_drv.h"
41 
42 static int ast_modeset = -1;
43 
44 MODULE_PARM_DESC(modeset, "Disable/Enable modesetting");
45 module_param_named(modeset, ast_modeset, int, 0400);
46 
47 /*
48  * DRM driver
49  */
50 
51 DEFINE_DRM_GEM_FOPS(ast_fops);
52 
53 static const struct drm_driver ast_driver = {
54 	.driver_features = DRIVER_ATOMIC |
55 			   DRIVER_GEM |
56 			   DRIVER_MODESET,
57 
58 	.fops = &ast_fops,
59 	.name = DRIVER_NAME,
60 	.desc = DRIVER_DESC,
61 	.date = DRIVER_DATE,
62 	.major = DRIVER_MAJOR,
63 	.minor = DRIVER_MINOR,
64 	.patchlevel = DRIVER_PATCHLEVEL,
65 
66 	DRM_GEM_SHMEM_DRIVER_OPS
67 };
68 
69 /*
70  * PCI driver
71  */
72 
73 #define PCI_VENDOR_ASPEED 0x1a03
74 
75 #define AST_VGA_DEVICE(id, info) {		\
76 	.class = PCI_BASE_CLASS_DISPLAY << 16,	\
77 	.class_mask = 0xff0000,			\
78 	.vendor = PCI_VENDOR_ASPEED,			\
79 	.device = id,				\
80 	.subvendor = PCI_ANY_ID,		\
81 	.subdevice = PCI_ANY_ID,		\
82 	.driver_data = (unsigned long) info }
83 
84 static const struct pci_device_id ast_pciidlist[] = {
85 	AST_VGA_DEVICE(PCI_CHIP_AST2000, NULL),
86 	AST_VGA_DEVICE(PCI_CHIP_AST2100, NULL),
87 	{0, 0, 0},
88 };
89 
90 MODULE_DEVICE_TABLE(pci, ast_pciidlist);
91 
ast_remove_conflicting_framebuffers(struct pci_dev * pdev)92 static int ast_remove_conflicting_framebuffers(struct pci_dev *pdev)
93 {
94 	bool primary = false;
95 	resource_size_t base, size;
96 
97 	base = pci_resource_start(pdev, 0);
98 	size = pci_resource_len(pdev, 0);
99 #ifdef CONFIG_X86
100 	primary = pdev->resource[PCI_ROM_RESOURCE].flags & IORESOURCE_ROM_SHADOW;
101 #endif
102 
103 	return drm_aperture_remove_conflicting_framebuffers(base, size, primary, &ast_driver);
104 }
105 
ast_pci_probe(struct pci_dev * pdev,const struct pci_device_id * ent)106 static int ast_pci_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
107 {
108 	struct ast_private *ast;
109 	struct drm_device *dev;
110 	int ret;
111 
112 	ret = ast_remove_conflicting_framebuffers(pdev);
113 	if (ret)
114 		return ret;
115 
116 	ret = pcim_enable_device(pdev);
117 	if (ret)
118 		return ret;
119 
120 	ast = ast_device_create(&ast_driver, pdev, ent->driver_data);
121 	if (IS_ERR(ast))
122 		return PTR_ERR(ast);
123 	dev = &ast->base;
124 
125 	ret = drm_dev_register(dev, ent->driver_data);
126 	if (ret)
127 		return ret;
128 
129 	drm_fbdev_generic_setup(dev, 32);
130 
131 	return 0;
132 }
133 
ast_pci_remove(struct pci_dev * pdev)134 static void ast_pci_remove(struct pci_dev *pdev)
135 {
136 	struct drm_device *dev = pci_get_drvdata(pdev);
137 
138 	drm_dev_unregister(dev);
139 	drm_atomic_helper_shutdown(dev);
140 }
141 
ast_drm_freeze(struct drm_device * dev)142 static int ast_drm_freeze(struct drm_device *dev)
143 {
144 	int error;
145 
146 	error = drm_mode_config_helper_suspend(dev);
147 	if (error)
148 		return error;
149 	pci_save_state(to_pci_dev(dev->dev));
150 	return 0;
151 }
152 
ast_drm_thaw(struct drm_device * dev)153 static int ast_drm_thaw(struct drm_device *dev)
154 {
155 	ast_post_gpu(dev);
156 
157 	return drm_mode_config_helper_resume(dev);
158 }
159 
ast_drm_resume(struct drm_device * dev)160 static int ast_drm_resume(struct drm_device *dev)
161 {
162 	if (pci_enable_device(to_pci_dev(dev->dev)))
163 		return -EIO;
164 
165 	return ast_drm_thaw(dev);
166 }
167 
ast_pm_suspend(struct device * dev)168 static int ast_pm_suspend(struct device *dev)
169 {
170 	struct pci_dev *pdev = to_pci_dev(dev);
171 	struct drm_device *ddev = pci_get_drvdata(pdev);
172 	int error;
173 
174 	error = ast_drm_freeze(ddev);
175 	if (error)
176 		return error;
177 
178 	pci_disable_device(pdev);
179 	pci_set_power_state(pdev, PCI_D3hot);
180 	return 0;
181 }
182 
ast_pm_resume(struct device * dev)183 static int ast_pm_resume(struct device *dev)
184 {
185 	struct pci_dev *pdev = to_pci_dev(dev);
186 	struct drm_device *ddev = pci_get_drvdata(pdev);
187 	return ast_drm_resume(ddev);
188 }
189 
ast_pm_freeze(struct device * dev)190 static int ast_pm_freeze(struct device *dev)
191 {
192 	struct pci_dev *pdev = to_pci_dev(dev);
193 	struct drm_device *ddev = pci_get_drvdata(pdev);
194 	return ast_drm_freeze(ddev);
195 }
196 
ast_pm_thaw(struct device * dev)197 static int ast_pm_thaw(struct device *dev)
198 {
199 	struct pci_dev *pdev = to_pci_dev(dev);
200 	struct drm_device *ddev = pci_get_drvdata(pdev);
201 	return ast_drm_thaw(ddev);
202 }
203 
ast_pm_poweroff(struct device * dev)204 static int ast_pm_poweroff(struct device *dev)
205 {
206 	struct pci_dev *pdev = to_pci_dev(dev);
207 	struct drm_device *ddev = pci_get_drvdata(pdev);
208 
209 	return ast_drm_freeze(ddev);
210 }
211 
212 static const struct dev_pm_ops ast_pm_ops = {
213 	.suspend = ast_pm_suspend,
214 	.resume = ast_pm_resume,
215 	.freeze = ast_pm_freeze,
216 	.thaw = ast_pm_thaw,
217 	.poweroff = ast_pm_poweroff,
218 	.restore = ast_pm_resume,
219 };
220 
221 static struct pci_driver ast_pci_driver = {
222 	.name = DRIVER_NAME,
223 	.id_table = ast_pciidlist,
224 	.probe = ast_pci_probe,
225 	.remove = ast_pci_remove,
226 	.driver.pm = &ast_pm_ops,
227 };
228 
229 drm_module_pci_driver_if_modeset(ast_pci_driver, ast_modeset);
230 
231 MODULE_AUTHOR(DRIVER_AUTHOR);
232 MODULE_DESCRIPTION(DRIVER_DESC);
233 MODULE_LICENSE("GPL and additional rights");
234