Linux Audio

Check our new training course

Loading...
v4.6
  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}
v3.15
  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/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_alloc(struct drm_fb_helper *helper,
 61			 struct drm_fb_helper_surface_size *sizes)
 62{
 63	struct intel_fbdev *ifbdev =
 64		container_of(helper, struct intel_fbdev, helper);
 65	struct drm_framebuffer *fb;
 66	struct drm_device *dev = helper->dev;
 
 67	struct drm_mode_fb_cmd2 mode_cmd = {};
 68	struct drm_i915_gem_object *obj;
 69	int size, ret;
 70
 71	/* we don't do packed 24bpp */
 72	if (sizes->surface_bpp == 24)
 73		sizes->surface_bpp = 32;
 74
 75	mode_cmd.width = sizes->surface_width;
 76	mode_cmd.height = sizes->surface_height;
 77
 78	mode_cmd.pitches[0] = ALIGN(mode_cmd.width *
 79				    DIV_ROUND_UP(sizes->surface_bpp, 8), 64);
 80	mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp,
 81							  sizes->surface_depth);
 82
 
 
 83	size = mode_cmd.pitches[0] * mode_cmd.height;
 84	size = ALIGN(size, PAGE_SIZE);
 85	obj = i915_gem_object_create_stolen(dev, size);
 
 
 
 
 
 86	if (obj == NULL)
 87		obj = i915_gem_alloc_object(dev, size);
 88	if (!obj) {
 89		DRM_ERROR("failed to allocate framebuffer\n");
 90		ret = -ENOMEM;
 91		goto out;
 92	}
 93
 94	/* Flush everything out, we'll be doing GTT only from now on */
 95	ret = intel_pin_and_fence_fb_obj(dev, obj, NULL);
 96	if (ret) {
 97		DRM_ERROR("failed to pin obj: %d\n", ret);
 98		goto out_unref;
 99	}
100
101	fb = __intel_framebuffer_create(dev, &mode_cmd, obj);
102	if (IS_ERR(fb)) {
 
103		ret = PTR_ERR(fb);
104		goto out_unpin;
105	}
106
 
 
107	ifbdev->fb = to_intel_framebuffer(fb);
108
109	return 0;
110
111out_unpin:
112	i915_gem_object_ggtt_unpin(obj);
113out_unref:
114	drm_gem_object_unreference(&obj->base);
115out:
 
116	return ret;
117}
118
119static int intelfb_create(struct drm_fb_helper *helper,
120			  struct drm_fb_helper_surface_size *sizes)
121{
122	struct intel_fbdev *ifbdev =
123		container_of(helper, struct intel_fbdev, helper);
124	struct intel_framebuffer *intel_fb = ifbdev->fb;
125	struct drm_device *dev = helper->dev;
126	struct drm_i915_private *dev_priv = dev->dev_private;
127	struct fb_info *info;
128	struct drm_framebuffer *fb;
129	struct drm_i915_gem_object *obj;
130	int size, ret;
131	bool prealloc = false;
132
133	mutex_lock(&dev->struct_mutex);
134
135	if (intel_fb &&
136	    (sizes->fb_width > intel_fb->base.width ||
137	     sizes->fb_height > intel_fb->base.height)) {
138		DRM_DEBUG_KMS("BIOS fb too small (%dx%d), we require (%dx%d),"
139			      " releasing it\n",
140			      intel_fb->base.width, intel_fb->base.height,
141			      sizes->fb_width, sizes->fb_height);
142		drm_framebuffer_unreference(&intel_fb->base);
143		intel_fb = ifbdev->fb = NULL;
144	}
145	if (!intel_fb || WARN_ON(!intel_fb->obj)) {
146		DRM_DEBUG_KMS("no BIOS fb, allocating a new one\n");
147		ret = intelfb_alloc(helper, sizes);
148		if (ret)
149			goto out_unlock;
150		intel_fb = ifbdev->fb;
151	} else {
152		DRM_DEBUG_KMS("re-using BIOS fb\n");
153		prealloc = true;
154		sizes->fb_width = intel_fb->base.width;
155		sizes->fb_height = intel_fb->base.height;
156	}
157
158	obj = intel_fb->obj;
159	size = obj->base.size;
160
161	info = framebuffer_alloc(0, &dev->pdev->dev);
162	if (!info) {
163		ret = -ENOMEM;
 
 
 
 
 
 
 
 
 
 
 
164		goto out_unpin;
165	}
166
167	info->par = helper;
168
169	fb = &ifbdev->fb->base;
170
171	ifbdev->helper.fb = fb;
172	ifbdev->helper.fbdev = info;
173
174	strcpy(info->fix.id, "inteldrmfb");
175
176	info->flags = FBINFO_DEFAULT | FBINFO_CAN_FORCE_OUTPUT;
177	info->fbops = &intelfb_ops;
178
179	ret = fb_alloc_cmap(&info->cmap, 256, 0);
180	if (ret) {
181		ret = -ENOMEM;
182		goto out_unpin;
183	}
184	/* setup aperture base/size for vesafb takeover */
185	info->apertures = alloc_apertures(1);
186	if (!info->apertures) {
187		ret = -ENOMEM;
188		goto out_unpin;
189	}
190	info->apertures->ranges[0].base = dev->mode_config.fb_base;
191	info->apertures->ranges[0].size = dev_priv->gtt.mappable_end;
192
193	info->fix.smem_start = dev->mode_config.fb_base + i915_gem_obj_ggtt_offset(obj);
194	info->fix.smem_len = size;
195
196	info->screen_base =
197		ioremap_wc(dev_priv->gtt.mappable_base + i915_gem_obj_ggtt_offset(obj),
198			   size);
199	if (!info->screen_base) {
 
200		ret = -ENOSPC;
201		goto out_unpin;
202	}
203	info->screen_size = size;
204
205	/* This driver doesn't need a VT switch to restore the mode on resume */
206	info->skip_vt_switch = true;
207
208	drm_fb_helper_fill_fix(info, fb->pitches[0], fb->depth);
209	drm_fb_helper_fill_var(info, &ifbdev->helper, sizes->fb_width, sizes->fb_height);
210
211	/* If the object is shmemfs backed, it will have given us zeroed pages.
212	 * If the object is stolen however, it will be full of whatever
213	 * garbage was left in there.
214	 */
215	if (ifbdev->fb->obj->stolen && !prealloc)
216		memset_io(info->screen_base, 0, info->screen_size);
217
218	/* Use default scratch pixmap (info->pixmap.flags = FB_PIXMAP_SYSTEM) */
219
220	DRM_DEBUG_KMS("allocated %dx%d fb: 0x%08lx, bo %p\n",
221		      fb->width, fb->height,
222		      i915_gem_obj_ggtt_offset(obj), obj);
223
224	mutex_unlock(&dev->struct_mutex);
225	vga_switcheroo_client_fb_set(dev->pdev, info);
226	return 0;
227
 
 
228out_unpin:
229	i915_gem_object_ggtt_unpin(obj);
230	drm_gem_object_unreference(&obj->base);
231out_unlock:
232	mutex_unlock(&dev->struct_mutex);
233	return ret;
234}
235
236/** Sets the color ramps on behalf of RandR */
237static void intel_crtc_fb_gamma_set(struct drm_crtc *crtc, u16 red, u16 green,
238				    u16 blue, int regno)
239{
240	struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
241
242	intel_crtc->lut_r[regno] = red >> 8;
243	intel_crtc->lut_g[regno] = green >> 8;
244	intel_crtc->lut_b[regno] = blue >> 8;
245}
246
247static void intel_crtc_fb_gamma_get(struct drm_crtc *crtc, u16 *red, u16 *green,
248				    u16 *blue, int regno)
249{
250	struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
251
252	*red = intel_crtc->lut_r[regno] << 8;
253	*green = intel_crtc->lut_g[regno] << 8;
254	*blue = intel_crtc->lut_b[regno] << 8;
255}
256
257static struct drm_fb_helper_crtc *
258intel_fb_helper_crtc(struct drm_fb_helper *fb_helper, struct drm_crtc *crtc)
259{
260	int i;
261
262	for (i = 0; i < fb_helper->crtc_count; i++)
263		if (fb_helper->crtc_info[i].mode_set.crtc == crtc)
264			return &fb_helper->crtc_info[i];
265
266	return NULL;
267}
268
269/*
270 * Try to read the BIOS display configuration and use it for the initial
271 * fb configuration.
272 *
273 * The BIOS or boot loader will generally create an initial display
274 * configuration for us that includes some set of active pipes and displays.
275 * This routine tries to figure out which pipes and connectors are active
276 * and stuffs them into the crtcs and modes array given to us by the
277 * drm_fb_helper code.
278 *
279 * The overall sequence is:
280 *   intel_fbdev_init - from driver load
281 *     intel_fbdev_init_bios - initialize the intel_fbdev using BIOS data
282 *     drm_fb_helper_init - build fb helper structs
283 *     drm_fb_helper_single_add_all_connectors - more fb helper structs
284 *   intel_fbdev_initial_config - apply the config
285 *     drm_fb_helper_initial_config - call ->probe then register_framebuffer()
286 *         drm_setup_crtcs - build crtc config for fbdev
287 *           intel_fb_initial_config - find active connectors etc
288 *         drm_fb_helper_single_fb_probe - set up fbdev
289 *           intelfb_create - re-use or alloc fb, build out fbdev structs
290 *
291 * Note that we don't make special consideration whether we could actually
292 * switch to the selected modes without a full modeset. E.g. when the display
293 * is in VGA mode we need to recalculate watermarks and set a new high-res
294 * framebuffer anyway.
295 */
296static bool intel_fb_initial_config(struct drm_fb_helper *fb_helper,
297				    struct drm_fb_helper_crtc **crtcs,
298				    struct drm_display_mode **modes,
 
299				    bool *enabled, int width, int height)
300{
301	struct drm_device *dev = fb_helper->dev;
302	int i, j;
303	bool *save_enabled;
304	bool fallback = true;
305	int num_connectors_enabled = 0;
306	int num_connectors_detected = 0;
307
308	/*
309	 * If the user specified any force options, just bail here
310	 * and use that config.
311	 */
312	for (i = 0; i < fb_helper->connector_count; i++) {
313		struct drm_fb_helper_connector *fb_conn;
314		struct drm_connector *connector;
315
316		fb_conn = fb_helper->connector_info[i];
317		connector = fb_conn->connector;
318
319		if (!enabled[i])
320			continue;
321
322		if (connector->force != DRM_FORCE_UNSPECIFIED)
323			return false;
324	}
325
326	save_enabled = kcalloc(dev->mode_config.num_connector, sizeof(bool),
327			       GFP_KERNEL);
328	if (!save_enabled)
329		return false;
330
331	memcpy(save_enabled, enabled, dev->mode_config.num_connector);
332
 
333	for (i = 0; i < fb_helper->connector_count; i++) {
334		struct drm_fb_helper_connector *fb_conn;
335		struct drm_connector *connector;
336		struct drm_encoder *encoder;
337		struct drm_fb_helper_crtc *new_crtc;
338
339		fb_conn = fb_helper->connector_info[i];
340		connector = fb_conn->connector;
341
 
 
 
 
 
 
342		if (connector->status == connector_status_connected)
343			num_connectors_detected++;
344
345		if (!enabled[i]) {
346			DRM_DEBUG_KMS("connector %d not enabled, skipping\n",
347				      connector->base.id);
 
 
 
 
 
 
 
 
348			continue;
349		}
350
351		encoder = connector->encoder;
352		if (!encoder || WARN_ON(!encoder->crtc)) {
353			DRM_DEBUG_KMS("connector %d has no encoder or crtc, skipping\n",
354				      connector->base.id);
 
 
 
355			enabled[i] = false;
 
356			continue;
357		}
358
359		num_connectors_enabled++;
360
361		new_crtc = intel_fb_helper_crtc(fb_helper, encoder->crtc);
362
363		/*
364		 * Make sure we're not trying to drive multiple connectors
365		 * with a single CRTC, since our cloning support may not
366		 * match the BIOS.
367		 */
368		for (j = 0; j < fb_helper->connector_count; j++) {
369			if (crtcs[j] == new_crtc) {
370				DRM_DEBUG_KMS("fallback: cloned configuration\n");
371				fallback = true;
372				goto out;
373			}
374		}
375
376		DRM_DEBUG_KMS("looking for cmdline mode on connector %d\n",
377			      fb_conn->connector->base.id);
378
379		/* go for command line mode first */
380		modes[i] = drm_pick_cmdline_mode(fb_conn, width, height);
381
382		/* try for preferred next */
383		if (!modes[i]) {
384			DRM_DEBUG_KMS("looking for preferred mode on connector %d\n",
385				      fb_conn->connector->base.id);
386			modes[i] = drm_has_preferred_mode(fb_conn, width,
387							  height);
388		}
389
390		/* No preferred mode marked by the EDID? Are there any modes? */
391		if (!modes[i] && !list_empty(&connector->modes)) {
392			DRM_DEBUG_KMS("using first mode listed on connector %s\n",
393				      drm_get_connector_name(connector));
394			modes[i] = list_first_entry(&connector->modes,
395						    struct drm_display_mode,
396						    head);
397		}
398
399		/* last resort: use current mode */
400		if (!modes[i]) {
401			/*
402			 * IMPORTANT: We want to use the adjusted mode (i.e.
403			 * after the panel fitter upscaling) as the initial
404			 * config, not the input mode, which is what crtc->mode
405			 * usually contains. But since our current fastboot
406			 * code puts a mode derived from the post-pfit timings
407			 * into crtc->mode this works out correctly. We don't
408			 * use hwmode anywhere right now, so use it for this
409			 * since the fb helper layer wants a pointer to
410			 * something we own.
 
 
411			 */
412			intel_mode_from_pipe_config(&encoder->crtc->hwmode,
413						    &to_intel_crtc(encoder->crtc)->config);
414			modes[i] = &encoder->crtc->hwmode;
415		}
416		crtcs[i] = new_crtc;
417
418		DRM_DEBUG_KMS("connector %s on crtc %d: %s\n",
419			      drm_get_connector_name(connector),
420			      encoder->crtc->base.id,
421			      modes[i]->name);
 
 
422
423		fallback = false;
 
 
 
 
 
 
424	}
425
426	/*
427	 * If the BIOS didn't enable everything it could, fall back to have the
428	 * same user experiencing of lighting up as much as possible like the
429	 * fbdev helper library.
430	 */
431	if (num_connectors_enabled != num_connectors_detected &&
432	    num_connectors_enabled < INTEL_INFO(dev)->num_pipes) {
433		DRM_DEBUG_KMS("fallback: Not all outputs enabled\n");
434		DRM_DEBUG_KMS("Enabled: %i, detected: %i\n", num_connectors_enabled,
435			      num_connectors_detected);
436		fallback = true;
437	}
438
439out:
440	if (fallback) {
 
441		DRM_DEBUG_KMS("Not using firmware configuration\n");
442		memcpy(enabled, save_enabled, dev->mode_config.num_connector);
443		kfree(save_enabled);
444		return false;
445	}
446
447	kfree(save_enabled);
448	return true;
449}
450
451static struct drm_fb_helper_funcs intel_fb_helper_funcs = {
452	.initial_config = intel_fb_initial_config,
453	.gamma_set = intel_crtc_fb_gamma_set,
454	.gamma_get = intel_crtc_fb_gamma_get,
455	.fb_probe = intelfb_create,
456};
457
458static void intel_fbdev_destroy(struct drm_device *dev,
459				struct intel_fbdev *ifbdev)
460{
461	if (ifbdev->helper.fbdev) {
462		struct fb_info *info = ifbdev->helper.fbdev;
 
 
463
464		unregister_framebuffer(info);
465		iounmap(info->screen_base);
466		if (info->cmap.len)
467			fb_dealloc_cmap(&info->cmap);
468
469		framebuffer_release(info);
470	}
471
472	drm_fb_helper_fini(&ifbdev->helper);
473
474	drm_framebuffer_unregister_private(&ifbdev->fb->base);
475	drm_framebuffer_remove(&ifbdev->fb->base);
 
 
476}
477
478/*
479 * Build an intel_fbdev struct using a BIOS allocated framebuffer, if possible.
480 * The core display code will have read out the current plane configuration,
481 * so we use that to figure out if there's an object for us to use as the
482 * fb, and if so, we re-use it for the fbdev configuration.
483 *
484 * Note we only support a single fb shared across pipes for boot (mostly for
485 * fbcon), so we just find the biggest and use that.
486 */
487static bool intel_fbdev_init_bios(struct drm_device *dev,
488				 struct intel_fbdev *ifbdev)
489{
490	struct intel_framebuffer *fb = NULL;
491	struct drm_crtc *crtc;
492	struct intel_crtc *intel_crtc;
493	struct intel_plane_config *plane_config = NULL;
494	unsigned int max_size = 0;
495
496	if (!i915.fastboot)
497		return false;
498
499	/* Find the largest fb */
500	list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
 
 
501		intel_crtc = to_intel_crtc(crtc);
502
503		if (!intel_crtc->active || !crtc->primary->fb) {
504			DRM_DEBUG_KMS("pipe %c not active or no fb, skipping\n",
505				      pipe_name(intel_crtc->pipe));
506			continue;
507		}
508
509		if (intel_crtc->plane_config.size > max_size) {
510			DRM_DEBUG_KMS("found possible fb from plane %c\n",
511				      pipe_name(intel_crtc->pipe));
512			plane_config = &intel_crtc->plane_config;
513			fb = to_intel_framebuffer(crtc->primary->fb);
514			max_size = plane_config->size;
515		}
516	}
517
518	if (!fb) {
519		DRM_DEBUG_KMS("no active fbs found, not using BIOS config\n");
520		goto out;
521	}
522
523	/* Now make sure all the pipes will fit into it */
524	list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
525		unsigned int cur_size;
526
527		intel_crtc = to_intel_crtc(crtc);
528
529		if (!intel_crtc->active) {
530			DRM_DEBUG_KMS("pipe %c not active, skipping\n",
531				      pipe_name(intel_crtc->pipe));
532			continue;
533		}
534
535		DRM_DEBUG_KMS("checking plane %c for BIOS fb\n",
536			      pipe_name(intel_crtc->pipe));
537
538		/*
539		 * See if the plane fb we found above will fit on this
540		 * pipe.  Note we need to use the selected fb's pitch and bpp
541		 * rather than the current pipe's, since they differ.
542		 */
543		cur_size = intel_crtc->config.adjusted_mode.crtc_hdisplay;
544		cur_size = cur_size * fb->base.bits_per_pixel / 8;
545		if (fb->base.pitches[0] < cur_size) {
546			DRM_DEBUG_KMS("fb not wide enough for plane %c (%d vs %d)\n",
547				      pipe_name(intel_crtc->pipe),
548				      cur_size, fb->base.pitches[0]);
549			plane_config = NULL;
550			fb = NULL;
551			break;
552		}
553
554		cur_size = intel_crtc->config.adjusted_mode.crtc_vdisplay;
555		cur_size = ALIGN(cur_size, plane_config->tiled ? (IS_GEN2(dev) ? 16 : 8) : 1);
 
 
556		cur_size *= fb->base.pitches[0];
557		DRM_DEBUG_KMS("pipe %c area: %dx%d, bpp: %d, size: %d\n",
558			      pipe_name(intel_crtc->pipe),
559			      intel_crtc->config.adjusted_mode.crtc_hdisplay,
560			      intel_crtc->config.adjusted_mode.crtc_vdisplay,
561			      fb->base.bits_per_pixel,
562			      cur_size);
563
564		if (cur_size > max_size) {
565			DRM_DEBUG_KMS("fb not big enough for plane %c (%d vs %d)\n",
566				      pipe_name(intel_crtc->pipe),
567				      cur_size, max_size);
568			plane_config = NULL;
569			fb = NULL;
570			break;
571		}
572
573		DRM_DEBUG_KMS("fb big enough for plane %c (%d >= %d)\n",
574			      pipe_name(intel_crtc->pipe),
575			      max_size, cur_size);
576	}
577
578	if (!fb) {
579		DRM_DEBUG_KMS("BIOS fb not suitable for all pipes, not using\n");
580		goto out;
581	}
582
583	ifbdev->preferred_bpp = fb->base.bits_per_pixel;
584	ifbdev->fb = fb;
585
586	drm_framebuffer_reference(&ifbdev->fb->base);
587
588	/* Final pass to check if any active pipes don't have fbs */
589	list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
590		intel_crtc = to_intel_crtc(crtc);
591
592		if (!intel_crtc->active)
593			continue;
594
595		WARN(!crtc->primary->fb,
596		     "re-used BIOS config but lost an fb on crtc %d\n",
597		     crtc->base.id);
598	}
599
600
601	DRM_DEBUG_KMS("using BIOS fb for initial console\n");
602	return true;
603
604out:
605
606	return false;
607}
608
 
 
 
 
 
 
 
 
 
609int intel_fbdev_init(struct drm_device *dev)
610{
611	struct intel_fbdev *ifbdev;
612	struct drm_i915_private *dev_priv = dev->dev_private;
613	int ret;
614
615	if (WARN_ON(INTEL_INFO(dev)->num_pipes == 0))
616		return -ENODEV;
617
618	ifbdev = kzalloc(sizeof(struct intel_fbdev), GFP_KERNEL);
619	if (ifbdev == NULL)
620		return -ENOMEM;
621
622	ifbdev->helper.funcs = &intel_fb_helper_funcs;
 
623	if (!intel_fbdev_init_bios(dev, ifbdev))
624		ifbdev->preferred_bpp = 32;
625
626	ret = drm_fb_helper_init(dev, &ifbdev->helper,
627				 INTEL_INFO(dev)->num_pipes, 4);
628	if (ret) {
629		kfree(ifbdev);
630		return ret;
631	}
632
 
 
633	dev_priv->fbdev = ifbdev;
 
 
634	drm_fb_helper_single_add_all_connectors(&ifbdev->helper);
635
636	return 0;
637}
638
639void intel_fbdev_initial_config(struct drm_device *dev)
640{
641	struct drm_i915_private *dev_priv = dev->dev_private;
642	struct intel_fbdev *ifbdev = dev_priv->fbdev;
643
644	/* Due to peculiar init order wrt to hpd handling this is separate. */
645	drm_fb_helper_initial_config(&ifbdev->helper, ifbdev->preferred_bpp);
 
 
 
 
 
 
 
646}
647
648void intel_fbdev_fini(struct drm_device *dev)
649{
650	struct drm_i915_private *dev_priv = dev->dev_private;
651	if (!dev_priv->fbdev)
652		return;
653
 
 
 
 
654	intel_fbdev_destroy(dev, dev_priv->fbdev);
655	kfree(dev_priv->fbdev);
656	dev_priv->fbdev = NULL;
657}
658
659void intel_fbdev_set_suspend(struct drm_device *dev, int state)
660{
661	struct drm_i915_private *dev_priv = dev->dev_private;
662	struct intel_fbdev *ifbdev = dev_priv->fbdev;
663	struct fb_info *info;
664
665	if (!ifbdev)
666		return;
667
668	info = ifbdev->helper.fbdev;
669
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
670	/* On resume from hibernation: If the object is shmemfs backed, it has
671	 * been restored from swap. If the object is stolen however, it will be
672	 * full of whatever garbage was left in there.
673	 */
674	if (state == FBINFO_STATE_RUNNING && ifbdev->fb->obj->stolen)
675		memset_io(info->screen_base, 0, info->screen_size);
676
677	fb_set_suspend(info, state);
 
678}
679
680void intel_fbdev_output_poll_changed(struct drm_device *dev)
681{
682	struct drm_i915_private *dev_priv = dev->dev_private;
683	if (dev_priv->fbdev)
684		drm_fb_helper_hotplug_event(&dev_priv->fbdev->helper);
685}
686
687void intel_fbdev_restore_mode(struct drm_device *dev)
688{
689	int ret;
690	struct drm_i915_private *dev_priv = dev->dev_private;
 
 
691
692	if (!dev_priv->fbdev)
693		return;
694
695	drm_modeset_lock_all(dev);
696
697	ret = drm_fb_helper_restore_fbdev_mode(&dev_priv->fbdev->helper);
698	if (ret)
699		DRM_DEBUG("failed to restore crtc mode\n");
700
701	drm_modeset_unlock_all(dev);
 
 
 
702}