xref: /dflybsd-src/sys/dev/drm/i915/intel_fbdev.c (revision bf0175970ba1c394f8039834a26ca6d163b23d0e)
1717f4a47SSascha Wildner /*
2717f4a47SSascha Wildner  * Copyright © 2007 David Airlie
3717f4a47SSascha Wildner  *
4717f4a47SSascha Wildner  * Permission is hereby granted, free of charge, to any person obtaining a
5717f4a47SSascha Wildner  * copy of this software and associated documentation files (the "Software"),
6717f4a47SSascha Wildner  * to deal in the Software without restriction, including without limitation
7717f4a47SSascha Wildner  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8717f4a47SSascha Wildner  * and/or sell copies of the Software, and to permit persons to whom the
9717f4a47SSascha Wildner  * Software is furnished to do so, subject to the following conditions:
10717f4a47SSascha Wildner  *
11717f4a47SSascha Wildner  * The above copyright notice and this permission notice (including the next
12717f4a47SSascha Wildner  * paragraph) shall be included in all copies or substantial portions of the
13717f4a47SSascha Wildner  * Software.
14717f4a47SSascha Wildner  *
15717f4a47SSascha Wildner  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
16717f4a47SSascha Wildner  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
17717f4a47SSascha Wildner  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
18717f4a47SSascha Wildner  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
19717f4a47SSascha Wildner  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
20717f4a47SSascha Wildner  * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
21717f4a47SSascha Wildner  * DEALINGS IN THE SOFTWARE.
22717f4a47SSascha Wildner  *
23717f4a47SSascha Wildner  * Authors:
24717f4a47SSascha Wildner  *     David Airlie
25717f4a47SSascha Wildner  */
26717f4a47SSascha Wildner 
271b13d190SFrançois Tigeot #include <linux/async.h>
28717f4a47SSascha Wildner #include <linux/module.h>
29717f4a47SSascha Wildner #include <linux/kernel.h>
308621f407SFrançois Tigeot #include <linux/console.h>
31717f4a47SSascha Wildner #include <linux/errno.h>
32717f4a47SSascha Wildner #include <linux/string.h>
33717f4a47SSascha Wildner #include <linux/mm.h>
341487f786SFrançois Tigeot #include <linux/tty.h>
351487f786SFrançois Tigeot #include <linux/sysrq.h>
36717f4a47SSascha Wildner #include <linux/delay.h>
37717f4a47SSascha Wildner #include <linux/fb.h>
381487f786SFrançois Tigeot #include <linux/init.h>
398621f407SFrançois Tigeot #include <linux/vga_switcheroo.h>
40717f4a47SSascha Wildner 
41ba55f2f5SFrançois Tigeot #include <drm/drmP.h>
42717f4a47SSascha Wildner #include <drm/drm_crtc.h>
43717f4a47SSascha Wildner #include <drm/drm_fb_helper.h>
44717f4a47SSascha Wildner #include "intel_drv.h"
45717f4a47SSascha Wildner #include <drm/i915_drm.h>
46717f4a47SSascha Wildner #include "i915_drv.h"
47717f4a47SSascha Wildner 
4824edb884SFrançois Tigeot static int intel_fbdev_set_par(struct fb_info *info)
4924edb884SFrançois Tigeot {
5024edb884SFrançois Tigeot 	struct drm_fb_helper *fb_helper = info->par;
5124edb884SFrançois Tigeot 	struct intel_fbdev *ifbdev =
5224edb884SFrançois Tigeot 		container_of(fb_helper, struct intel_fbdev, helper);
5324edb884SFrançois Tigeot 	int ret;
5424edb884SFrançois Tigeot 
5524edb884SFrançois Tigeot 	ret = drm_fb_helper_set_par(info);
5624edb884SFrançois Tigeot 
5724edb884SFrançois Tigeot 	if (ret == 0) {
5824edb884SFrançois Tigeot 		mutex_lock(&fb_helper->dev->struct_mutex);
59a05eeebfSFrançois Tigeot 		intel_fb_obj_invalidate(ifbdev->fb->obj, ORIGIN_GTT);
6024edb884SFrançois Tigeot 		mutex_unlock(&fb_helper->dev->struct_mutex);
6124edb884SFrançois Tigeot 	}
6224edb884SFrançois Tigeot 
6324edb884SFrançois Tigeot 	return ret;
6424edb884SFrançois Tigeot }
6524edb884SFrançois Tigeot 
66477eb7f9SFrançois Tigeot static int intel_fbdev_blank(int blank, struct fb_info *info)
67477eb7f9SFrançois Tigeot {
68477eb7f9SFrançois Tigeot 	struct drm_fb_helper *fb_helper = info->par;
69477eb7f9SFrançois Tigeot 	struct intel_fbdev *ifbdev =
70477eb7f9SFrançois Tigeot 		container_of(fb_helper, struct intel_fbdev, helper);
71477eb7f9SFrançois Tigeot 	int ret;
72477eb7f9SFrançois Tigeot 
73477eb7f9SFrançois Tigeot 	ret = drm_fb_helper_blank(blank, info);
74477eb7f9SFrançois Tigeot 
75477eb7f9SFrançois Tigeot 	if (ret == 0) {
76477eb7f9SFrançois Tigeot 		mutex_lock(&fb_helper->dev->struct_mutex);
77a05eeebfSFrançois Tigeot 		intel_fb_obj_invalidate(ifbdev->fb->obj, ORIGIN_GTT);
78477eb7f9SFrançois Tigeot 		mutex_unlock(&fb_helper->dev->struct_mutex);
79477eb7f9SFrançois Tigeot 	}
80477eb7f9SFrançois Tigeot 
81477eb7f9SFrançois Tigeot 	return ret;
82477eb7f9SFrançois Tigeot }
83477eb7f9SFrançois Tigeot 
84ba409a88SImre Vadász #if 0
8519c468b4SFrançois Tigeot static int intel_fbdev_pan_display(struct fb_var_screeninfo *var,
8619c468b4SFrançois Tigeot 				   struct fb_info *info)
8719c468b4SFrançois Tigeot {
8819c468b4SFrançois Tigeot 	struct drm_fb_helper *fb_helper = info->par;
8919c468b4SFrançois Tigeot 	struct intel_fbdev *ifbdev =
9019c468b4SFrançois Tigeot 		container_of(fb_helper, struct intel_fbdev, helper);
9119c468b4SFrançois Tigeot 
9219c468b4SFrançois Tigeot 	int ret;
9319c468b4SFrançois Tigeot 	ret = drm_fb_helper_pan_display(var, info);
9419c468b4SFrançois Tigeot 
9519c468b4SFrançois Tigeot 	if (ret == 0) {
9619c468b4SFrançois Tigeot 		mutex_lock(&fb_helper->dev->struct_mutex);
97a05eeebfSFrançois Tigeot 		intel_fb_obj_invalidate(ifbdev->fb->obj, ORIGIN_GTT);
9819c468b4SFrançois Tigeot 		mutex_unlock(&fb_helper->dev->struct_mutex);
9919c468b4SFrançois Tigeot 	}
10019c468b4SFrançois Tigeot 
10119c468b4SFrançois Tigeot 	return ret;
10219c468b4SFrançois Tigeot }
103ba409a88SImre Vadász #endif
10419c468b4SFrançois Tigeot 
105717f4a47SSascha Wildner static struct fb_ops intelfb_ops = {
106ba409a88SImre Vadász #if 0
107717f4a47SSascha Wildner 	.owner = THIS_MODULE,
108717f4a47SSascha Wildner 	.fb_check_var = drm_fb_helper_check_var,
109ba409a88SImre Vadász #endif
11024edb884SFrançois Tigeot 	.fb_set_par = intel_fbdev_set_par,
111ba409a88SImre Vadász #if 0
112a05eeebfSFrançois Tigeot 	.fb_fillrect = drm_fb_helper_cfb_fillrect,
113a05eeebfSFrançois Tigeot 	.fb_copyarea = drm_fb_helper_cfb_copyarea,
114a05eeebfSFrançois Tigeot 	.fb_imageblit = drm_fb_helper_cfb_imageblit,
11519c468b4SFrançois Tigeot 	.fb_pan_display = intel_fbdev_pan_display,
116717f4a47SSascha Wildner #endif
117ba409a88SImre Vadász 	.fb_blank = intel_fbdev_blank,
118ba409a88SImre Vadász #if 0
119ba409a88SImre Vadász 	.fb_setcmap = drm_fb_helper_setcmap,
120ba409a88SImre Vadász #endif
121ba409a88SImre Vadász 	.fb_debug_enter = drm_fb_helper_debug_enter,
122ba409a88SImre Vadász #if 0
123ba409a88SImre Vadász 	.fb_debug_leave = drm_fb_helper_debug_leave,
124ba409a88SImre Vadász #endif
125ba409a88SImre Vadász };
126717f4a47SSascha Wildner 
127717f4a47SSascha Wildner static int intelfb_alloc(struct drm_fb_helper *helper,
128717f4a47SSascha Wildner 			 struct drm_fb_helper_surface_size *sizes)
129717f4a47SSascha Wildner {
130717f4a47SSascha Wildner 	struct intel_fbdev *ifbdev =
131717f4a47SSascha Wildner 		container_of(helper, struct intel_fbdev, helper);
132c0e85e96SFrançois Tigeot 	struct drm_framebuffer *fb;
133717f4a47SSascha Wildner 	struct drm_device *dev = helper->dev;
134352ff8bdSFrançois Tigeot 	struct drm_i915_private *dev_priv = to_i915(dev);
1358621f407SFrançois Tigeot 	struct i915_ggtt *ggtt = &dev_priv->ggtt;
136717f4a47SSascha Wildner 	struct drm_mode_fb_cmd2 mode_cmd = {};
137352ff8bdSFrançois Tigeot 	struct drm_i915_gem_object *obj = NULL;
138717f4a47SSascha Wildner 	int size, ret;
139717f4a47SSascha Wildner 
140717f4a47SSascha Wildner 	/* we don't do packed 24bpp */
141717f4a47SSascha Wildner 	if (sizes->surface_bpp == 24)
142717f4a47SSascha Wildner 		sizes->surface_bpp = 32;
143717f4a47SSascha Wildner 
144717f4a47SSascha Wildner 	mode_cmd.width = sizes->surface_width;
145717f4a47SSascha Wildner 	mode_cmd.height = sizes->surface_height;
146717f4a47SSascha Wildner 
147717f4a47SSascha Wildner 	mode_cmd.pitches[0] = ALIGN(mode_cmd.width *
148717f4a47SSascha Wildner 				    DIV_ROUND_UP(sizes->surface_bpp, 8), 64);
149717f4a47SSascha Wildner 	mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp,
150717f4a47SSascha Wildner 							  sizes->surface_depth);
151717f4a47SSascha Wildner 
152aee94f86SFrançois Tigeot 	mutex_lock(&dev->struct_mutex);
153aee94f86SFrançois Tigeot 
154717f4a47SSascha Wildner 	size = mode_cmd.pitches[0] * mode_cmd.height;
15524edb884SFrançois Tigeot 	size = PAGE_ALIGN(size);
156352ff8bdSFrançois Tigeot 
157352ff8bdSFrançois Tigeot 	/* If the FB is too big, just don't use it since fbdev is not very
158352ff8bdSFrançois Tigeot 	 * important and we should probably use that space with FBC or other
159352ff8bdSFrançois Tigeot 	 * features. */
1608621f407SFrançois Tigeot 	if (size * 2 < ggtt->stolen_usable_size)
161717f4a47SSascha Wildner 		obj = i915_gem_object_create_stolen(dev, size);
162717f4a47SSascha Wildner 	if (obj == NULL)
1631487f786SFrançois Tigeot 		obj = i915_gem_object_create(dev, size);
1641487f786SFrançois Tigeot 	if (IS_ERR(obj)) {
165717f4a47SSascha Wildner 		DRM_ERROR("failed to allocate framebuffer\n");
1661487f786SFrançois Tigeot 		ret = PTR_ERR(obj);
167717f4a47SSascha Wildner 		goto out;
168717f4a47SSascha Wildner 	}
169717f4a47SSascha Wildner 
170ba55f2f5SFrançois Tigeot 	fb = __intel_framebuffer_create(dev, &mode_cmd, obj);
171ba55f2f5SFrançois Tigeot 	if (IS_ERR(fb)) {
172aee94f86SFrançois Tigeot 		drm_gem_object_unreference(&obj->base);
173ba55f2f5SFrançois Tigeot 		ret = PTR_ERR(fb);
174aee94f86SFrançois Tigeot 		goto out;
1752c9916cdSFrançois Tigeot 	}
1762c9916cdSFrançois Tigeot 
177aee94f86SFrançois Tigeot 	mutex_unlock(&dev->struct_mutex);
178ba55f2f5SFrançois Tigeot 
179ba55f2f5SFrançois Tigeot 	ifbdev->fb = to_intel_framebuffer(fb);
180717f4a47SSascha Wildner 
181717f4a47SSascha Wildner 	return 0;
182717f4a47SSascha Wildner 
183717f4a47SSascha Wildner out:
184aee94f86SFrançois Tigeot 	mutex_unlock(&dev->struct_mutex);
185717f4a47SSascha Wildner 	return ret;
186717f4a47SSascha Wildner }
187717f4a47SSascha Wildner 
188717f4a47SSascha Wildner static int intelfb_create(struct drm_fb_helper *helper,
189717f4a47SSascha Wildner 			  struct drm_fb_helper_surface_size *sizes)
190717f4a47SSascha Wildner {
191717f4a47SSascha Wildner 	struct intel_fbdev *ifbdev =
192717f4a47SSascha Wildner 		container_of(helper, struct intel_fbdev, helper);
193ba55f2f5SFrançois Tigeot 	struct intel_framebuffer *intel_fb = ifbdev->fb;
194717f4a47SSascha Wildner 	struct drm_device *dev = helper->dev;
1958621f407SFrançois Tigeot 	struct drm_i915_private *dev_priv = to_i915(dev);
1961487f786SFrançois Tigeot 	struct i915_ggtt *ggtt = &dev_priv->ggtt;
197717f4a47SSascha Wildner 	struct fb_info *info;
198717f4a47SSascha Wildner 	struct drm_framebuffer *fb;
1991487f786SFrançois Tigeot 	struct i915_vma *vma;
200717f4a47SSascha Wildner 	struct drm_i915_gem_object *obj;
201ba55f2f5SFrançois Tigeot 	bool prealloc = false;
2021487f786SFrançois Tigeot 	void *vaddr;
2031487f786SFrançois Tigeot 	int ret;
2041487f786SFrançois Tigeot 	device_t vga_dev;
205717f4a47SSascha Wildner 
206ba55f2f5SFrançois Tigeot 	if (intel_fb &&
207ba55f2f5SFrançois Tigeot 	    (sizes->fb_width > intel_fb->base.width ||
208ba55f2f5SFrançois Tigeot 	     sizes->fb_height > intel_fb->base.height)) {
209ba55f2f5SFrançois Tigeot 		DRM_DEBUG_KMS("BIOS fb too small (%dx%d), we require (%dx%d),"
210ba55f2f5SFrançois Tigeot 			      " releasing it\n",
211ba55f2f5SFrançois Tigeot 			      intel_fb->base.width, intel_fb->base.height,
212ba55f2f5SFrançois Tigeot 			      sizes->fb_width, sizes->fb_height);
213ba55f2f5SFrançois Tigeot 		drm_framebuffer_unreference(&intel_fb->base);
214ba55f2f5SFrançois Tigeot 		intel_fb = ifbdev->fb = NULL;
215ba55f2f5SFrançois Tigeot 	}
216ba55f2f5SFrançois Tigeot 	if (!intel_fb || WARN_ON(!intel_fb->obj)) {
217717f4a47SSascha Wildner 		DRM_DEBUG_KMS("no BIOS fb, allocating a new one\n");
218717f4a47SSascha Wildner 		ret = intelfb_alloc(helper, sizes);
219717f4a47SSascha Wildner 		if (ret)
220aee94f86SFrançois Tigeot 			return ret;
221ba55f2f5SFrançois Tigeot 		intel_fb = ifbdev->fb;
222717f4a47SSascha Wildner 	} else {
223717f4a47SSascha Wildner 		DRM_DEBUG_KMS("re-using BIOS fb\n");
224ba55f2f5SFrançois Tigeot 		prealloc = true;
225717f4a47SSascha Wildner 		sizes->fb_width = intel_fb->base.width;
226717f4a47SSascha Wildner 		sizes->fb_height = intel_fb->base.height;
227717f4a47SSascha Wildner 	}
228717f4a47SSascha Wildner 
229717f4a47SSascha Wildner 	obj = intel_fb->obj;
230717f4a47SSascha Wildner 
231aee94f86SFrançois Tigeot 	mutex_lock(&dev->struct_mutex);
232aee94f86SFrançois Tigeot 
233aee94f86SFrançois Tigeot 	/* Pin the GGTT vma for our access via info->screen_base.
234aee94f86SFrançois Tigeot 	 * This also validates that any existing fb inherited from the
235aee94f86SFrançois Tigeot 	 * BIOS is suitable for own access.
236aee94f86SFrançois Tigeot 	 */
2371dedbd3bSFrançois Tigeot 	ret = intel_pin_and_fence_fb_obj(&ifbdev->fb->base, DRM_ROTATE_0);
238aee94f86SFrançois Tigeot 	if (ret)
239aee94f86SFrançois Tigeot 		goto out_unlock;
240aee94f86SFrançois Tigeot 
241a05eeebfSFrançois Tigeot 	info = drm_fb_helper_alloc_fbi(helper);
242a05eeebfSFrançois Tigeot 	if (IS_ERR(info)) {
243aee94f86SFrançois Tigeot 		DRM_ERROR("Failed to allocate fb_info\n");
244a05eeebfSFrançois Tigeot 		ret = PTR_ERR(info);
245717f4a47SSascha Wildner 		goto out_unpin;
246717f4a47SSascha Wildner 	}
2472c9916cdSFrançois Tigeot 
248717f4a47SSascha Wildner 	info->par = helper;
249ba55f2f5SFrançois Tigeot 
250f9dc6f44SImre Vadász 	fb = &ifbdev->fb->base;
251f9dc6f44SImre Vadász 
252a05eeebfSFrançois Tigeot 	ifbdev->helper.fb = fb;
253a05eeebfSFrançois Tigeot 
254ba55f2f5SFrançois Tigeot #ifdef __DragonFly__
255fb572d17SFrançois Tigeot 	vga_dev = device_get_parent(dev->dev->bsddev);
256717f4a47SSascha Wildner 	info->width = sizes->fb_width;
257717f4a47SSascha Wildner 	info->height = sizes->fb_height;
258f9dc6f44SImre Vadász 	info->stride = fb->pitches[0];
259717f4a47SSascha Wildner 	info->depth = sizes->surface_bpp;
2601487f786SFrançois Tigeot 	info->paddr = ggtt->mappable_base + i915_gem_obj_ggtt_offset(obj);
261717f4a47SSascha Wildner 	info->is_vga_boot_display = vga_pci_is_boot_display(vga_dev);
262ba409a88SImre Vadász 	info->fbops = intelfb_ops;
2631487f786SFrançois Tigeot #endif
2641487f786SFrançois Tigeot 
2651487f786SFrançois Tigeot #if 0
266717f4a47SSascha Wildner 	strcpy(info->fix.id, "inteldrmfb");
267717f4a47SSascha Wildner 
268717f4a47SSascha Wildner 	info->flags = FBINFO_DEFAULT | FBINFO_CAN_FORCE_OUTPUT;
269717f4a47SSascha Wildner 	info->fbops = &intelfb_ops;
2701487f786SFrançois Tigeot #endif
2711487f786SFrançois Tigeot 
2721487f786SFrançois Tigeot 	vma = i915_gem_obj_to_ggtt(obj);
273717f4a47SSascha Wildner 
274717f4a47SSascha Wildner 	/* setup aperture base/size for vesafb takeover */
2751487f786SFrançois Tigeot #ifndef __DragonFly__
276717f4a47SSascha Wildner 	info->apertures->ranges[0].base = dev->mode_config.fb_base;
2778621f407SFrançois Tigeot 	info->apertures->ranges[0].size = ggtt->mappable_end;
278717f4a47SSascha Wildner 
2791487f786SFrançois Tigeot 	info->fix.smem_start = dev->mode_config.fb_base + vma->node.start;
2801487f786SFrançois Tigeot 	info->fix.smem_len = vma->node.size;
2811487f786SFrançois Tigeot #endif
282717f4a47SSascha Wildner 
2831487f786SFrançois Tigeot 	vaddr = i915_vma_pin_iomap(vma);
2841487f786SFrançois Tigeot 	if (IS_ERR(vaddr)) {
285aee94f86SFrançois Tigeot 		DRM_ERROR("Failed to remap framebuffer into virtual memory\n");
2861487f786SFrançois Tigeot 		ret = PTR_ERR(vaddr);
287a05eeebfSFrançois Tigeot 		goto out_destroy_fbi;
288717f4a47SSascha Wildner 	}
2891487f786SFrançois Tigeot #ifdef __DragonFly__
2901487f786SFrançois Tigeot 	info->vaddr = (vm_offset_t)vaddr;
2911487f786SFrançois Tigeot #else
2921487f786SFrançois Tigeot 	info->screen_base = vaddr;
2931487f786SFrançois Tigeot 	info->screen_size = vma->node.size;
294717f4a47SSascha Wildner 
295717f4a47SSascha Wildner 	/* This driver doesn't need a VT switch to restore the mode on resume */
296717f4a47SSascha Wildner 	info->skip_vt_switch = true;
297717f4a47SSascha Wildner 
298717f4a47SSascha Wildner 	drm_fb_helper_fill_fix(info, fb->pitches[0], fb->depth);
299717f4a47SSascha Wildner 	drm_fb_helper_fill_var(info, &ifbdev->helper, sizes->fb_width, sizes->fb_height);
300717f4a47SSascha Wildner 
301717f4a47SSascha Wildner 	/* If the object is shmemfs backed, it will have given us zeroed pages.
302717f4a47SSascha Wildner 	 * If the object is stolen however, it will be full of whatever
303717f4a47SSascha Wildner 	 * garbage was left in there.
304717f4a47SSascha Wildner 	 */
305ba55f2f5SFrançois Tigeot 	if (ifbdev->fb->obj->stolen && !prealloc)
306717f4a47SSascha Wildner 		memset_io(info->screen_base, 0, info->screen_size);
307717f4a47SSascha Wildner 
308717f4a47SSascha Wildner 	/* Use default scratch pixmap (info->pixmap.flags = FB_PIXMAP_SYSTEM) */
309717f4a47SSascha Wildner #endif
310717f4a47SSascha Wildner 
311f77dbd6cSFrançois Tigeot 	DRM_DEBUG_KMS("allocated %dx%d fb: 0x%08llx, bo %p\n",
312717f4a47SSascha Wildner 		      fb->width, fb->height,
313717f4a47SSascha Wildner 		      i915_gem_obj_ggtt_offset(obj), obj);
314717f4a47SSascha Wildner 
315717f4a47SSascha Wildner 	mutex_unlock(&dev->struct_mutex);
316717f4a47SSascha Wildner 	vga_switcheroo_client_fb_set(dev->pdev, info);
317717f4a47SSascha Wildner 	return 0;
318717f4a47SSascha Wildner 
319a05eeebfSFrançois Tigeot out_destroy_fbi:
320a05eeebfSFrançois Tigeot 	drm_fb_helper_release_fbi(helper);
321717f4a47SSascha Wildner out_unpin:
3221487f786SFrançois Tigeot 	intel_unpin_fb_obj(&ifbdev->fb->base, BIT(DRM_ROTATE_0));
323717f4a47SSascha Wildner out_unlock:
324717f4a47SSascha Wildner 	mutex_unlock(&dev->struct_mutex);
325717f4a47SSascha Wildner 	return ret;
326717f4a47SSascha Wildner }
327717f4a47SSascha Wildner 
328717f4a47SSascha Wildner /** Sets the color ramps on behalf of RandR */
329717f4a47SSascha Wildner static void intel_crtc_fb_gamma_set(struct drm_crtc *crtc, u16 red, u16 green,
330717f4a47SSascha Wildner 				    u16 blue, int regno)
331717f4a47SSascha Wildner {
332717f4a47SSascha Wildner 	struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
333717f4a47SSascha Wildner 
334717f4a47SSascha Wildner 	intel_crtc->lut_r[regno] = red >> 8;
335717f4a47SSascha Wildner 	intel_crtc->lut_g[regno] = green >> 8;
336717f4a47SSascha Wildner 	intel_crtc->lut_b[regno] = blue >> 8;
337717f4a47SSascha Wildner }
338717f4a47SSascha Wildner 
339717f4a47SSascha Wildner static void intel_crtc_fb_gamma_get(struct drm_crtc *crtc, u16 *red, u16 *green,
340717f4a47SSascha Wildner 				    u16 *blue, int regno)
341717f4a47SSascha Wildner {
342717f4a47SSascha Wildner 	struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
343717f4a47SSascha Wildner 
344717f4a47SSascha Wildner 	*red = intel_crtc->lut_r[regno] << 8;
345717f4a47SSascha Wildner 	*green = intel_crtc->lut_g[regno] << 8;
346717f4a47SSascha Wildner 	*blue = intel_crtc->lut_b[regno] << 8;
347717f4a47SSascha Wildner }
348717f4a47SSascha Wildner 
349ba55f2f5SFrançois Tigeot static struct drm_fb_helper_crtc *
350ba55f2f5SFrançois Tigeot intel_fb_helper_crtc(struct drm_fb_helper *fb_helper, struct drm_crtc *crtc)
351ba55f2f5SFrançois Tigeot {
352ba55f2f5SFrançois Tigeot 	int i;
353ba55f2f5SFrançois Tigeot 
354ba55f2f5SFrançois Tigeot 	for (i = 0; i < fb_helper->crtc_count; i++)
355ba55f2f5SFrançois Tigeot 		if (fb_helper->crtc_info[i].mode_set.crtc == crtc)
356ba55f2f5SFrançois Tigeot 			return &fb_helper->crtc_info[i];
357ba55f2f5SFrançois Tigeot 
358ba55f2f5SFrançois Tigeot 	return NULL;
359ba55f2f5SFrançois Tigeot }
360ba55f2f5SFrançois Tigeot 
361ba55f2f5SFrançois Tigeot /*
362ba55f2f5SFrançois Tigeot  * Try to read the BIOS display configuration and use it for the initial
363ba55f2f5SFrançois Tigeot  * fb configuration.
364ba55f2f5SFrançois Tigeot  *
365ba55f2f5SFrançois Tigeot  * The BIOS or boot loader will generally create an initial display
366ba55f2f5SFrançois Tigeot  * configuration for us that includes some set of active pipes and displays.
367ba55f2f5SFrançois Tigeot  * This routine tries to figure out which pipes and connectors are active
368ba55f2f5SFrançois Tigeot  * and stuffs them into the crtcs and modes array given to us by the
369ba55f2f5SFrançois Tigeot  * drm_fb_helper code.
370ba55f2f5SFrançois Tigeot  *
371ba55f2f5SFrançois Tigeot  * The overall sequence is:
372ba55f2f5SFrançois Tigeot  *   intel_fbdev_init - from driver load
373ba55f2f5SFrançois Tigeot  *     intel_fbdev_init_bios - initialize the intel_fbdev using BIOS data
374ba55f2f5SFrançois Tigeot  *     drm_fb_helper_init - build fb helper structs
375ba55f2f5SFrançois Tigeot  *     drm_fb_helper_single_add_all_connectors - more fb helper structs
376ba55f2f5SFrançois Tigeot  *   intel_fbdev_initial_config - apply the config
377ba55f2f5SFrançois Tigeot  *     drm_fb_helper_initial_config - call ->probe then register_framebuffer()
378ba55f2f5SFrançois Tigeot  *         drm_setup_crtcs - build crtc config for fbdev
379ba55f2f5SFrançois Tigeot  *           intel_fb_initial_config - find active connectors etc
380ba55f2f5SFrançois Tigeot  *         drm_fb_helper_single_fb_probe - set up fbdev
381ba55f2f5SFrançois Tigeot  *           intelfb_create - re-use or alloc fb, build out fbdev structs
382ba55f2f5SFrançois Tigeot  *
383ba55f2f5SFrançois Tigeot  * Note that we don't make special consideration whether we could actually
384ba55f2f5SFrançois Tigeot  * switch to the selected modes without a full modeset. E.g. when the display
385ba55f2f5SFrançois Tigeot  * is in VGA mode we need to recalculate watermarks and set a new high-res
386ba55f2f5SFrançois Tigeot  * framebuffer anyway.
387ba55f2f5SFrançois Tigeot  */
388ba55f2f5SFrançois Tigeot static bool intel_fb_initial_config(struct drm_fb_helper *fb_helper,
389ba55f2f5SFrançois Tigeot 				    struct drm_fb_helper_crtc **crtcs,
390ba55f2f5SFrançois Tigeot 				    struct drm_display_mode **modes,
3912c9916cdSFrançois Tigeot 				    struct drm_fb_offset *offsets,
392ba55f2f5SFrançois Tigeot 				    bool *enabled, int width, int height)
393ba55f2f5SFrançois Tigeot {
394ba55f2f5SFrançois Tigeot 	struct drm_device *dev = fb_helper->dev;
395*bf017597SFrançois Tigeot 	unsigned long conn_configured, mask;
396*bf017597SFrançois Tigeot 	unsigned int count = min(fb_helper->connector_count, BITS_PER_LONG);
397ba55f2f5SFrançois Tigeot 	int i, j;
398ba55f2f5SFrançois Tigeot 	bool *save_enabled;
399ba55f2f5SFrançois Tigeot 	bool fallback = true;
400ba55f2f5SFrançois Tigeot 	int num_connectors_enabled = 0;
401ba55f2f5SFrançois Tigeot 	int num_connectors_detected = 0;
4022c9916cdSFrançois Tigeot 	int pass = 0;
403ba55f2f5SFrançois Tigeot 
404*bf017597SFrançois Tigeot 	save_enabled = kcalloc(count, sizeof(bool), GFP_KERNEL);
405ba55f2f5SFrançois Tigeot 	if (!save_enabled)
406ba55f2f5SFrançois Tigeot 		return false;
407ba55f2f5SFrançois Tigeot 
408*bf017597SFrançois Tigeot 	memcpy(save_enabled, enabled, count);
409*bf017597SFrançois Tigeot 	mask = BIT(count) - 1;
410*bf017597SFrançois Tigeot 	conn_configured = 0;
4112c9916cdSFrançois Tigeot retry:
412*bf017597SFrançois Tigeot 	for (i = 0; i < count; i++) {
413ba55f2f5SFrançois Tigeot 		struct drm_fb_helper_connector *fb_conn;
414ba55f2f5SFrançois Tigeot 		struct drm_connector *connector;
415ba55f2f5SFrançois Tigeot 		struct drm_encoder *encoder;
416ba55f2f5SFrançois Tigeot 		struct drm_fb_helper_crtc *new_crtc;
4178621f407SFrançois Tigeot 		struct intel_crtc *intel_crtc;
418ba55f2f5SFrançois Tigeot 
419ba55f2f5SFrançois Tigeot 		fb_conn = fb_helper->connector_info[i];
420ba55f2f5SFrançois Tigeot 		connector = fb_conn->connector;
421ba55f2f5SFrançois Tigeot 
422*bf017597SFrançois Tigeot 		if (conn_configured & BIT(i))
4232c9916cdSFrançois Tigeot 			continue;
4242c9916cdSFrançois Tigeot 
4252c9916cdSFrançois Tigeot 		if (pass == 0 && !connector->has_tile)
4262c9916cdSFrançois Tigeot 			continue;
4272c9916cdSFrançois Tigeot 
428ba55f2f5SFrançois Tigeot 		if (connector->status == connector_status_connected)
429ba55f2f5SFrançois Tigeot 			num_connectors_detected++;
430ba55f2f5SFrançois Tigeot 
431ba55f2f5SFrançois Tigeot 		if (!enabled[i]) {
432ba55f2f5SFrançois Tigeot 			DRM_DEBUG_KMS("connector %s not enabled, skipping\n",
433b4efbf42Szrj 				      connector->name);
434*bf017597SFrançois Tigeot 			conn_configured |= BIT(i);
435ba55f2f5SFrançois Tigeot 			continue;
436ba55f2f5SFrançois Tigeot 		}
437ba55f2f5SFrançois Tigeot 
4381b13d190SFrançois Tigeot 		if (connector->force == DRM_FORCE_OFF) {
4391b13d190SFrançois Tigeot 			DRM_DEBUG_KMS("connector %s is disabled by user, skipping\n",
4401b13d190SFrançois Tigeot 				      connector->name);
4411b13d190SFrançois Tigeot 			enabled[i] = false;
4421b13d190SFrançois Tigeot 			continue;
4431b13d190SFrançois Tigeot 		}
4441b13d190SFrançois Tigeot 
445c0e85e96SFrançois Tigeot 		encoder = connector->state->best_encoder;
446c0e85e96SFrançois Tigeot 		if (!encoder || WARN_ON(!connector->state->crtc)) {
4471b13d190SFrançois Tigeot 			if (connector->force > DRM_FORCE_OFF)
4481b13d190SFrançois Tigeot 				goto bail;
4491b13d190SFrançois Tigeot 
450ba55f2f5SFrançois Tigeot 			DRM_DEBUG_KMS("connector %s has no encoder or crtc, skipping\n",
451b4efbf42Szrj 				      connector->name);
452ba55f2f5SFrançois Tigeot 			enabled[i] = false;
453*bf017597SFrançois Tigeot 			conn_configured |= BIT(i);
454ba55f2f5SFrançois Tigeot 			continue;
455ba55f2f5SFrançois Tigeot 		}
456ba55f2f5SFrançois Tigeot 
457ba55f2f5SFrançois Tigeot 		num_connectors_enabled++;
458ba55f2f5SFrançois Tigeot 
4598621f407SFrançois Tigeot 		intel_crtc = to_intel_crtc(connector->state->crtc);
4608621f407SFrançois Tigeot 		for (j = 0; j < 256; j++) {
4618621f407SFrançois Tigeot 			intel_crtc->lut_r[j] = j;
4628621f407SFrançois Tigeot 			intel_crtc->lut_g[j] = j;
4638621f407SFrançois Tigeot 			intel_crtc->lut_b[j] = j;
4648621f407SFrançois Tigeot 		}
4658621f407SFrançois Tigeot 
466*bf017597SFrançois Tigeot 		new_crtc = intel_fb_helper_crtc(fb_helper,
467*bf017597SFrançois Tigeot 						connector->state->crtc);
468ba55f2f5SFrançois Tigeot 
469ba55f2f5SFrançois Tigeot 		/*
470ba55f2f5SFrançois Tigeot 		 * Make sure we're not trying to drive multiple connectors
471ba55f2f5SFrançois Tigeot 		 * with a single CRTC, since our cloning support may not
472ba55f2f5SFrançois Tigeot 		 * match the BIOS.
473ba55f2f5SFrançois Tigeot 		 */
474*bf017597SFrançois Tigeot 		for (j = 0; j < count; j++) {
475ba55f2f5SFrançois Tigeot 			if (crtcs[j] == new_crtc) {
476ba55f2f5SFrançois Tigeot 				DRM_DEBUG_KMS("fallback: cloned configuration\n");
4771b13d190SFrançois Tigeot 				goto bail;
478ba55f2f5SFrançois Tigeot 			}
479ba55f2f5SFrançois Tigeot 		}
480ba55f2f5SFrançois Tigeot 
481ba55f2f5SFrançois Tigeot 		DRM_DEBUG_KMS("looking for cmdline mode on connector %s\n",
482b4efbf42Szrj 			      connector->name);
483ba55f2f5SFrançois Tigeot 
484ba55f2f5SFrançois Tigeot 		/* go for command line mode first */
485ba55f2f5SFrançois Tigeot 		modes[i] = drm_pick_cmdline_mode(fb_conn, width, height);
486ba55f2f5SFrançois Tigeot 
487ba55f2f5SFrançois Tigeot 		/* try for preferred next */
488ba55f2f5SFrançois Tigeot 		if (!modes[i]) {
4892c9916cdSFrançois Tigeot 			DRM_DEBUG_KMS("looking for preferred mode on connector %s %d\n",
4902c9916cdSFrançois Tigeot 				      connector->name, connector->has_tile);
491ba55f2f5SFrançois Tigeot 			modes[i] = drm_has_preferred_mode(fb_conn, width,
492ba55f2f5SFrançois Tigeot 							  height);
493ba55f2f5SFrançois Tigeot 		}
494ba55f2f5SFrançois Tigeot 
495ba55f2f5SFrançois Tigeot 		/* No preferred mode marked by the EDID? Are there any modes? */
496ba55f2f5SFrançois Tigeot 		if (!modes[i] && !list_empty(&connector->modes)) {
497ba55f2f5SFrançois Tigeot 			DRM_DEBUG_KMS("using first mode listed on connector %s\n",
498ba55f2f5SFrançois Tigeot 				      connector->name);
499ba55f2f5SFrançois Tigeot 			modes[i] = list_first_entry(&connector->modes,
500ba55f2f5SFrançois Tigeot 						    struct drm_display_mode,
501ba55f2f5SFrançois Tigeot 						    head);
502ba55f2f5SFrançois Tigeot 		}
503ba55f2f5SFrançois Tigeot 
504ba55f2f5SFrançois Tigeot 		/* last resort: use current mode */
505ba55f2f5SFrançois Tigeot 		if (!modes[i]) {
506ba55f2f5SFrançois Tigeot 			/*
507ba55f2f5SFrançois Tigeot 			 * IMPORTANT: We want to use the adjusted mode (i.e.
508ba55f2f5SFrançois Tigeot 			 * after the panel fitter upscaling) as the initial
509ba55f2f5SFrançois Tigeot 			 * config, not the input mode, which is what crtc->mode
510a05eeebfSFrançois Tigeot 			 * usually contains. But since our current
511ba55f2f5SFrançois Tigeot 			 * code puts a mode derived from the post-pfit timings
512a05eeebfSFrançois Tigeot 			 * into crtc->mode this works out correctly.
513c0e85e96SFrançois Tigeot 			 *
514c0e85e96SFrançois Tigeot 			 * This is crtc->mode and not crtc->state->mode for the
515c0e85e96SFrançois Tigeot 			 * fastboot check to work correctly. crtc_state->mode has
516c0e85e96SFrançois Tigeot 			 * I915_MODE_FLAG_INHERITED, which we clear to force check
517c0e85e96SFrançois Tigeot 			 * state.
518ba55f2f5SFrançois Tigeot 			 */
519ba55f2f5SFrançois Tigeot 			DRM_DEBUG_KMS("looking for current mode on connector %s\n",
520b4efbf42Szrj 				      connector->name);
521c0e85e96SFrançois Tigeot 			modes[i] = &connector->state->crtc->mode;
522ba55f2f5SFrançois Tigeot 		}
523ba55f2f5SFrançois Tigeot 		crtcs[i] = new_crtc;
524ba55f2f5SFrançois Tigeot 
5251487f786SFrançois Tigeot 		DRM_DEBUG_KMS("connector %s on [CRTC:%d:%s]: %dx%d%s\n",
526b4efbf42Szrj 			      connector->name,
527c0e85e96SFrançois Tigeot 			      connector->state->crtc->base.id,
5281487f786SFrançois Tigeot 			      connector->state->crtc->name,
529ba55f2f5SFrançois Tigeot 			      modes[i]->hdisplay, modes[i]->vdisplay,
530ba55f2f5SFrançois Tigeot 			      modes[i]->flags & DRM_MODE_FLAG_INTERLACE ? "i" :"");
531ba55f2f5SFrançois Tigeot 
532ba55f2f5SFrançois Tigeot 		fallback = false;
533*bf017597SFrançois Tigeot 		conn_configured |= BIT(i);
5342c9916cdSFrançois Tigeot 	}
5352c9916cdSFrançois Tigeot 
5362c9916cdSFrançois Tigeot 	if ((conn_configured & mask) != mask) {
5372c9916cdSFrançois Tigeot 		pass++;
5382c9916cdSFrançois Tigeot 		goto retry;
539ba55f2f5SFrançois Tigeot 	}
540ba55f2f5SFrançois Tigeot 
541ba55f2f5SFrançois Tigeot 	/*
542ba55f2f5SFrançois Tigeot 	 * If the BIOS didn't enable everything it could, fall back to have the
543ba55f2f5SFrançois Tigeot 	 * same user experiencing of lighting up as much as possible like the
544ba55f2f5SFrançois Tigeot 	 * fbdev helper library.
545ba55f2f5SFrançois Tigeot 	 */
546ba55f2f5SFrançois Tigeot 	if (num_connectors_enabled != num_connectors_detected &&
547ba55f2f5SFrançois Tigeot 	    num_connectors_enabled < INTEL_INFO(dev)->num_pipes) {
548ba55f2f5SFrançois Tigeot 		DRM_DEBUG_KMS("fallback: Not all outputs enabled\n");
549ba55f2f5SFrançois Tigeot 		DRM_DEBUG_KMS("Enabled: %i, detected: %i\n", num_connectors_enabled,
550ba55f2f5SFrançois Tigeot 			      num_connectors_detected);
551ba55f2f5SFrançois Tigeot 		fallback = true;
552ba55f2f5SFrançois Tigeot 	}
553ba55f2f5SFrançois Tigeot 
554ba55f2f5SFrançois Tigeot 	if (fallback) {
5551b13d190SFrançois Tigeot bail:
556ba55f2f5SFrançois Tigeot 		DRM_DEBUG_KMS("Not using firmware configuration\n");
557*bf017597SFrançois Tigeot 		memcpy(enabled, save_enabled, count);
558ba55f2f5SFrançois Tigeot 		kfree(save_enabled);
559ba55f2f5SFrançois Tigeot 		return false;
560ba55f2f5SFrançois Tigeot 	}
561ba55f2f5SFrançois Tigeot 
562ba55f2f5SFrançois Tigeot 	kfree(save_enabled);
563ba55f2f5SFrançois Tigeot 	return true;
564ba55f2f5SFrançois Tigeot }
565ba55f2f5SFrançois Tigeot 
566c6f73aabSFrançois Tigeot static const struct drm_fb_helper_funcs intel_fb_helper_funcs = {
567ba55f2f5SFrançois Tigeot 	.initial_config = intel_fb_initial_config,
568717f4a47SSascha Wildner 	.gamma_set = intel_crtc_fb_gamma_set,
569717f4a47SSascha Wildner 	.gamma_get = intel_crtc_fb_gamma_get,
570717f4a47SSascha Wildner 	.fb_probe = intelfb_create,
571717f4a47SSascha Wildner };
572717f4a47SSascha Wildner 
5731487f786SFrançois Tigeot static void intel_fbdev_destroy(struct intel_fbdev *ifbdev)
574717f4a47SSascha Wildner {
575aee94f86SFrançois Tigeot 	/* We rely on the object-free to release the VMA pinning for
576aee94f86SFrançois Tigeot 	 * the info->screen_base mmaping. Leaking the VMA is simpler than
577aee94f86SFrançois Tigeot 	 * trying to rectify all the possible error paths leading here.
578aee94f86SFrançois Tigeot 	 */
579aee94f86SFrançois Tigeot 
580a05eeebfSFrançois Tigeot 	drm_fb_helper_unregister_fbi(&ifbdev->helper);
581a05eeebfSFrançois Tigeot 	drm_fb_helper_release_fbi(&ifbdev->helper);
582717f4a47SSascha Wildner 
583717f4a47SSascha Wildner 	drm_fb_helper_fini(&ifbdev->helper);
584717f4a47SSascha Wildner 
585aee94f86SFrançois Tigeot 	if (ifbdev->fb) {
5861487f786SFrançois Tigeot 		mutex_lock(&ifbdev->helper.dev->struct_mutex);
5871487f786SFrançois Tigeot 		intel_unpin_fb_obj(&ifbdev->fb->base, BIT(DRM_ROTATE_0));
5881487f786SFrançois Tigeot 		mutex_unlock(&ifbdev->helper.dev->struct_mutex);
5891487f786SFrançois Tigeot 
5902c9916cdSFrançois Tigeot 		drm_framebuffer_remove(&ifbdev->fb->base);
591ba55f2f5SFrançois Tigeot 	}
5921487f786SFrançois Tigeot 
5931487f786SFrançois Tigeot 	kfree(ifbdev);
594aee94f86SFrançois Tigeot }
595ba55f2f5SFrançois Tigeot 
596ba55f2f5SFrançois Tigeot /*
597ba55f2f5SFrançois Tigeot  * Build an intel_fbdev struct using a BIOS allocated framebuffer, if possible.
598ba55f2f5SFrançois Tigeot  * The core display code will have read out the current plane configuration,
599ba55f2f5SFrançois Tigeot  * so we use that to figure out if there's an object for us to use as the
600ba55f2f5SFrançois Tigeot  * fb, and if so, we re-use it for the fbdev configuration.
601ba55f2f5SFrançois Tigeot  *
602ba55f2f5SFrançois Tigeot  * Note we only support a single fb shared across pipes for boot (mostly for
603ba55f2f5SFrançois Tigeot  * fbcon), so we just find the biggest and use that.
604ba55f2f5SFrançois Tigeot  */
605ba55f2f5SFrançois Tigeot static bool intel_fbdev_init_bios(struct drm_device *dev,
606ba55f2f5SFrançois Tigeot 				 struct intel_fbdev *ifbdev)
607ba55f2f5SFrançois Tigeot {
608ba55f2f5SFrançois Tigeot 	struct intel_framebuffer *fb = NULL;
609ba55f2f5SFrançois Tigeot 	struct drm_crtc *crtc;
610ba55f2f5SFrançois Tigeot 	struct intel_crtc *intel_crtc;
611ba55f2f5SFrançois Tigeot 	unsigned int max_size = 0;
612ba55f2f5SFrançois Tigeot 
613ba55f2f5SFrançois Tigeot 	/* Find the largest fb */
614ba55f2f5SFrançois Tigeot 	for_each_crtc(dev, crtc) {
615a05eeebfSFrançois Tigeot 		struct drm_i915_gem_object *obj =
616a05eeebfSFrançois Tigeot 			intel_fb_obj(crtc->primary->state->fb);
617ba55f2f5SFrançois Tigeot 		intel_crtc = to_intel_crtc(crtc);
618ba55f2f5SFrançois Tigeot 
619352ff8bdSFrançois Tigeot 		if (!crtc->state->active || !obj) {
620ba55f2f5SFrançois Tigeot 			DRM_DEBUG_KMS("pipe %c not active or no fb, skipping\n",
621ba55f2f5SFrançois Tigeot 				      pipe_name(intel_crtc->pipe));
622ba55f2f5SFrançois Tigeot 			continue;
623ba55f2f5SFrançois Tigeot 		}
624ba55f2f5SFrançois Tigeot 
625a05eeebfSFrançois Tigeot 		if (obj->base.size > max_size) {
626ba55f2f5SFrançois Tigeot 			DRM_DEBUG_KMS("found possible fb from plane %c\n",
627ba55f2f5SFrançois Tigeot 				      pipe_name(intel_crtc->pipe));
628a05eeebfSFrançois Tigeot 			fb = to_intel_framebuffer(crtc->primary->state->fb);
629a05eeebfSFrançois Tigeot 			max_size = obj->base.size;
630ba55f2f5SFrançois Tigeot 		}
631ba55f2f5SFrançois Tigeot 	}
632ba55f2f5SFrançois Tigeot 
633ba55f2f5SFrançois Tigeot 	if (!fb) {
634ba55f2f5SFrançois Tigeot 		DRM_DEBUG_KMS("no active fbs found, not using BIOS config\n");
635ba55f2f5SFrançois Tigeot 		goto out;
636ba55f2f5SFrançois Tigeot 	}
637ba55f2f5SFrançois Tigeot 
638ba55f2f5SFrançois Tigeot 	/* Now make sure all the pipes will fit into it */
639ba55f2f5SFrançois Tigeot 	for_each_crtc(dev, crtc) {
640ba55f2f5SFrançois Tigeot 		unsigned int cur_size;
641ba55f2f5SFrançois Tigeot 
642ba55f2f5SFrançois Tigeot 		intel_crtc = to_intel_crtc(crtc);
643ba55f2f5SFrançois Tigeot 
644352ff8bdSFrançois Tigeot 		if (!crtc->state->active) {
645ba55f2f5SFrançois Tigeot 			DRM_DEBUG_KMS("pipe %c not active, skipping\n",
646ba55f2f5SFrançois Tigeot 				      pipe_name(intel_crtc->pipe));
647ba55f2f5SFrançois Tigeot 			continue;
648ba55f2f5SFrançois Tigeot 		}
649ba55f2f5SFrançois Tigeot 
650ba55f2f5SFrançois Tigeot 		DRM_DEBUG_KMS("checking plane %c for BIOS fb\n",
651ba55f2f5SFrançois Tigeot 			      pipe_name(intel_crtc->pipe));
652ba55f2f5SFrançois Tigeot 
653ba55f2f5SFrançois Tigeot 		/*
654ba55f2f5SFrançois Tigeot 		 * See if the plane fb we found above will fit on this
655ba55f2f5SFrançois Tigeot 		 * pipe.  Note we need to use the selected fb's pitch and bpp
656ba55f2f5SFrançois Tigeot 		 * rather than the current pipe's, since they differ.
657ba55f2f5SFrançois Tigeot 		 */
6582c9916cdSFrançois Tigeot 		cur_size = intel_crtc->config->base.adjusted_mode.crtc_hdisplay;
659ba55f2f5SFrançois Tigeot 		cur_size = cur_size * fb->base.bits_per_pixel / 8;
660ba55f2f5SFrançois Tigeot 		if (fb->base.pitches[0] < cur_size) {
661ba55f2f5SFrançois Tigeot 			DRM_DEBUG_KMS("fb not wide enough for plane %c (%d vs %d)\n",
662ba55f2f5SFrançois Tigeot 				      pipe_name(intel_crtc->pipe),
663ba55f2f5SFrançois Tigeot 				      cur_size, fb->base.pitches[0]);
664ba55f2f5SFrançois Tigeot 			fb = NULL;
665ba55f2f5SFrançois Tigeot 			break;
666ba55f2f5SFrançois Tigeot 		}
667ba55f2f5SFrançois Tigeot 
6682c9916cdSFrançois Tigeot 		cur_size = intel_crtc->config->base.adjusted_mode.crtc_vdisplay;
6692c9916cdSFrançois Tigeot 		cur_size = intel_fb_align_height(dev, cur_size,
670477eb7f9SFrançois Tigeot 						 fb->base.pixel_format,
671477eb7f9SFrançois Tigeot 						 fb->base.modifier[0]);
672ba55f2f5SFrançois Tigeot 		cur_size *= fb->base.pitches[0];
673ba55f2f5SFrançois Tigeot 		DRM_DEBUG_KMS("pipe %c area: %dx%d, bpp: %d, size: %d\n",
674ba55f2f5SFrançois Tigeot 			      pipe_name(intel_crtc->pipe),
6752c9916cdSFrançois Tigeot 			      intel_crtc->config->base.adjusted_mode.crtc_hdisplay,
6762c9916cdSFrançois Tigeot 			      intel_crtc->config->base.adjusted_mode.crtc_vdisplay,
677ba55f2f5SFrançois Tigeot 			      fb->base.bits_per_pixel,
678ba55f2f5SFrançois Tigeot 			      cur_size);
679ba55f2f5SFrançois Tigeot 
680ba55f2f5SFrançois Tigeot 		if (cur_size > max_size) {
681ba55f2f5SFrançois Tigeot 			DRM_DEBUG_KMS("fb not big enough for plane %c (%d vs %d)\n",
682ba55f2f5SFrançois Tigeot 				      pipe_name(intel_crtc->pipe),
683ba55f2f5SFrançois Tigeot 				      cur_size, max_size);
684ba55f2f5SFrançois Tigeot 			fb = NULL;
685ba55f2f5SFrançois Tigeot 			break;
686ba55f2f5SFrançois Tigeot 		}
687ba55f2f5SFrançois Tigeot 
688ba55f2f5SFrançois Tigeot 		DRM_DEBUG_KMS("fb big enough for plane %c (%d >= %d)\n",
689ba55f2f5SFrançois Tigeot 			      pipe_name(intel_crtc->pipe),
690ba55f2f5SFrançois Tigeot 			      max_size, cur_size);
691ba55f2f5SFrançois Tigeot 	}
692ba55f2f5SFrançois Tigeot 
693ba55f2f5SFrançois Tigeot 	if (!fb) {
694ba55f2f5SFrançois Tigeot 		DRM_DEBUG_KMS("BIOS fb not suitable for all pipes, not using\n");
695ba55f2f5SFrançois Tigeot 		goto out;
696ba55f2f5SFrançois Tigeot 	}
697ba55f2f5SFrançois Tigeot 
698ba55f2f5SFrançois Tigeot 	ifbdev->preferred_bpp = fb->base.bits_per_pixel;
699ba55f2f5SFrançois Tigeot 	ifbdev->fb = fb;
700ba55f2f5SFrançois Tigeot 
701ba55f2f5SFrançois Tigeot 	drm_framebuffer_reference(&ifbdev->fb->base);
702ba55f2f5SFrançois Tigeot 
703ba55f2f5SFrançois Tigeot 	/* Final pass to check if any active pipes don't have fbs */
704ba55f2f5SFrançois Tigeot 	for_each_crtc(dev, crtc) {
705ba55f2f5SFrançois Tigeot 		intel_crtc = to_intel_crtc(crtc);
706ba55f2f5SFrançois Tigeot 
707352ff8bdSFrançois Tigeot 		if (!crtc->state->active)
708ba55f2f5SFrançois Tigeot 			continue;
709ba55f2f5SFrançois Tigeot 
710ba55f2f5SFrançois Tigeot 		WARN(!crtc->primary->fb,
711ba55f2f5SFrançois Tigeot 		     "re-used BIOS config but lost an fb on crtc %d\n",
712ba55f2f5SFrançois Tigeot 		     crtc->base.id);
713ba55f2f5SFrançois Tigeot 	}
714ba55f2f5SFrançois Tigeot 
715ba55f2f5SFrançois Tigeot 
716ba55f2f5SFrançois Tigeot 	DRM_DEBUG_KMS("using BIOS fb for initial console\n");
717ba55f2f5SFrançois Tigeot 	return true;
718ba55f2f5SFrançois Tigeot 
719ba55f2f5SFrançois Tigeot out:
720ba55f2f5SFrançois Tigeot 
721ba55f2f5SFrançois Tigeot 	return false;
722717f4a47SSascha Wildner }
723717f4a47SSascha Wildner 
7241b13d190SFrançois Tigeot static void intel_fbdev_suspend_worker(struct work_struct *work)
7251b13d190SFrançois Tigeot {
726303bf270SFrançois Tigeot 	intel_fbdev_set_suspend(&container_of(work,
7271b13d190SFrançois Tigeot 					      struct drm_i915_private,
728303bf270SFrançois Tigeot 					      fbdev_suspend_work)->drm,
7291b13d190SFrançois Tigeot 				FBINFO_STATE_RUNNING,
7301b13d190SFrançois Tigeot 				true);
7311b13d190SFrançois Tigeot }
7321b13d190SFrançois Tigeot 
733717f4a47SSascha Wildner int intel_fbdev_init(struct drm_device *dev)
734717f4a47SSascha Wildner {
735717f4a47SSascha Wildner 	struct intel_fbdev *ifbdev;
736*bf017597SFrançois Tigeot 	struct drm_i915_private *dev_priv = to_i915(dev);
737717f4a47SSascha Wildner 	int ret;
738717f4a47SSascha Wildner 
739ba55f2f5SFrançois Tigeot 	if (WARN_ON(INTEL_INFO(dev)->num_pipes == 0))
740ba55f2f5SFrançois Tigeot 		return -ENODEV;
741ba55f2f5SFrançois Tigeot 
742ba55f2f5SFrançois Tigeot 	ifbdev = kzalloc(sizeof(struct intel_fbdev), GFP_KERNEL);
743ba55f2f5SFrançois Tigeot 	if (ifbdev == NULL)
744717f4a47SSascha Wildner 		return -ENOMEM;
745717f4a47SSascha Wildner 
746c6f73aabSFrançois Tigeot 	drm_fb_helper_prepare(dev, &ifbdev->helper, &intel_fb_helper_funcs);
747c6f73aabSFrançois Tigeot 
748ba55f2f5SFrançois Tigeot 	if (!intel_fbdev_init_bios(dev, ifbdev))
749ba55f2f5SFrançois Tigeot 		ifbdev->preferred_bpp = 32;
750717f4a47SSascha Wildner 
751717f4a47SSascha Wildner 	ret = drm_fb_helper_init(dev, &ifbdev->helper,
752ba55f2f5SFrançois Tigeot 				 INTEL_INFO(dev)->num_pipes, 4);
753717f4a47SSascha Wildner 	if (ret) {
754717f4a47SSascha Wildner 		kfree(ifbdev);
755717f4a47SSascha Wildner 		return ret;
756717f4a47SSascha Wildner 	}
757717f4a47SSascha Wildner 
758ba55f2f5SFrançois Tigeot 	dev_priv->fbdev = ifbdev;
7591b13d190SFrançois Tigeot 	INIT_WORK(&dev_priv->fbdev_suspend_work, intel_fbdev_suspend_worker);
7601b13d190SFrançois Tigeot 
761717f4a47SSascha Wildner 	drm_fb_helper_single_add_all_connectors(&ifbdev->helper);
762717f4a47SSascha Wildner 
763717f4a47SSascha Wildner 	return 0;
764717f4a47SSascha Wildner }
765717f4a47SSascha Wildner 
766aee94f86SFrançois Tigeot static void intel_fbdev_initial_config(void *data, async_cookie_t cookie)
767717f4a47SSascha Wildner {
7681487f786SFrançois Tigeot 	struct intel_fbdev *ifbdev = data;
769717f4a47SSascha Wildner 
770717f4a47SSascha Wildner 	/* Due to peculiar init order wrt to hpd handling this is separate. */
771aee94f86SFrançois Tigeot 	if (drm_fb_helper_initial_config(&ifbdev->helper,
772aee94f86SFrançois Tigeot 					 ifbdev->preferred_bpp))
7731487f786SFrançois Tigeot 		intel_fbdev_fini(ifbdev->helper.dev);
774aee94f86SFrançois Tigeot }
775aee94f86SFrançois Tigeot 
776aee94f86SFrançois Tigeot void intel_fbdev_initial_config_async(struct drm_device *dev)
777aee94f86SFrançois Tigeot {
7781487f786SFrançois Tigeot 	struct intel_fbdev *ifbdev = to_i915(dev)->fbdev;
7791487f786SFrançois Tigeot 
7801487f786SFrançois Tigeot 	ifbdev->cookie = async_schedule(intel_fbdev_initial_config, ifbdev);
7811487f786SFrançois Tigeot }
7821487f786SFrançois Tigeot 
7831487f786SFrançois Tigeot static void intel_fbdev_sync(struct intel_fbdev *ifbdev)
7841487f786SFrançois Tigeot {
7851487f786SFrançois Tigeot 	if (!ifbdev->cookie)
7861487f786SFrançois Tigeot 		return;
7871487f786SFrançois Tigeot 
7881487f786SFrançois Tigeot 	/* Only serialises with all preceding async calls, hence +1 */
7891487f786SFrançois Tigeot 	async_synchronize_cookie(ifbdev->cookie + 1);
7901487f786SFrançois Tigeot 	ifbdev->cookie = 0;
791717f4a47SSascha Wildner }
792717f4a47SSascha Wildner 
793717f4a47SSascha Wildner void intel_fbdev_fini(struct drm_device *dev)
794717f4a47SSascha Wildner {
795*bf017597SFrançois Tigeot 	struct drm_i915_private *dev_priv = to_i915(dev);
7961487f786SFrançois Tigeot 	struct intel_fbdev *ifbdev = dev_priv->fbdev;
7971487f786SFrançois Tigeot 
7981487f786SFrançois Tigeot 	if (!ifbdev)
799717f4a47SSascha Wildner 		return;
800717f4a47SSascha Wildner 
8011b13d190SFrançois Tigeot 	flush_work(&dev_priv->fbdev_suspend_work);
8021487f786SFrançois Tigeot #if 0
803aee94f86SFrançois Tigeot 	if (!current_is_async())
804aee94f86SFrançois Tigeot #endif
8051487f786SFrançois Tigeot 		intel_fbdev_sync(ifbdev);
8061487f786SFrançois Tigeot 
8071487f786SFrançois Tigeot 	intel_fbdev_destroy(ifbdev);
808717f4a47SSascha Wildner 	dev_priv->fbdev = NULL;
809717f4a47SSascha Wildner }
810717f4a47SSascha Wildner 
8111b13d190SFrançois Tigeot void intel_fbdev_set_suspend(struct drm_device *dev, int state, bool synchronous)
812717f4a47SSascha Wildner {
813717f4a47SSascha Wildner #if 0
814*bf017597SFrançois Tigeot 	struct drm_i915_private *dev_priv = to_i915(dev);
815717f4a47SSascha Wildner 	struct intel_fbdev *ifbdev = dev_priv->fbdev;
816717f4a47SSascha Wildner 	struct fb_info *info;
817717f4a47SSascha Wildner 
818*bf017597SFrançois Tigeot 	if (!ifbdev || !ifbdev->fb)
819717f4a47SSascha Wildner 		return;
820717f4a47SSascha Wildner 
821717f4a47SSascha Wildner 	info = ifbdev->helper.fbdev;
822717f4a47SSascha Wildner 
8231b13d190SFrançois Tigeot 	if (synchronous) {
8241b13d190SFrançois Tigeot 		/* Flush any pending work to turn the console on, and then
8251b13d190SFrançois Tigeot 		 * wait to turn it off. It must be synchronous as we are
8261b13d190SFrançois Tigeot 		 * about to suspend or unload the driver.
8271b13d190SFrançois Tigeot 		 *
8281b13d190SFrançois Tigeot 		 * Note that from within the work-handler, we cannot flush
8291b13d190SFrançois Tigeot 		 * ourselves, so only flush outstanding work upon suspend!
8301b13d190SFrançois Tigeot 		 */
8311b13d190SFrançois Tigeot 		if (state != FBINFO_STATE_RUNNING)
8321b13d190SFrançois Tigeot 			flush_work(&dev_priv->fbdev_suspend_work);
8331b13d190SFrançois Tigeot 		console_lock();
8341b13d190SFrançois Tigeot 	} else {
8351b13d190SFrançois Tigeot 		/*
8361b13d190SFrançois Tigeot 		 * The console lock can be pretty contented on resume due
8371b13d190SFrançois Tigeot 		 * to all the printk activity.  Try to keep it out of the hot
8381b13d190SFrançois Tigeot 		 * path of resume if possible.
8391b13d190SFrançois Tigeot 		 */
8401b13d190SFrançois Tigeot 		WARN_ON(state != FBINFO_STATE_RUNNING);
8411b13d190SFrançois Tigeot 		if (!console_trylock()) {
8421b13d190SFrançois Tigeot 			/* Don't block our own workqueue as this can
8431b13d190SFrançois Tigeot 			 * be run in parallel with other i915.ko tasks.
8441b13d190SFrançois Tigeot 			 */
8451b13d190SFrançois Tigeot 			schedule_work(&dev_priv->fbdev_suspend_work);
8461b13d190SFrançois Tigeot 			return;
8471b13d190SFrançois Tigeot 		}
8481b13d190SFrançois Tigeot 	}
8491b13d190SFrançois Tigeot 
850717f4a47SSascha Wildner 	/* On resume from hibernation: If the object is shmemfs backed, it has
851717f4a47SSascha Wildner 	 * been restored from swap. If the object is stolen however, it will be
852717f4a47SSascha Wildner 	 * full of whatever garbage was left in there.
853717f4a47SSascha Wildner 	 */
8541b13d190SFrançois Tigeot 	if (state == FBINFO_STATE_RUNNING && ifbdev->fb->obj->stolen)
855717f4a47SSascha Wildner 		memset_io(info->screen_base, 0, info->screen_size);
856717f4a47SSascha Wildner 
857a05eeebfSFrançois Tigeot 	drm_fb_helper_set_suspend(&ifbdev->helper, state);
8581b13d190SFrançois Tigeot 	console_unlock();
859717f4a47SSascha Wildner #endif
860717f4a47SSascha Wildner }
861717f4a47SSascha Wildner 
862717f4a47SSascha Wildner void intel_fbdev_output_poll_changed(struct drm_device *dev)
863717f4a47SSascha Wildner {
864*bf017597SFrançois Tigeot 	struct intel_fbdev *ifbdev = to_i915(dev)->fbdev;
865*bf017597SFrançois Tigeot 
866*bf017597SFrançois Tigeot 	if (ifbdev && ifbdev->fb)
867*bf017597SFrançois Tigeot 		drm_fb_helper_hotplug_event(&ifbdev->helper);
868717f4a47SSascha Wildner }
869717f4a47SSascha Wildner 
870717f4a47SSascha Wildner void intel_fbdev_restore_mode(struct drm_device *dev)
871717f4a47SSascha Wildner {
872*bf017597SFrançois Tigeot 	struct intel_fbdev *ifbdev = to_i915(dev)->fbdev;
873717f4a47SSascha Wildner 
874a05eeebfSFrançois Tigeot 	if (!ifbdev)
875717f4a47SSascha Wildner 		return;
876717f4a47SSascha Wildner 
8771487f786SFrançois Tigeot 	intel_fbdev_sync(ifbdev);
878*bf017597SFrançois Tigeot 	if (!ifbdev->fb)
879*bf017597SFrançois Tigeot 		return;
880a05eeebfSFrançois Tigeot 
8811487f786SFrançois Tigeot #ifdef __DragonFly__
8829c52345dSzrj 	/* XXX: avoid dead-locking the Xorg on exit */
8839c52345dSzrj 	if (mutex_is_locked(&dev->mode_config.mutex)) {
8849c52345dSzrj 		DRM_ERROR("fubar while trying to restore kms_console\n");
8859c52345dSzrj 		return; /* drm_modeset_unlock_all(dev) ? */
8869c52345dSzrj 	}
8871487f786SFrançois Tigeot #endif
8889c52345dSzrj 
889*bf017597SFrançois Tigeot 	if (drm_fb_helper_restore_fbdev_mode_unlocked(&ifbdev->helper)) {
890717f4a47SSascha Wildner 		DRM_DEBUG("failed to restore crtc mode\n");
891a05eeebfSFrançois Tigeot 	} else {
892*bf017597SFrançois Tigeot 		mutex_lock(&dev->struct_mutex);
893a05eeebfSFrançois Tigeot 		intel_fb_obj_invalidate(ifbdev->fb->obj, ORIGIN_GTT);
894*bf017597SFrançois Tigeot 		mutex_unlock(&dev->struct_mutex);
895a05eeebfSFrançois Tigeot 	}
896717f4a47SSascha Wildner }
897