587 lines · 16.0 KB · C
RawDownload
/* * Copyright © 2007 David Airlie * * Permission is hereby granted, free of charge, to any person obtaining a * copy of this software and associated documentation files (the "Software"), * to deal in the Software without restriction, including without limitation * the rights to use, copy, modify, merge, publish, distribute, sublicense, * and/or sell copies of the Software, and to permit persons to whom the * Software is furnished to do so, subject to the following conditions: * * The above copyright notice and this permission notice (including the next * paragraph) shall be included in all copies or substantial portions of the * Software. * * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER * DEALINGS IN THE SOFTWARE. * * Authors: *     David Airlie */ #include <linux/console.h>#include <linux/delay.h>#include <linux/errno.h>#include <linux/fb.h>#include <linux/init.h>#include <linux/kernel.h>#include <linux/mm.h>#include <linux/module.h>#include <linux/string.h>#include <linux/sysrq.h>#include <linux/tty.h>#include <linux/vga_switcheroo.h> #include <drm/clients/drm_client_setup.h>#include <drm/intel/display_parent_interface.h>#include <drm/drm_crtc.h>#include <drm/drm_crtc_helper.h>#include <drm/drm_fb_helper.h>#include <drm/drm_fourcc.h>#include <drm/drm_gem.h>#include <drm/drm_gem_framebuffer_helper.h>#include <drm/drm_managed.h>#include <drm/drm_print.h> #include "intel_bo.h"#include "intel_display_core.h"#include "intel_display_rpm.h"#include "intel_display_types.h"#include "intel_fb.h"#include "intel_fbdev.h"#include "intel_frontbuffer.h"#include "intel_parent.h"#include "intel_plane.h" struct intel_fbdev {	struct intel_framebuffer *fb;	struct i915_vma *vma;}; static struct intel_fbdev *to_intel_fbdev(struct drm_fb_helper *fb_helper){	struct intel_display *display = to_intel_display(fb_helper->client.dev); 	return display->fbdev.fbdev;} static struct intel_frontbuffer *to_frontbuffer(struct intel_fbdev *ifbdev){	return ifbdev->fb->frontbuffer;} static void intel_fbdev_invalidate(struct intel_fbdev *ifbdev){	intel_frontbuffer_invalidate(to_frontbuffer(ifbdev), ORIGIN_CPU);} FB_GEN_DEFAULT_DEFERRED_IOMEM_OPS(intel_fbdev,				  drm_fb_helper_damage_range,				  drm_fb_helper_damage_area) static int intel_fbdev_set_par(struct fb_info *info){	struct intel_fbdev *ifbdev = to_intel_fbdev(info->par);	int ret; 	ret = drm_fb_helper_set_par(info);	if (ret == 0)		intel_fbdev_invalidate(ifbdev); 	return ret;} static int intel_fbdev_blank(int blank, struct fb_info *info){	struct intel_fbdev *ifbdev = to_intel_fbdev(info->par);	int ret; 	ret = drm_fb_helper_blank(blank, info);	if (ret == 0)		intel_fbdev_invalidate(ifbdev); 	return ret;} static int intel_fbdev_pan_display(struct fb_var_screeninfo *var,				   struct fb_info *info){	struct intel_fbdev *ifbdev = to_intel_fbdev(info->par);	int ret; 	ret = drm_fb_helper_pan_display(var, info);	if (ret == 0)		intel_fbdev_invalidate(ifbdev); 	return ret;} static int intel_fbdev_mmap(struct fb_info *info, struct vm_area_struct *vma){	struct drm_fb_helper *fb_helper = info->par;	struct drm_gem_object *obj = drm_gem_fb_get_obj(fb_helper->fb, 0); 	return intel_bo_fb_mmap(obj, vma);} static void intel_fbdev_fb_destroy(struct fb_info *info){	struct drm_fb_helper *fb_helper = info->par;	struct intel_display *display = to_intel_display(fb_helper->client.dev);	struct intel_fbdev *ifbdev = to_intel_fbdev(fb_helper); 	drm_fb_helper_fini(fb_helper); 	/*	 * We rely on the object-free to release the VMA pinning for	 * the info->screen_base mmaping. Leaking the VMA is simpler than	 * trying to rectify all the possible error paths leading here.	 */	intel_parent_fb_pin_ggtt_unpin(display, ifbdev->vma, -1);	drm_framebuffer_remove(fb_helper->fb); 	drm_client_release(&fb_helper->client);} __diag_push();__diag_ignore_all("-Woverride-init", "Allow field initialization overrides for fb ops"); static const struct fb_ops intelfb_ops = {	.owner = THIS_MODULE,	__FB_DEFAULT_DEFERRED_OPS_RDWR(intel_fbdev),	DRM_FB_HELPER_DEFAULT_OPS,	.fb_set_par = intel_fbdev_set_par,	.fb_blank = intel_fbdev_blank,	.fb_pan_display = intel_fbdev_pan_display,	__FB_DEFAULT_DEFERRED_OPS_DRAW(intel_fbdev),	.fb_mmap = intel_fbdev_mmap,	.fb_destroy = intel_fbdev_fb_destroy,}; __diag_pop(); static int intelfb_dirty(struct drm_fb_helper *helper, struct drm_clip_rect *clip){	if (!(clip->x1 < clip->x2 && clip->y1 < clip->y2))		return 0; 	if (helper->fb->funcs->dirty)		return helper->fb->funcs->dirty(helper->fb, NULL, 0, 0, clip, 1); 	return 0;} static void intelfb_restore(struct drm_fb_helper *fb_helper){	struct intel_fbdev *ifbdev = to_intel_fbdev(fb_helper); 	intel_fbdev_invalidate(ifbdev);} static void intelfb_set_suspend(struct drm_fb_helper *fb_helper, bool suspend){	struct fb_info *info = fb_helper->info; 	/*	 * When resuming from hibernation, Linux restores the object's	 * content from swap if the buffer is backed by shmemfs. If the	 * object is stolen however, it will be full of whatever garbage	 * was left in there. Clear it to zero in this case.	 */	if (!suspend && !intel_bo_is_shmem(intel_fb_bo(fb_helper->fb)))		memset_io(info->screen_base, 0, info->screen_size); 	fb_set_suspend(info, suspend);} static const struct drm_fb_helper_funcs intel_fb_helper_funcs = {	.fb_dirty = intelfb_dirty,	.fb_restore = intelfb_restore,	.fb_set_suspend = intelfb_set_suspend,}; static void intel_fbdev_fill_mode_cmd(struct intel_display *display,				      struct drm_fb_helper_surface_size *sizes,				      struct drm_mode_fb_cmd2 *mode_cmd){	/* we don't do packed 24bpp */	if (sizes->surface_bpp == 24)		sizes->surface_bpp = 32; 	mode_cmd->flags = DRM_MODE_FB_MODIFIERS;	mode_cmd->width = sizes->surface_width;	mode_cmd->height = sizes->surface_height; 	mode_cmd->pitches[0] = intel_bo_fbdev_pitch_align(display, mode_cmd->width * DIV_ROUND_UP(sizes->surface_bpp, 8));	mode_cmd->pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp,							   sizes->surface_depth);	mode_cmd->modifier[0] = DRM_FORMAT_MOD_LINEAR;} static struct intel_framebuffer *__intel_fbdev_fb_alloc(struct intel_display *display,		       struct drm_fb_helper_surface_size *sizes){	struct drm_mode_fb_cmd2 mode_cmd = {};	struct drm_framebuffer *fb;	struct drm_gem_object *obj;	int size; 	intel_fbdev_fill_mode_cmd(display, sizes, &mode_cmd); 	size = mode_cmd.pitches[0] * mode_cmd.height;	size = PAGE_ALIGN(size); 	obj = intel_bo_fbdev_create(display, size);	if (IS_ERR(obj)) {		fb = ERR_CAST(obj);		goto err;	} 	fb = intel_framebuffer_create(obj,				      drm_get_format_info(display->drm,							  mode_cmd.pixel_format,							  mode_cmd.modifier[0]),				      &mode_cmd);	if (IS_ERR(fb)) {		intel_bo_fbdev_destroy(obj);		goto err;	} 	drm_gem_object_put(obj); 	return to_intel_framebuffer(fb); err:	return ERR_CAST(fb); } static bool bios_fb_ok(const struct intel_framebuffer *fb,		       const struct drm_fb_helper_surface_size *sizes){	struct intel_display *display = to_intel_display(fb->base.dev);	int width = fb->base.width;	int height = fb->base.height;	int depth = fb->base.format->depth;	int bpp = fb->base.format->cpp[0] * 8; 	if (sizes->fb_width > width || sizes->fb_height > height) {		drm_dbg_kms(display->drm,			    "BIOS fb too small (%dx%d), we require (%dx%d), releasing it\n",			    width, height, sizes->fb_width, sizes->fb_height);		return false;	} 	if (sizes->surface_depth != depth || sizes->surface_bpp != bpp) {		drm_dbg_kms(display->drm,			    "BIOS fb using wrong depth/bpp (%d/%d), we require (%d/%d), releasing it\n",			    depth, bpp, sizes->surface_depth, sizes->surface_bpp);		return false;	} 	return true;} int intel_fbdev_driver_fbdev_probe(struct drm_fb_helper *helper,				   struct drm_fb_helper_surface_size *sizes){	struct intel_display *display = to_intel_display(helper->dev);	struct intel_fbdev *ifbdev = to_intel_fbdev(helper);	struct intel_fb_pin_params pin_params = {};	struct intel_framebuffer *fb = ifbdev->fb;	struct fb_info *info = helper->info;	struct ref_tracker *wakeref;	struct i915_vma *vma;	bool prealloc = false;	struct drm_gem_object *obj;	u32 offset;	int ret; 	ifbdev->fb = NULL; 	if (fb && !bios_fb_ok(fb, sizes)) {		drm_framebuffer_put(&fb->base);		fb = NULL;	} 	wakeref = intel_display_rpm_get(display); 	if (!fb || drm_WARN_ON(display->drm, !intel_fb_bo(&fb->base))) {		drm_dbg_kms(display->drm,			    "no BIOS fb, allocating a new one\n"); 		fb = __intel_fbdev_fb_alloc(display, sizes);		if (IS_ERR(fb)) {			ret = PTR_ERR(fb);			goto out_unlock;		}	} else {		drm_dbg_kms(display->drm, "re-using BIOS fb\n");		prealloc = true;		sizes->fb_width = fb->base.width;		sizes->fb_height = fb->base.height;	} 	obj = intel_fb_bo(&fb->base); 	/* Pin the GGTT vma for our access via info->screen_base.	 * This also validates that any existing fb inherited from the	 * BIOS is suitable for own access.	 */	pin_params.view = &fb->normal_view.gtt;	pin_params.alignment = fb->min_alignment;	pin_params.vtd_guard = intel_fb_view_vtd_guard(&fb->base,						       &fb->normal_view,						       DRM_MODE_ROTATE_0);	pin_params.needs_low_address = intel_plane_needs_low_address(display); 	ret = intel_parent_fb_pin_ggtt_pin(display, obj, &pin_params,					   &vma, &offset, NULL);	if (ret)		goto out_unlock; 	helper->funcs = &intel_fb_helper_funcs;	helper->fb = &fb->base; 	info->fbops = &intelfb_ops; 	ret = intel_bo_fbdev_fill_info(obj, info, vma);	if (ret)		goto out_unpin; 	drm_fb_helper_fill_info(info, display->drm->fb_helper, sizes); 	/* If the object is shmemfs backed, it will have given us zeroed pages.	 * If the object is stolen however, it will be full of whatever	 * garbage was left in there.	 */	if (!intel_bo_is_shmem(obj) && !prealloc)		memset_io(info->screen_base, 0, info->screen_size); 	/* Use default scratch pixmap (info->pixmap.flags = FB_PIXMAP_SYSTEM) */ 	drm_dbg_kms(display->drm, "allocated %dx%d fb\n", fb->base.width, fb->base.height);	ifbdev->fb = fb;	ifbdev->vma = vma; 	intel_display_rpm_put(display, wakeref); 	return 0; out_unpin:	intel_parent_fb_pin_ggtt_unpin(display, vma, -1);out_unlock:	intel_display_rpm_put(display, wakeref); 	return ret;} /* * Build an intel_fbdev struct using a BIOS allocated framebuffer, if possible. * The core display code will have read out the current plane configuration, * so we use that to figure out if there's an object for us to use as the * fb, and if so, we re-use it for the fbdev configuration. * * Note we only support a single fb shared across pipes for boot (mostly for * fbcon), so we just find the biggest and use that. */static bool intel_fbdev_init_bios(struct intel_display *display,				  struct intel_fbdev *ifbdev){	struct intel_framebuffer *fb = NULL;	struct intel_crtc *crtc;	unsigned int max_size = 0; 	/* Find the largest fb */	for_each_intel_crtc(display, crtc) {		struct intel_crtc_state *crtc_state =			to_intel_crtc_state(crtc->base.state);		struct intel_plane *plane =			to_intel_plane(crtc->base.primary);		struct intel_plane_state *plane_state =			to_intel_plane_state(plane->base.state);		struct drm_gem_object *obj = intel_fb_bo(plane_state->uapi.fb); 		if (!crtc_state->uapi.active) {			drm_dbg_kms(display->drm,				    "[CRTC:%d:%s] not active, skipping\n",				    crtc->base.base.id, crtc->base.name);			continue;		} 		if (!obj) {			drm_dbg_kms(display->drm,				    "[PLANE:%d:%s] no fb, skipping\n",				    plane->base.base.id, plane->base.name);			continue;		} 		if (obj->size > max_size) {			drm_dbg_kms(display->drm,				    "found possible fb from [PLANE:%d:%s]\n",				    plane->base.base.id, plane->base.name);			fb = to_intel_framebuffer(plane_state->uapi.fb);			max_size = obj->size;		}	} 	if (!fb) {		drm_dbg_kms(display->drm,			    "no active fbs found, not using BIOS config\n");		goto out;	} 	/* Now make sure all the pipes will fit into it */	for_each_intel_crtc(display, crtc) {		struct intel_crtc_state *crtc_state =			to_intel_crtc_state(crtc->base.state);		struct intel_plane *plane =			to_intel_plane(crtc->base.primary);		unsigned int cur_size; 		if (!crtc_state->uapi.active) {			drm_dbg_kms(display->drm,				    "[CRTC:%d:%s] not active, skipping\n",				    crtc->base.base.id, crtc->base.name);			continue;		} 		drm_dbg_kms(display->drm, "checking [PLANE:%d:%s] for BIOS fb\n",			    plane->base.base.id, plane->base.name); 		/*		 * See if the plane fb we found above will fit on this		 * pipe.  Note we need to use the selected fb's pitch and bpp		 * rather than the current pipe's, since they differ.		 */		cur_size = crtc_state->uapi.adjusted_mode.crtc_hdisplay;		cur_size = cur_size * fb->base.format->cpp[0];		if (fb->base.pitches[0] < cur_size) {			drm_dbg_kms(display->drm,				    "fb not wide enough for [PLANE:%d:%s] (%d vs %d)\n",				    plane->base.base.id, plane->base.name,				    cur_size, fb->base.pitches[0]);			fb = NULL;			break;		} 		cur_size = crtc_state->uapi.adjusted_mode.crtc_vdisplay;		cur_size = intel_fb_align_height(&fb->base, 0, cur_size);		cur_size *= fb->base.pitches[0];		drm_dbg_kms(display->drm,			    "[CRTC:%d:%s] area: %dx%d, bpp: %d, size: %d\n",			    crtc->base.base.id, crtc->base.name,			    crtc_state->uapi.adjusted_mode.crtc_hdisplay,			    crtc_state->uapi.adjusted_mode.crtc_vdisplay,			    fb->base.format->cpp[0] * 8,			    cur_size); 		if (cur_size > max_size) {			drm_dbg_kms(display->drm,				    "fb not big enough for [PLANE:%d:%s] (%d vs %d)\n",				    plane->base.base.id, plane->base.name,				    cur_size, max_size);			fb = NULL;			break;		} 		drm_dbg_kms(display->drm,			    "fb big enough [PLANE:%d:%s] (%d >= %d)\n",			    plane->base.base.id, plane->base.name,			    max_size, cur_size);	} 	if (!fb) {

Lines 1–500 of 587.