Linux Audio

Check our new training course

Loading...
Note: File does not exist in v3.1.
  1/*
  2 * Copyright © 2007 David Airlie
  3 *
  4 * Permission is hereby granted, free of charge, to any person obtaining a
  5 * copy of this software and associated documentation files (the "Software"),
  6 * to deal in the Software without restriction, including without limitation
  7 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
  8 * and/or sell copies of the Software, and to permit persons to whom the
  9 * Software is furnished to do so, subject to the following conditions:
 10 *
 11 * The above copyright notice and this permission notice (including the next
 12 * paragraph) shall be included in all copies or substantial portions of the
 13 * Software.
 14 *
 15 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 16 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 17 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
 18 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 19 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
 20 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
 21 * DEALINGS IN THE SOFTWARE.
 22 *
 23 * Authors:
 24 *     David Airlie
 25 */
 26
 27#include <linux/async.h>
 28#include <linux/module.h>
 29#include <linux/kernel.h>
 30#include <linux/console.h>
 31#include <linux/errno.h>
 32#include <linux/string.h>
 33#include <linux/mm.h>
 34#include <linux/tty.h>
 35#include <linux/sysrq.h>
 36#include <linux/delay.h>
 37#include <linux/fb.h>
 38#include <linux/init.h>
 39#include <linux/vga_switcheroo.h>
 40
 41#include <drm/drmP.h>
 42#include <drm/drm_crtc.h>
 43#include <drm/drm_fb_helper.h>
 44#include "intel_drv.h"
 45#include <drm/i915_drm.h>
 46#include "i915_drv.h"
 47
 48static int intel_fbdev_set_par(struct fb_info *info)
 49{
 50	struct drm_fb_helper *fb_helper = info->par;
 51	struct intel_fbdev *ifbdev =
 52		container_of(fb_helper, struct intel_fbdev, helper);
 53	int ret;
 54
 55	ret = drm_fb_helper_set_par(info);
 56
 57	if (ret == 0) {
 58		mutex_lock(&fb_helper->dev->struct_mutex);
 59		intel_fb_obj_invalidate(ifbdev->fb->obj, ORIGIN_GTT);
 60		mutex_unlock(&fb_helper->dev->struct_mutex);
 61	}
 62
 63	return ret;
 64}
 65
 66static int intel_fbdev_blank(int blank, struct fb_info *info)
 67{
 68	struct drm_fb_helper *fb_helper = info->par;
 69	struct intel_fbdev *ifbdev =
 70		container_of(fb_helper, struct intel_fbdev, helper);
 71	int ret;
 72
 73	ret = drm_fb_helper_blank(blank, info);
 74
 75	if (ret == 0) {
 76		mutex_lock(&fb_helper->dev->struct_mutex);
 77		intel_fb_obj_invalidate(ifbdev->fb->obj, ORIGIN_GTT);
 78		mutex_unlock(&fb_helper->dev->struct_mutex);
 79	}
 80
 81	return ret;
 82}
 83
 84static int intel_fbdev_pan_display(struct fb_var_screeninfo *var,
 85				   struct fb_info *info)
 86{
 87	struct drm_fb_helper *fb_helper = info->par;
 88	struct intel_fbdev *ifbdev =
 89		container_of(fb_helper, struct intel_fbdev, helper);
 90
 91	int ret;
 92	ret = drm_fb_helper_pan_display(var, info);
 93
 94	if (ret == 0) {
 95		mutex_lock(&fb_helper->dev->struct_mutex);
 96		intel_fb_obj_invalidate(ifbdev->fb->obj, ORIGIN_GTT);
 97		mutex_unlock(&fb_helper->dev->struct_mutex);
 98	}
 99
100	return ret;
101}
102
103static struct fb_ops intelfb_ops = {
104	.owner = THIS_MODULE,
105	.fb_check_var = drm_fb_helper_check_var,
106	.fb_set_par = intel_fbdev_set_par,
107	.fb_fillrect = drm_fb_helper_cfb_fillrect,
108	.fb_copyarea = drm_fb_helper_cfb_copyarea,
109	.fb_imageblit = drm_fb_helper_cfb_imageblit,
110	.fb_pan_display = intel_fbdev_pan_display,
111	.fb_blank = intel_fbdev_blank,
112	.fb_setcmap = drm_fb_helper_setcmap,
113	.fb_debug_enter = drm_fb_helper_debug_enter,
114	.fb_debug_leave = drm_fb_helper_debug_leave,
115};
116
117static int intelfb_alloc(struct drm_fb_helper *helper,
118			 struct drm_fb_helper_surface_size *sizes)
119{
120	struct intel_fbdev *ifbdev =
121		container_of(helper, struct intel_fbdev, helper);
122	struct drm_framebuffer *fb;
123	struct drm_device *dev = helper->dev;
124	struct drm_i915_private *dev_priv = to_i915(dev);
125	struct drm_mode_fb_cmd2 mode_cmd = {};
126	struct drm_i915_gem_object *obj = NULL;
127	int size, ret;
128
129	/* we don't do packed 24bpp */
130	if (sizes->surface_bpp == 24)
131		sizes->surface_bpp = 32;
132
133	mode_cmd.width = sizes->surface_width;
134	mode_cmd.height = sizes->surface_height;
135
136	mode_cmd.pitches[0] = ALIGN(mode_cmd.width *
137				    DIV_ROUND_UP(sizes->surface_bpp, 8), 64);
138	mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp,
139							  sizes->surface_depth);
140
141	mutex_lock(&dev->struct_mutex);
142
143	size = mode_cmd.pitches[0] * mode_cmd.height;
144	size = PAGE_ALIGN(size);
145
146	/* If the FB is too big, just don't use it since fbdev is not very
147	 * important and we should probably use that space with FBC or other
148	 * features. */
149	if (size * 2 < dev_priv->gtt.stolen_usable_size)
150		obj = i915_gem_object_create_stolen(dev, size);
151	if (obj == NULL)
152		obj = i915_gem_alloc_object(dev, size);
153	if (!obj) {
154		DRM_ERROR("failed to allocate framebuffer\n");
155		ret = -ENOMEM;
156		goto out;
157	}
158
159	fb = __intel_framebuffer_create(dev, &mode_cmd, obj);
160	if (IS_ERR(fb)) {
161		drm_gem_object_unreference(&obj->base);
162		ret = PTR_ERR(fb);
163		goto out;
164	}
165
166	mutex_unlock(&dev->struct_mutex);
167
168	ifbdev->fb = to_intel_framebuffer(fb);
169
170	return 0;
171
172out:
173	mutex_unlock(&dev->struct_mutex);
174	return ret;
175}
176
177static int intelfb_create(struct drm_fb_helper *helper,
178			  struct drm_fb_helper_surface_size *sizes)
179{
180	struct intel_fbdev *ifbdev =
181		container_of(helper, struct intel_fbdev, helper);
182	struct intel_framebuffer *intel_fb = ifbdev->fb;
183	struct drm_device *dev = helper->dev;
184	struct drm_i915_private *dev_priv = dev->dev_private;
185	struct fb_info *info;
186	struct drm_framebuffer *fb;
187	struct drm_i915_gem_object *obj;
188	int size, ret;
189	bool prealloc = false;
190
191	if (intel_fb &&
192	    (sizes->fb_width > intel_fb->base.width ||
193	     sizes->fb_height > intel_fb->base.height)) {
194		DRM_DEBUG_KMS("BIOS fb too small (%dx%d), we require (%dx%d),"
195			      " releasing it\n",
196			      intel_fb->base.width, intel_fb->base.height,
197			      sizes->fb_width, sizes->fb_height);
198		drm_framebuffer_unreference(&intel_fb->base);
199		intel_fb = ifbdev->fb = NULL;
200	}
201	if (!intel_fb || WARN_ON(!intel_fb->obj)) {
202		DRM_DEBUG_KMS("no BIOS fb, allocating a new one\n");
203		ret = intelfb_alloc(helper, sizes);
204		if (ret)
205			return ret;
206		intel_fb = ifbdev->fb;
207	} else {
208		DRM_DEBUG_KMS("re-using BIOS fb\n");
209		prealloc = true;
210		sizes->fb_width = intel_fb->base.width;
211		sizes->fb_height = intel_fb->base.height;
212	}
213
214	obj = intel_fb->obj;
215	size = obj->base.size;
216
217	mutex_lock(&dev->struct_mutex);
218
219	/* Pin the GGTT vma for our access via info->screen_base.
220	 * This also validates that any existing fb inherited from the
221	 * BIOS is suitable for own access.
222	 */
223	ret = intel_pin_and_fence_fb_obj(NULL, &ifbdev->fb->base, NULL);
224	if (ret)
225		goto out_unlock;
226
227	info = drm_fb_helper_alloc_fbi(helper);
228	if (IS_ERR(info)) {
229		DRM_ERROR("Failed to allocate fb_info\n");
230		ret = PTR_ERR(info);
231		goto out_unpin;
232	}
233
234	info->par = helper;
235
236	fb = &ifbdev->fb->base;
237
238	ifbdev->helper.fb = fb;
239
240	strcpy(info->fix.id, "inteldrmfb");
241
242	info->flags = FBINFO_DEFAULT | FBINFO_CAN_FORCE_OUTPUT;
243	info->fbops = &intelfb_ops;
244
245	/* setup aperture base/size for vesafb takeover */
246	info->apertures->ranges[0].base = dev->mode_config.fb_base;
247	info->apertures->ranges[0].size = dev_priv->gtt.mappable_end;
248
249	info->fix.smem_start = dev->mode_config.fb_base + i915_gem_obj_ggtt_offset(obj);
250	info->fix.smem_len = size;
251
252	info->screen_base =
253		ioremap_wc(dev_priv->gtt.mappable_base + i915_gem_obj_ggtt_offset(obj),
254			   size);
255	if (!info->screen_base) {
256		DRM_ERROR("Failed to remap framebuffer into virtual memory\n");
257		ret = -ENOSPC;
258		goto out_destroy_fbi;
259	}
260	info->screen_size = size;
261
262	/* This driver doesn't need a VT switch to restore the mode on resume */
263	info->skip_vt_switch = true;
264
265	drm_fb_helper_fill_fix(info, fb->pitches[0], fb->depth);
266	drm_fb_helper_fill_var(info, &ifbdev->helper, sizes->fb_width, sizes->fb_height);
267
268	/* If the object is shmemfs backed, it will have given us zeroed pages.
269	 * If the object is stolen however, it will be full of whatever
270	 * garbage was left in there.
271	 */
272	if (ifbdev->fb->obj->stolen && !prealloc)
273		memset_io(info->screen_base, 0, info->screen_size);
274
275	/* Use default scratch pixmap (info->pixmap.flags = FB_PIXMAP_SYSTEM) */
276
277	DRM_DEBUG_KMS("allocated %dx%d fb: 0x%08llx, bo %p\n",
278		      fb->width, fb->height,
279		      i915_gem_obj_ggtt_offset(obj), obj);
280
281	mutex_unlock(&dev->struct_mutex);
282	vga_switcheroo_client_fb_set(dev->pdev, info);
283	return 0;
284
285out_destroy_fbi:
286	drm_fb_helper_release_fbi(helper);
287out_unpin:
288	i915_gem_object_ggtt_unpin(obj);
289out_unlock:
290	mutex_unlock(&dev->struct_mutex);
291	return ret;
292}
293
294/** Sets the color ramps on behalf of RandR */
295static void intel_crtc_fb_gamma_set(struct drm_crtc *crtc, u16 red, u16 green,
296				    u16 blue, int regno)
297{
298	struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
299
300	intel_crtc->lut_r[regno] = red >> 8;
301	intel_crtc->lut_g[regno] = green >> 8;
302	intel_crtc->lut_b[regno] = blue >> 8;
303}
304
305static void intel_crtc_fb_gamma_get(struct drm_crtc *crtc, u16 *red, u16 *green,
306				    u16 *blue, int regno)
307{
308	struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
309
310	*red = intel_crtc->lut_r[regno] << 8;
311	*green = intel_crtc->lut_g[regno] << 8;
312	*blue = intel_crtc->lut_b[regno] << 8;
313}
314
315static struct drm_fb_helper_crtc *
316intel_fb_helper_crtc(struct drm_fb_helper *fb_helper, struct drm_crtc *crtc)
317{
318	int i;
319
320	for (i = 0; i < fb_helper->crtc_count; i++)
321		if (fb_helper->crtc_info[i].mode_set.crtc == crtc)
322			return &fb_helper->crtc_info[i];
323
324	return NULL;
325}
326
327/*
328 * Try to read the BIOS display configuration and use it for the initial
329 * fb configuration.
330 *
331 * The BIOS or boot loader will generally create an initial display
332 * configuration for us that includes some set of active pipes and displays.
333 * This routine tries to figure out which pipes and connectors are active
334 * and stuffs them into the crtcs and modes array given to us by the
335 * drm_fb_helper code.
336 *
337 * The overall sequence is:
338 *   intel_fbdev_init - from driver load
339 *     intel_fbdev_init_bios - initialize the intel_fbdev using BIOS data
340 *     drm_fb_helper_init - build fb helper structs
341 *     drm_fb_helper_single_add_all_connectors - more fb helper structs
342 *   intel_fbdev_initial_config - apply the config
343 *     drm_fb_helper_initial_config - call ->probe then register_framebuffer()
344 *         drm_setup_crtcs - build crtc config for fbdev
345 *           intel_fb_initial_config - find active connectors etc
346 *         drm_fb_helper_single_fb_probe - set up fbdev
347 *           intelfb_create - re-use or alloc fb, build out fbdev structs
348 *
349 * Note that we don't make special consideration whether we could actually
350 * switch to the selected modes without a full modeset. E.g. when the display
351 * is in VGA mode we need to recalculate watermarks and set a new high-res
352 * framebuffer anyway.
353 */
354static bool intel_fb_initial_config(struct drm_fb_helper *fb_helper,
355				    struct drm_fb_helper_crtc **crtcs,
356				    struct drm_display_mode **modes,
357				    struct drm_fb_offset *offsets,
358				    bool *enabled, int width, int height)
359{
360	struct drm_device *dev = fb_helper->dev;
361	int i, j;
362	bool *save_enabled;
363	bool fallback = true;
364	int num_connectors_enabled = 0;
365	int num_connectors_detected = 0;
366	uint64_t conn_configured = 0, mask;
367	int pass = 0;
368
369	save_enabled = kcalloc(dev->mode_config.num_connector, sizeof(bool),
370			       GFP_KERNEL);
371	if (!save_enabled)
372		return false;
373
374	memcpy(save_enabled, enabled, dev->mode_config.num_connector);
375	mask = (1 << fb_helper->connector_count) - 1;
376retry:
377	for (i = 0; i < fb_helper->connector_count; i++) {
378		struct drm_fb_helper_connector *fb_conn;
379		struct drm_connector *connector;
380		struct drm_encoder *encoder;
381		struct drm_fb_helper_crtc *new_crtc;
382
383		fb_conn = fb_helper->connector_info[i];
384		connector = fb_conn->connector;
385
386		if (conn_configured & (1 << i))
387			continue;
388
389		if (pass == 0 && !connector->has_tile)
390			continue;
391
392		if (connector->status == connector_status_connected)
393			num_connectors_detected++;
394
395		if (!enabled[i]) {
396			DRM_DEBUG_KMS("connector %s not enabled, skipping\n",
397				      connector->name);
398			conn_configured |= (1 << i);
399			continue;
400		}
401
402		if (connector->force == DRM_FORCE_OFF) {
403			DRM_DEBUG_KMS("connector %s is disabled by user, skipping\n",
404				      connector->name);
405			enabled[i] = false;
406			continue;
407		}
408
409		encoder = connector->state->best_encoder;
410		if (!encoder || WARN_ON(!connector->state->crtc)) {
411			if (connector->force > DRM_FORCE_OFF)
412				goto bail;
413
414			DRM_DEBUG_KMS("connector %s has no encoder or crtc, skipping\n",
415				      connector->name);
416			enabled[i] = false;
417			conn_configured |= (1 << i);
418			continue;
419		}
420
421		num_connectors_enabled++;
422
423		new_crtc = intel_fb_helper_crtc(fb_helper, connector->state->crtc);
424
425		/*
426		 * Make sure we're not trying to drive multiple connectors
427		 * with a single CRTC, since our cloning support may not
428		 * match the BIOS.
429		 */
430		for (j = 0; j < fb_helper->connector_count; j++) {
431			if (crtcs[j] == new_crtc) {
432				DRM_DEBUG_KMS("fallback: cloned configuration\n");
433				goto bail;
434			}
435		}
436
437		DRM_DEBUG_KMS("looking for cmdline mode on connector %s\n",
438			      connector->name);
439
440		/* go for command line mode first */
441		modes[i] = drm_pick_cmdline_mode(fb_conn, width, height);
442
443		/* try for preferred next */
444		if (!modes[i]) {
445			DRM_DEBUG_KMS("looking for preferred mode on connector %s %d\n",
446				      connector->name, connector->has_tile);
447			modes[i] = drm_has_preferred_mode(fb_conn, width,
448							  height);
449		}
450
451		/* No preferred mode marked by the EDID? Are there any modes? */
452		if (!modes[i] && !list_empty(&connector->modes)) {
453			DRM_DEBUG_KMS("using first mode listed on connector %s\n",
454				      connector->name);
455			modes[i] = list_first_entry(&connector->modes,
456						    struct drm_display_mode,
457						    head);
458		}
459
460		/* last resort: use current mode */
461		if (!modes[i]) {
462			/*
463			 * IMPORTANT: We want to use the adjusted mode (i.e.
464			 * after the panel fitter upscaling) as the initial
465			 * config, not the input mode, which is what crtc->mode
466			 * usually contains. But since our current
467			 * code puts a mode derived from the post-pfit timings
468			 * into crtc->mode this works out correctly.
469			 *
470			 * This is crtc->mode and not crtc->state->mode for the
471			 * fastboot check to work correctly. crtc_state->mode has
472			 * I915_MODE_FLAG_INHERITED, which we clear to force check
473			 * state.
474			 */
475			DRM_DEBUG_KMS("looking for current mode on connector %s\n",
476				      connector->name);
477			modes[i] = &connector->state->crtc->mode;
478		}
479		crtcs[i] = new_crtc;
480
481		DRM_DEBUG_KMS("connector %s on pipe %c [CRTC:%d]: %dx%d%s\n",
482			      connector->name,
483			      pipe_name(to_intel_crtc(connector->state->crtc)->pipe),
484			      connector->state->crtc->base.id,
485			      modes[i]->hdisplay, modes[i]->vdisplay,
486			      modes[i]->flags & DRM_MODE_FLAG_INTERLACE ? "i" :"");
487
488		fallback = false;
489		conn_configured |= (1 << i);
490	}
491
492	if ((conn_configured & mask) != mask) {
493		pass++;
494		goto retry;
495	}
496
497	/*
498	 * If the BIOS didn't enable everything it could, fall back to have the
499	 * same user experiencing of lighting up as much as possible like the
500	 * fbdev helper library.
501	 */
502	if (num_connectors_enabled != num_connectors_detected &&
503	    num_connectors_enabled < INTEL_INFO(dev)->num_pipes) {
504		DRM_DEBUG_KMS("fallback: Not all outputs enabled\n");
505		DRM_DEBUG_KMS("Enabled: %i, detected: %i\n", num_connectors_enabled,
506			      num_connectors_detected);
507		fallback = true;
508	}
509
510	if (fallback) {
511bail:
512		DRM_DEBUG_KMS("Not using firmware configuration\n");
513		memcpy(enabled, save_enabled, dev->mode_config.num_connector);
514		kfree(save_enabled);
515		return false;
516	}
517
518	kfree(save_enabled);
519	return true;
520}
521
522static const struct drm_fb_helper_funcs intel_fb_helper_funcs = {
523	.initial_config = intel_fb_initial_config,
524	.gamma_set = intel_crtc_fb_gamma_set,
525	.gamma_get = intel_crtc_fb_gamma_get,
526	.fb_probe = intelfb_create,
527};
528
529static void intel_fbdev_destroy(struct drm_device *dev,
530				struct intel_fbdev *ifbdev)
531{
532	/* We rely on the object-free to release the VMA pinning for
533	 * the info->screen_base mmaping. Leaking the VMA is simpler than
534	 * trying to rectify all the possible error paths leading here.
535	 */
536
537	drm_fb_helper_unregister_fbi(&ifbdev->helper);
538	drm_fb_helper_release_fbi(&ifbdev->helper);
539
540	drm_fb_helper_fini(&ifbdev->helper);
541
542	if (ifbdev->fb) {
543		drm_framebuffer_unregister_private(&ifbdev->fb->base);
544		drm_framebuffer_remove(&ifbdev->fb->base);
545	}
546}
547
548/*
549 * Build an intel_fbdev struct using a BIOS allocated framebuffer, if possible.
550 * The core display code will have read out the current plane configuration,
551 * so we use that to figure out if there's an object for us to use as the
552 * fb, and if so, we re-use it for the fbdev configuration.
553 *
554 * Note we only support a single fb shared across pipes for boot (mostly for
555 * fbcon), so we just find the biggest and use that.
556 */
557static bool intel_fbdev_init_bios(struct drm_device *dev,
558				 struct intel_fbdev *ifbdev)
559{
560	struct intel_framebuffer *fb = NULL;
561	struct drm_crtc *crtc;
562	struct intel_crtc *intel_crtc;
563	unsigned int max_size = 0;
564
565	/* Find the largest fb */
566	for_each_crtc(dev, crtc) {
567		struct drm_i915_gem_object *obj =
568			intel_fb_obj(crtc->primary->state->fb);
569		intel_crtc = to_intel_crtc(crtc);
570
571		if (!crtc->state->active || !obj) {
572			DRM_DEBUG_KMS("pipe %c not active or no fb, skipping\n",
573				      pipe_name(intel_crtc->pipe));
574			continue;
575		}
576
577		if (obj->base.size > max_size) {
578			DRM_DEBUG_KMS("found possible fb from plane %c\n",
579				      pipe_name(intel_crtc->pipe));
580			fb = to_intel_framebuffer(crtc->primary->state->fb);
581			max_size = obj->base.size;
582		}
583	}
584
585	if (!fb) {
586		DRM_DEBUG_KMS("no active fbs found, not using BIOS config\n");
587		goto out;
588	}
589
590	/* Now make sure all the pipes will fit into it */
591	for_each_crtc(dev, crtc) {
592		unsigned int cur_size;
593
594		intel_crtc = to_intel_crtc(crtc);
595
596		if (!crtc->state->active) {
597			DRM_DEBUG_KMS("pipe %c not active, skipping\n",
598				      pipe_name(intel_crtc->pipe));
599			continue;
600		}
601
602		DRM_DEBUG_KMS("checking plane %c for BIOS fb\n",
603			      pipe_name(intel_crtc->pipe));
604
605		/*
606		 * See if the plane fb we found above will fit on this
607		 * pipe.  Note we need to use the selected fb's pitch and bpp
608		 * rather than the current pipe's, since they differ.
609		 */
610		cur_size = intel_crtc->config->base.adjusted_mode.crtc_hdisplay;
611		cur_size = cur_size * fb->base.bits_per_pixel / 8;
612		if (fb->base.pitches[0] < cur_size) {
613			DRM_DEBUG_KMS("fb not wide enough for plane %c (%d vs %d)\n",
614				      pipe_name(intel_crtc->pipe),
615				      cur_size, fb->base.pitches[0]);
616			fb = NULL;
617			break;
618		}
619
620		cur_size = intel_crtc->config->base.adjusted_mode.crtc_vdisplay;
621		cur_size = intel_fb_align_height(dev, cur_size,
622						 fb->base.pixel_format,
623						 fb->base.modifier[0]);
624		cur_size *= fb->base.pitches[0];
625		DRM_DEBUG_KMS("pipe %c area: %dx%d, bpp: %d, size: %d\n",
626			      pipe_name(intel_crtc->pipe),
627			      intel_crtc->config->base.adjusted_mode.crtc_hdisplay,
628			      intel_crtc->config->base.adjusted_mode.crtc_vdisplay,
629			      fb->base.bits_per_pixel,
630			      cur_size);
631
632		if (cur_size > max_size) {
633			DRM_DEBUG_KMS("fb not big enough for plane %c (%d vs %d)\n",
634				      pipe_name(intel_crtc->pipe),
635				      cur_size, max_size);
636			fb = NULL;
637			break;
638		}
639
640		DRM_DEBUG_KMS("fb big enough for plane %c (%d >= %d)\n",
641			      pipe_name(intel_crtc->pipe),
642			      max_size, cur_size);
643	}
644
645	if (!fb) {
646		DRM_DEBUG_KMS("BIOS fb not suitable for all pipes, not using\n");
647		goto out;
648	}
649
650	ifbdev->preferred_bpp = fb->base.bits_per_pixel;
651	ifbdev->fb = fb;
652
653	drm_framebuffer_reference(&ifbdev->fb->base);
654
655	/* Final pass to check if any active pipes don't have fbs */
656	for_each_crtc(dev, crtc) {
657		intel_crtc = to_intel_crtc(crtc);
658
659		if (!crtc->state->active)
660			continue;
661
662		WARN(!crtc->primary->fb,
663		     "re-used BIOS config but lost an fb on crtc %d\n",
664		     crtc->base.id);
665	}
666
667
668	DRM_DEBUG_KMS("using BIOS fb for initial console\n");
669	return true;
670
671out:
672
673	return false;
674}
675
676static void intel_fbdev_suspend_worker(struct work_struct *work)
677{
678	intel_fbdev_set_suspend(container_of(work,
679					     struct drm_i915_private,
680					     fbdev_suspend_work)->dev,
681				FBINFO_STATE_RUNNING,
682				true);
683}
684
685int intel_fbdev_init(struct drm_device *dev)
686{
687	struct intel_fbdev *ifbdev;
688	struct drm_i915_private *dev_priv = dev->dev_private;
689	int ret;
690
691	if (WARN_ON(INTEL_INFO(dev)->num_pipes == 0))
692		return -ENODEV;
693
694	ifbdev = kzalloc(sizeof(struct intel_fbdev), GFP_KERNEL);
695	if (ifbdev == NULL)
696		return -ENOMEM;
697
698	drm_fb_helper_prepare(dev, &ifbdev->helper, &intel_fb_helper_funcs);
699
700	if (!intel_fbdev_init_bios(dev, ifbdev))
701		ifbdev->preferred_bpp = 32;
702
703	ret = drm_fb_helper_init(dev, &ifbdev->helper,
704				 INTEL_INFO(dev)->num_pipes, 4);
705	if (ret) {
706		kfree(ifbdev);
707		return ret;
708	}
709
710	ifbdev->helper.atomic = true;
711
712	dev_priv->fbdev = ifbdev;
713	INIT_WORK(&dev_priv->fbdev_suspend_work, intel_fbdev_suspend_worker);
714
715	drm_fb_helper_single_add_all_connectors(&ifbdev->helper);
716
717	return 0;
718}
719
720static void intel_fbdev_initial_config(void *data, async_cookie_t cookie)
721{
722	struct drm_i915_private *dev_priv = data;
723	struct intel_fbdev *ifbdev = dev_priv->fbdev;
724
725	/* Due to peculiar init order wrt to hpd handling this is separate. */
726	if (drm_fb_helper_initial_config(&ifbdev->helper,
727					 ifbdev->preferred_bpp))
728		intel_fbdev_fini(dev_priv->dev);
729}
730
731void intel_fbdev_initial_config_async(struct drm_device *dev)
732{
733	async_schedule(intel_fbdev_initial_config, to_i915(dev));
734}
735
736void intel_fbdev_fini(struct drm_device *dev)
737{
738	struct drm_i915_private *dev_priv = dev->dev_private;
739	if (!dev_priv->fbdev)
740		return;
741
742	flush_work(&dev_priv->fbdev_suspend_work);
743
744	if (!current_is_async())
745		async_synchronize_full();
746	intel_fbdev_destroy(dev, dev_priv->fbdev);
747	kfree(dev_priv->fbdev);
748	dev_priv->fbdev = NULL;
749}
750
751void intel_fbdev_set_suspend(struct drm_device *dev, int state, bool synchronous)
752{
753	struct drm_i915_private *dev_priv = dev->dev_private;
754	struct intel_fbdev *ifbdev = dev_priv->fbdev;
755	struct fb_info *info;
756
757	if (!ifbdev)
758		return;
759
760	info = ifbdev->helper.fbdev;
761
762	if (synchronous) {
763		/* Flush any pending work to turn the console on, and then
764		 * wait to turn it off. It must be synchronous as we are
765		 * about to suspend or unload the driver.
766		 *
767		 * Note that from within the work-handler, we cannot flush
768		 * ourselves, so only flush outstanding work upon suspend!
769		 */
770		if (state != FBINFO_STATE_RUNNING)
771			flush_work(&dev_priv->fbdev_suspend_work);
772		console_lock();
773	} else {
774		/*
775		 * The console lock can be pretty contented on resume due
776		 * to all the printk activity.  Try to keep it out of the hot
777		 * path of resume if possible.
778		 */
779		WARN_ON(state != FBINFO_STATE_RUNNING);
780		if (!console_trylock()) {
781			/* Don't block our own workqueue as this can
782			 * be run in parallel with other i915.ko tasks.
783			 */
784			schedule_work(&dev_priv->fbdev_suspend_work);
785			return;
786		}
787	}
788
789	/* On resume from hibernation: If the object is shmemfs backed, it has
790	 * been restored from swap. If the object is stolen however, it will be
791	 * full of whatever garbage was left in there.
792	 */
793	if (state == FBINFO_STATE_RUNNING && ifbdev->fb->obj->stolen)
794		memset_io(info->screen_base, 0, info->screen_size);
795
796	drm_fb_helper_set_suspend(&ifbdev->helper, state);
797	console_unlock();
798}
799
800void intel_fbdev_output_poll_changed(struct drm_device *dev)
801{
802	struct drm_i915_private *dev_priv = dev->dev_private;
803	if (dev_priv->fbdev)
804		drm_fb_helper_hotplug_event(&dev_priv->fbdev->helper);
805}
806
807void intel_fbdev_restore_mode(struct drm_device *dev)
808{
809	int ret;
810	struct drm_i915_private *dev_priv = dev->dev_private;
811	struct intel_fbdev *ifbdev = dev_priv->fbdev;
812	struct drm_fb_helper *fb_helper;
813
814	if (!ifbdev)
815		return;
816
817	fb_helper = &ifbdev->helper;
818
819	ret = drm_fb_helper_restore_fbdev_mode_unlocked(fb_helper);
820	if (ret) {
821		DRM_DEBUG("failed to restore crtc mode\n");
822	} else {
823		mutex_lock(&fb_helper->dev->struct_mutex);
824		intel_fb_obj_invalidate(ifbdev->fb->obj, ORIGIN_GTT);
825		mutex_unlock(&fb_helper->dev->struct_mutex);
826	}
827}