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#include <linux/module.h>
28#include <linux/kernel.h>
29#include <linux/errno.h>
30#include <linux/string.h>
31#include <linux/mm.h>
32#include <linux/tty.h>
33#include <linux/sysrq.h>
34#include <linux/delay.h>
35#include <linux/fb.h>
36#include <linux/init.h>
37#include <linux/vga_switcheroo.h>
38
39#include <drm/drmP.h>
40#include <drm/drm_crtc.h>
41#include <drm/drm_fb_helper.h>
42#include "intel_drv.h"
43#include <drm/i915_drm.h>
44#include "i915_drv.h"
45
46static struct fb_ops intelfb_ops = {
47 .owner = THIS_MODULE,
48 .fb_check_var = drm_fb_helper_check_var,
49 .fb_set_par = drm_fb_helper_set_par,
50 .fb_fillrect = cfb_fillrect,
51 .fb_copyarea = cfb_copyarea,
52 .fb_imageblit = cfb_imageblit,
53 .fb_pan_display = drm_fb_helper_pan_display,
54 .fb_blank = drm_fb_helper_blank,
55 .fb_setcmap = drm_fb_helper_setcmap,
56 .fb_debug_enter = drm_fb_helper_debug_enter,
57 .fb_debug_leave = drm_fb_helper_debug_leave,
58};
59
60static int intelfb_create(struct drm_fb_helper *helper,
61 struct drm_fb_helper_surface_size *sizes)
62{
63 struct intel_fbdev *ifbdev = (struct intel_fbdev *)helper;
64 struct drm_device *dev = ifbdev->helper.dev;
65 struct drm_i915_private *dev_priv = dev->dev_private;
66 struct fb_info *info;
67 struct drm_framebuffer *fb;
68 struct drm_mode_fb_cmd2 mode_cmd = {};
69 struct drm_i915_gem_object *obj;
70 struct device *device = &dev->pdev->dev;
71 int size, ret;
72
73
74 if (sizes->surface_bpp == 24)
75 sizes->surface_bpp = 32;
76
77 mode_cmd.width = sizes->surface_width;
78 mode_cmd.height = sizes->surface_height;
79
80 mode_cmd.pitches[0] = ALIGN(mode_cmd.width * ((sizes->surface_bpp + 7) /
81 8), 64);
82 mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp,
83 sizes->surface_depth);
84
85 size = mode_cmd.pitches[0] * mode_cmd.height;
86 size = ALIGN(size, PAGE_SIZE);
87 obj = i915_gem_object_create_stolen(dev, size);
88 if (obj == NULL)
89 obj = i915_gem_alloc_object(dev, size);
90 if (!obj) {
91 DRM_ERROR("failed to allocate framebuffer\n");
92 ret = -ENOMEM;
93 goto out;
94 }
95
96 mutex_lock(&dev->struct_mutex);
97
98
99 ret = intel_pin_and_fence_fb_obj(dev, obj, NULL);
100 if (ret) {
101 DRM_ERROR("failed to pin fb: %d\n", ret);
102 goto out_unref;
103 }
104
105 info = framebuffer_alloc(0, device);
106 if (!info) {
107 ret = -ENOMEM;
108 goto out_unpin;
109 }
110
111 info->par = ifbdev;
112
113 ret = intel_framebuffer_init(dev, &ifbdev->ifb, &mode_cmd, obj);
114 if (ret)
115 goto out_unpin;
116
117 fb = &ifbdev->ifb.base;
118
119 ifbdev->helper.fb = fb;
120 ifbdev->helper.fbdev = info;
121
122 strcpy(info->fix.id, "inteldrmfb");
123
124 info->flags = FBINFO_DEFAULT | FBINFO_CAN_FORCE_OUTPUT;
125 info->fbops = &intelfb_ops;
126
127 ret = fb_alloc_cmap(&info->cmap, 256, 0);
128 if (ret) {
129 ret = -ENOMEM;
130 goto out_unpin;
131 }
132
133 info->apertures = alloc_apertures(1);
134 if (!info->apertures) {
135 ret = -ENOMEM;
136 goto out_unpin;
137 }
138 info->apertures->ranges[0].base = dev->mode_config.fb_base;
139 info->apertures->ranges[0].size = dev_priv->gtt.mappable_end;
140
141 info->fix.smem_start = dev->mode_config.fb_base + obj->gtt_offset;
142 info->fix.smem_len = size;
143
144 info->screen_base =
145 ioremap_wc(dev_priv->gtt.mappable_base + obj->gtt_offset,
146 size);
147 if (!info->screen_base) {
148 ret = -ENOSPC;
149 goto out_unpin;
150 }
151 info->screen_size = size;
152
153
154
155 drm_fb_helper_fill_fix(info, fb->pitches[0], fb->depth);
156 drm_fb_helper_fill_var(info, &ifbdev->helper, sizes->fb_width, sizes->fb_height);
157
158
159
160
161
162 if (ifbdev->ifb.obj->stolen)
163 memset_io(info->screen_base, 0, info->screen_size);
164
165
166
167 DRM_DEBUG_KMS("allocated %dx%d fb: 0x%08x, bo %p\n",
168 fb->width, fb->height,
169 obj->gtt_offset, obj);
170
171
172 mutex_unlock(&dev->struct_mutex);
173 vga_switcheroo_client_fb_set(dev->pdev, info);
174 return 0;
175
176out_unpin:
177 i915_gem_object_unpin(obj);
178out_unref:
179 drm_gem_object_unreference(&obj->base);
180 mutex_unlock(&dev->struct_mutex);
181out:
182 return ret;
183}
184
185static struct drm_fb_helper_funcs intel_fb_helper_funcs = {
186 .gamma_set = intel_crtc_fb_gamma_set,
187 .gamma_get = intel_crtc_fb_gamma_get,
188 .fb_probe = intelfb_create,
189};
190
191static void intel_fbdev_destroy(struct drm_device *dev,
192 struct intel_fbdev *ifbdev)
193{
194 struct fb_info *info;
195 struct intel_framebuffer *ifb = &ifbdev->ifb;
196
197 if (ifbdev->helper.fbdev) {
198 info = ifbdev->helper.fbdev;
199 unregister_framebuffer(info);
200 iounmap(info->screen_base);
201 if (info->cmap.len)
202 fb_dealloc_cmap(&info->cmap);
203 framebuffer_release(info);
204 }
205
206 drm_fb_helper_fini(&ifbdev->helper);
207
208 drm_framebuffer_unregister_private(&ifb->base);
209 drm_framebuffer_cleanup(&ifb->base);
210 if (ifb->obj) {
211 drm_gem_object_unreference_unlocked(&ifb->obj->base);
212 ifb->obj = NULL;
213 }
214}
215
216int intel_fbdev_init(struct drm_device *dev)
217{
218 struct intel_fbdev *ifbdev;
219 drm_i915_private_t *dev_priv = dev->dev_private;
220 int ret;
221
222 ifbdev = kzalloc(sizeof(struct intel_fbdev), GFP_KERNEL);
223 if (!ifbdev)
224 return -ENOMEM;
225
226 dev_priv->fbdev = ifbdev;
227 ifbdev->helper.funcs = &intel_fb_helper_funcs;
228
229 ret = drm_fb_helper_init(dev, &ifbdev->helper,
230 dev_priv->num_pipe,
231 INTELFB_CONN_LIMIT);
232 if (ret) {
233 kfree(ifbdev);
234 return ret;
235 }
236
237 drm_fb_helper_single_add_all_connectors(&ifbdev->helper);
238
239 return 0;
240}
241
242void intel_fbdev_initial_config(struct drm_device *dev)
243{
244 drm_i915_private_t *dev_priv = dev->dev_private;
245
246
247 drm_fb_helper_initial_config(&dev_priv->fbdev->helper, 32);
248}
249
250void intel_fbdev_fini(struct drm_device *dev)
251{
252 drm_i915_private_t *dev_priv = dev->dev_private;
253 if (!dev_priv->fbdev)
254 return;
255
256 intel_fbdev_destroy(dev, dev_priv->fbdev);
257 kfree(dev_priv->fbdev);
258 dev_priv->fbdev = NULL;
259}
260
261void intel_fbdev_set_suspend(struct drm_device *dev, int state)
262{
263 drm_i915_private_t *dev_priv = dev->dev_private;
264 if (!dev_priv->fbdev)
265 return;
266
267 fb_set_suspend(dev_priv->fbdev->helper.fbdev, state);
268}
269
270MODULE_LICENSE("GPL and additional rights");
271
272void intel_fb_output_poll_changed(struct drm_device *dev)
273{
274 drm_i915_private_t *dev_priv = dev->dev_private;
275 drm_fb_helper_hotplug_event(&dev_priv->fbdev->helper);
276}
277
278void intel_fb_restore_mode(struct drm_device *dev)
279{
280 int ret;
281 drm_i915_private_t *dev_priv = dev->dev_private;
282 struct drm_mode_config *config = &dev->mode_config;
283 struct drm_plane *plane;
284
285 drm_modeset_lock_all(dev);
286
287 ret = drm_fb_helper_restore_fbdev_mode(&dev_priv->fbdev->helper);
288 if (ret)
289 DRM_DEBUG("failed to restore crtc mode\n");
290
291
292 list_for_each_entry(plane, &config->plane_list, head)
293 if (plane->enabled)
294 plane->funcs->disable_plane(plane);
295
296 drm_modeset_unlock_all(dev);
297}
298