1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
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
34#include "ast_drv.h"
35
36int ast_modeset = -1;
37
38MODULE_PARM_DESC(modeset, "Disable/Enable modesetting");
39module_param_named(modeset, ast_modeset, int, 0400);
40
41#define PCI_VENDOR_ASPEED 0x1a03
42
43static struct drm_driver driver;
44
45#define AST_VGA_DEVICE(id, info) { \
46 .class = PCI_BASE_CLASS_DISPLAY << 16, \
47 .class_mask = 0xff0000, \
48 .vendor = PCI_VENDOR_ASPEED, \
49 .device = id, \
50 .subvendor = PCI_ANY_ID, \
51 .subdevice = PCI_ANY_ID, \
52 .driver_data = (unsigned long) info }
53
54static const struct pci_device_id pciidlist[] = {
55 AST_VGA_DEVICE(PCI_CHIP_AST2000, NULL),
56 AST_VGA_DEVICE(PCI_CHIP_AST2100, NULL),
57
58 {0, 0, 0},
59};
60
61MODULE_DEVICE_TABLE(pci, pciidlist);
62
63static int ast_pci_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
64{
65 return drm_get_pci_dev(pdev, ent, &driver);
66}
67
68static void
69ast_pci_remove(struct pci_dev *pdev)
70{
71 struct drm_device *dev = pci_get_drvdata(pdev);
72
73 drm_put_dev(dev);
74}
75
76
77
78static int ast_drm_freeze(struct drm_device *dev)
79{
80 drm_kms_helper_poll_disable(dev);
81
82 pci_save_state(dev->pdev);
83
84 console_lock();
85 ast_fbdev_set_suspend(dev, 1);
86 console_unlock();
87 return 0;
88}
89
90static int ast_drm_thaw(struct drm_device *dev)
91{
92 int error = 0;
93
94 ast_post_gpu(dev);
95
96 drm_mode_config_reset(dev);
97 drm_helper_resume_force_mode(dev);
98
99 console_lock();
100 ast_fbdev_set_suspend(dev, 0);
101 console_unlock();
102 return error;
103}
104
105static int ast_drm_resume(struct drm_device *dev)
106{
107 int ret;
108
109 if (pci_enable_device(dev->pdev))
110 return -EIO;
111
112 ret = ast_drm_thaw(dev);
113 if (ret)
114 return ret;
115
116 drm_kms_helper_poll_enable(dev);
117 return 0;
118}
119
120static int ast_pm_suspend(struct device *dev)
121{
122 struct pci_dev *pdev = to_pci_dev(dev);
123 struct drm_device *ddev = pci_get_drvdata(pdev);
124 int error;
125
126 error = ast_drm_freeze(ddev);
127 if (error)
128 return error;
129
130 pci_disable_device(pdev);
131 pci_set_power_state(pdev, PCI_D3hot);
132 return 0;
133}
134static int ast_pm_resume(struct device *dev)
135{
136 struct pci_dev *pdev = to_pci_dev(dev);
137 struct drm_device *ddev = pci_get_drvdata(pdev);
138 return ast_drm_resume(ddev);
139}
140
141static int ast_pm_freeze(struct device *dev)
142{
143 struct pci_dev *pdev = to_pci_dev(dev);
144 struct drm_device *ddev = pci_get_drvdata(pdev);
145
146 if (!ddev || !ddev->dev_private)
147 return -ENODEV;
148 return ast_drm_freeze(ddev);
149
150}
151
152static int ast_pm_thaw(struct device *dev)
153{
154 struct pci_dev *pdev = to_pci_dev(dev);
155 struct drm_device *ddev = pci_get_drvdata(pdev);
156 return ast_drm_thaw(ddev);
157}
158
159static int ast_pm_poweroff(struct device *dev)
160{
161 struct pci_dev *pdev = to_pci_dev(dev);
162 struct drm_device *ddev = pci_get_drvdata(pdev);
163
164 return ast_drm_freeze(ddev);
165}
166
167static const struct dev_pm_ops ast_pm_ops = {
168 .suspend = ast_pm_suspend,
169 .resume = ast_pm_resume,
170 .freeze = ast_pm_freeze,
171 .thaw = ast_pm_thaw,
172 .poweroff = ast_pm_poweroff,
173 .restore = ast_pm_resume,
174};
175
176static struct pci_driver ast_pci_driver = {
177 .name = DRIVER_NAME,
178 .id_table = pciidlist,
179 .probe = ast_pci_probe,
180 .remove = ast_pci_remove,
181 .driver.pm = &ast_pm_ops,
182};
183
184static const struct file_operations ast_fops = {
185 .owner = THIS_MODULE,
186 .open = drm_open,
187 .release = drm_release,
188 .unlocked_ioctl = drm_ioctl,
189 .mmap = ast_mmap,
190 .poll = drm_poll,
191 .compat_ioctl = drm_compat_ioctl,
192 .read = drm_read,
193};
194
195static struct drm_driver driver = {
196 .driver_features = DRIVER_MODESET | DRIVER_GEM,
197
198 .load = ast_driver_load,
199 .unload = ast_driver_unload,
200
201 .fops = &ast_fops,
202 .name = DRIVER_NAME,
203 .desc = DRIVER_DESC,
204 .date = DRIVER_DATE,
205 .major = DRIVER_MAJOR,
206 .minor = DRIVER_MINOR,
207 .patchlevel = DRIVER_PATCHLEVEL,
208
209 .gem_free_object_unlocked = ast_gem_free_object,
210 .dumb_create = ast_dumb_create,
211 .dumb_map_offset = ast_dumb_mmap_offset,
212
213};
214
215static int __init ast_init(void)
216{
217 if (vgacon_text_force() && ast_modeset == -1)
218 return -EINVAL;
219
220 if (ast_modeset == 0)
221 return -EINVAL;
222 return pci_register_driver(&ast_pci_driver);
223}
224static void __exit ast_exit(void)
225{
226 pci_unregister_driver(&ast_pci_driver);
227}
228
229module_init(ast_init);
230module_exit(ast_exit);
231
232MODULE_AUTHOR(DRIVER_AUTHOR);
233MODULE_DESCRIPTION(DRIVER_DESC);
234MODULE_LICENSE("GPL and additional rights");
235
236