WebSVN – Kolibri OS – Diff – /drivers/video/drm/i915/intel_fbdev.c


﻿/*
 * 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 
#include 
#include 
#include 
#include 
#include 
//#include 
#include 
#include 
#include 
#include 
//#include 
 
#include 
#include 
#include 
#include "intel_drv.h"
#include 
#include "i915_drv.h"
 
struct fb_info *framebuffer_alloc(size_t size, struct device *dev)
{
#define BYTES_PER_LONG (BITS_PER_LONG/8)
#define PADDING (BYTES_PER_LONG - (sizeof(struct fb_info) % BYTES_PER_LONG))
    int fb_info_size = sizeof(struct fb_info);
    struct fb_info *info;
    char *p;
 
    if (size)
        fb_info_size += PADDING;
 
    p = kzalloc(fb_info_size + size, GFP_KERNEL);
 
    if (!p)
        return NULL;
 
    info = (struct fb_info *) p;
 
    if (size)
        info->par = p + fb_info_size;
 
    return info;
#undef PADDING
#undef BYTES_PER_LONG
}
 
static int intel_fbdev_set_par(struct fb_info *info)
{
	struct drm_fb_helper *fb_helper = info->par;
	struct intel_fbdev *ifbdev =
		container_of(fb_helper, struct intel_fbdev, helper);
	int ret;
 
	ret = drm_fb_helper_set_par(info);
 
	if (ret == 0) {
		mutex_lock(&fb_helper->dev->struct_mutex);
		intel_fb_obj_invalidate(ifbdev->fb->obj, ORIGIN_GTT);
		mutex_unlock(&fb_helper->dev->struct_mutex);
	}
 
	return ret;
}
 
static int intel_fbdev_blank(int blank, struct fb_info *info)
{
	struct drm_fb_helper *fb_helper = info->par;
	struct intel_fbdev *ifbdev =
		container_of(fb_helper, struct intel_fbdev, helper);
	int ret;
 
	ret = drm_fb_helper_blank(blank, info);
 
	if (ret == 0) {
		mutex_lock(&fb_helper->dev->struct_mutex);
		intel_fb_obj_invalidate(ifbdev->fb->obj, ORIGIN_GTT);
		mutex_unlock(&fb_helper->dev->struct_mutex);
	}
 
	return ret;
}
 
static int intel_fbdev_pan_display(struct fb_var_screeninfo *var,
				   struct fb_info *info)
{
	struct drm_fb_helper *fb_helper = info->par;
	struct intel_fbdev *ifbdev =
		container_of(fb_helper, struct intel_fbdev, helper);
 
	int ret;
	ret = drm_fb_helper_pan_display(var, info);
 
	if (ret == 0) {
		mutex_lock(&fb_helper->dev->struct_mutex);
		intel_fb_obj_invalidate(ifbdev->fb->obj, ORIGIN_GTT);
		mutex_unlock(&fb_helper->dev->struct_mutex);
	}
 
	return ret;
}
 
static struct fb_ops intelfb_ops = {
	.owner = THIS_MODULE,
	.fb_check_var = drm_fb_helper_check_var,
	.fb_set_par = intel_fbdev_set_par,
//   .fb_fillrect = cfb_fillrect,
//   .fb_copyarea = cfb_copyarea,
//   .fb_imageblit = cfb_imageblit,
	.fb_pan_display = intel_fbdev_pan_display,
	.fb_blank = intel_fbdev_blank,
//   .fb_setcmap = drm_fb_helper_setcmap,
//   .fb_debug_enter = drm_fb_helper_debug_enter,
//   .fb_debug_leave = drm_fb_helper_debug_leave,
};
 
static int intelfb_alloc(struct drm_fb_helper *helper,
			 struct drm_fb_helper_surface_size *sizes)
{
	struct intel_fbdev *ifbdev =
		container_of(helper, struct intel_fbdev, helper);
	struct drm_framebuffer *fb;
	struct drm_device *dev = helper->dev;
	struct drm_i915_private *dev_priv = to_i915(dev);
	struct drm_mode_fb_cmd2 mode_cmd = {};
	struct drm_i915_gem_object *obj = NULL;
	int size, ret;
 
	/* we don't do packed 24bpp */
	if (sizes->surface_bpp == 24)
		sizes->surface_bpp = 32;
 
	mode_cmd.width = sizes->surface_width;
	mode_cmd.height = sizes->surface_height;
 
	mode_cmd.pitches[0] = ALIGN(mode_cmd.width *
				    DIV_ROUND_UP(sizes->surface_bpp, 8), 64);
	mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp,
							  sizes->surface_depth);
 
	size = mode_cmd.pitches[0] * mode_cmd.height;
	size = PAGE_ALIGN(size);
	obj = main_fb_obj;
	obj->map_and_fenceable=true;
	if (!obj) {
		DRM_ERROR("failed to allocate framebuffer\n");
		ret = -ENOMEM;
		goto out;
	}
 
	fb = __intel_framebuffer_create(dev, &mode_cmd, obj);
	if (IS_ERR(fb)) {
		ret = PTR_ERR(fb);
		goto out_unref;
	}
 
	/* Flush everything out, we'll be doing GTT only from now on */
	ret = intel_pin_and_fence_fb_obj(NULL, fb, NULL, NULL, NULL);
	if (ret) {
		DRM_ERROR("failed to pin obj: %d\n", ret);
		goto out_fb;
	}
 
	ifbdev->fb = to_intel_framebuffer(fb);
 
	return 0;
 
out_fb:
	drm_framebuffer_remove(fb);
out_unref:
	drm_gem_object_unreference(&obj->base);
out:
	return ret;
}
 
static int intelfb_create(struct drm_fb_helper *helper,
			  struct drm_fb_helper_surface_size *sizes)
{
	struct intel_fbdev *ifbdev =
		container_of(helper, struct intel_fbdev, helper);
	struct intel_framebuffer *intel_fb = ifbdev->fb;
	struct drm_device *dev = helper->dev;
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct fb_info *info;
	struct drm_framebuffer *fb;
	struct drm_i915_gem_object *obj;
	int size, ret;
	bool prealloc = false;
 
	mutex_lock(&dev->struct_mutex);
 
#if 0
	if (intel_fb &&
	    (sizes->fb_width > intel_fb->base.width ||
	     sizes->fb_height > intel_fb->base.height)) {
		DRM_DEBUG_KMS("BIOS fb too small (%dx%d), we require (%dx%d),"
			      " releasing it\n",
			      intel_fb->base.width, intel_fb->base.height,
			      sizes->fb_width, sizes->fb_height);
		drm_framebuffer_unreference(&intel_fb->base);
		intel_fb = ifbdev->fb = NULL;
	}
#endif
 
	if (!intel_fb || WARN_ON(!intel_fb->obj)) {
		DRM_DEBUG_KMS("no BIOS fb, allocating a new one\n");
		ret = intelfb_alloc(helper, sizes);
		if (ret)
			goto out_unlock;
		intel_fb = ifbdev->fb;
	} else {
		DRM_DEBUG_KMS("re-using BIOS fb\n");
		prealloc = true;
		sizes->fb_width = intel_fb->base.width;
		sizes->fb_height = intel_fb->base.height;
	}
 
	obj = intel_fb->obj;
	size = obj->base.size;
 
	info = drm_fb_helper_alloc_fbi(helper);
	if (IS_ERR(info)) {
		ret = PTR_ERR(info);
		goto out_unpin;
	}
 
	info->par = helper;
 
	fb = &ifbdev->fb->base;
 
    if(main_framebuffer == NULL)
        main_framebuffer = fb;
 
	ifbdev->helper.fb = fb;
 
	strcpy(info->fix.id, "inteldrmfb");
 
	info->flags = FBINFO_DEFAULT | FBINFO_CAN_FORCE_OUTPUT;
	info->fbops = &intelfb_ops;
 
	/* setup aperture base/size for vesafb takeover */
	info->apertures->ranges[0].base = dev->mode_config.fb_base;
	info->apertures->ranges[0].size = dev_priv->gtt.mappable_end;
 
 
	info->screen_base = (void*) 0xFE000000;
	info->screen_size = size;
 
	/* This driver doesn't need a VT switch to restore the mode on resume */
	info->skip_vt_switch = true;
 
	drm_fb_helper_fill_fix(info, fb->pitches[0], fb->depth);
	drm_fb_helper_fill_var(info, &ifbdev->helper, sizes->fb_width, sizes->fb_height);
 
	/* Use default scratch pixmap (info->pixmap.flags = FB_PIXMAP_SYSTEM) */
 
	DRM_DEBUG_KMS("allocated %dx%d fb: 0x%08llx, bo %p\n",
		      fb->width, fb->height,
		      i915_gem_obj_ggtt_offset(obj), obj);
 
	mutex_unlock(&dev->struct_mutex);
	return 0;
 
out_destroy_fbi:
	drm_fb_helper_release_fbi(helper);
out_unpin:
	i915_gem_object_ggtt_unpin(obj);
	drm_gem_object_unreference(&obj->base);
out_unlock:
	mutex_unlock(&dev->struct_mutex);
	return ret;
}
 
/** Sets the color ramps on behalf of RandR */
static void intel_crtc_fb_gamma_set(struct drm_crtc *crtc, u16 red, u16 green,
				    u16 blue, int regno)
{
	struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
 
	intel_crtc->lut_r[regno] = red >> 8;
	intel_crtc->lut_g[regno] = green >> 8;
	intel_crtc->lut_b[regno] = blue >> 8;
}
 
static void intel_crtc_fb_gamma_get(struct drm_crtc *crtc, u16 *red, u16 *green,
				    u16 *blue, int regno)
{
	struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
 
	*red = intel_crtc->lut_r[regno] << 8;
	*green = intel_crtc->lut_g[regno] << 8;
	*blue = intel_crtc->lut_b[regno] << 8;
}
 
static struct drm_fb_helper_crtc *
intel_fb_helper_crtc(struct drm_fb_helper *fb_helper, struct drm_crtc *crtc)
{
	int i;
 
	for (i = 0; i < fb_helper->crtc_count; i++)
		if (fb_helper->crtc_info[i].mode_set.crtc == crtc)
			return &fb_helper->crtc_info[i];
 
	return NULL;
}
 
/*
 * Try to read the BIOS display configuration and use it for the initial
 * fb configuration.
 *
 * The BIOS or boot loader will generally create an initial display
 * configuration for us that includes some set of active pipes and displays.
 * This routine tries to figure out which pipes and connectors are active
 * and stuffs them into the crtcs and modes array given to us by the
 * drm_fb_helper code.
 *
 * The overall sequence is:
 *   intel_fbdev_init - from driver load
 *     intel_fbdev_init_bios - initialize the intel_fbdev using BIOS data
 *     drm_fb_helper_init - build fb helper structs
 *     drm_fb_helper_single_add_all_connectors - more fb helper structs
 *   intel_fbdev_initial_config - apply the config
 *     drm_fb_helper_initial_config - call ->probe then register_framebuffer()
 *         drm_setup_crtcs - build crtc config for fbdev
 *           intel_fb_initial_config - find active connectors etc
 *         drm_fb_helper_single_fb_probe - set up fbdev
 *           intelfb_create - re-use or alloc fb, build out fbdev structs
 *
 * Note that we don't make special consideration whether we could actually
 * switch to the selected modes without a full modeset. E.g. when the display
 * is in VGA mode we need to recalculate watermarks and set a new high-res
 * framebuffer anyway.
 */
static bool intel_fb_initial_config(struct drm_fb_helper *fb_helper,
				    struct drm_fb_helper_crtc **crtcs,
				    struct drm_display_mode **modes,
				    struct drm_fb_offset *offsets,
				    bool *enabled, int width, int height)
{
	struct drm_device *dev = fb_helper->dev;
	int i, j;
	bool *save_enabled;
	bool fallback = true;
	int num_connectors_enabled = 0;
	int num_connectors_detected = 0;
	uint64_t conn_configured = 0, mask;
	int pass = 0;
 
	save_enabled = kcalloc(dev->mode_config.num_connector, sizeof(bool),
			       GFP_KERNEL);
	if (!save_enabled)
		return false;
 
	memcpy(save_enabled, enabled, dev->mode_config.num_connector);
	mask = (1 << fb_helper->connector_count) - 1;
retry:
	for (i = 0; i < fb_helper->connector_count; i++) {
		struct drm_fb_helper_connector *fb_conn;
		struct drm_connector *connector;
		struct drm_encoder *encoder;
		struct drm_fb_helper_crtc *new_crtc;
 
		fb_conn = fb_helper->connector_info[i];
		connector = fb_conn->connector;
 
		if (conn_configured & (1 << i))
			continue;
 
		if (pass == 0 && !connector->has_tile)
			continue;
 
		if (connector->status == connector_status_connected)
			num_connectors_detected++;
 
		if (!enabled[i]) {
			DRM_DEBUG_KMS("connector %s not enabled, skipping\n",
				      connector->name);
			conn_configured |= (1 << i);
			continue;
		}
 
		if (connector->force == DRM_FORCE_OFF) {
			DRM_DEBUG_KMS("connector %s is disabled by user, skipping\n",
				      connector->name);
			enabled[i] = false;
			continue;
		}
 
		encoder = connector->encoder;
		if (!encoder || WARN_ON(!encoder->crtc)) {
			if (connector->force > DRM_FORCE_OFF)
				goto bail;
 
			DRM_DEBUG_KMS("connector %s has no encoder or crtc, skipping\n",
				      connector->name);
			enabled[i] = false;
			conn_configured |= (1 << i);
			continue;
		}
 
		num_connectors_enabled++;
 
		new_crtc = intel_fb_helper_crtc(fb_helper, encoder->crtc);
 
		/*
		 * Make sure we're not trying to drive multiple connectors
		 * with a single CRTC, since our cloning support may not
		 * match the BIOS.
		 */
		for (j = 0; j < fb_helper->connector_count; j++) {
			if (crtcs[j] == new_crtc) {
				DRM_DEBUG_KMS("fallback: cloned configuration\n");
				goto bail;
			}
		}
 
		DRM_DEBUG_KMS("looking for cmdline mode on connector %s\n",
			      connector->name);
 
		/* go for command line mode first */
		modes[i] = drm_pick_cmdline_mode(fb_conn, width, height);
 
		/* try for preferred next */
		if (!modes[i]) {
			DRM_DEBUG_KMS("looking for preferred mode on connector %s %d\n",
				      connector->name, connector->has_tile);
			modes[i] = drm_has_preferred_mode(fb_conn, width,
							  height);
		}
 
		/* No preferred mode marked by the EDID? Are there any modes? */
		if (!modes[i] && !list_empty(&connector->modes)) {
			DRM_DEBUG_KMS("using first mode listed on connector %s\n",
				      connector->name);
			modes[i] = list_first_entry(&connector->modes,
						    struct drm_display_mode,
						    head);
		}
 
		/* last resort: use current mode */
		if (!modes[i]) {
			/*
			 * IMPORTANT: We want to use the adjusted mode (i.e.
			 * after the panel fitter upscaling) as the initial
			 * config, not the input mode, which is what crtc->mode
			 * usually contains. But since our current
			 * code puts a mode derived from the post-pfit timings
			 * into crtc->mode this works out correctly.
			 */
			DRM_DEBUG_KMS("looking for current mode on connector %s\n",
				      connector->name);
			modes[i] = &encoder->crtc->mode;
		}
		crtcs[i] = new_crtc;
 
		DRM_DEBUG_KMS("connector %s on pipe %c [CRTC:%d]: %dx%d%s\n",
			      connector->name,
			      pipe_name(to_intel_crtc(encoder->crtc)->pipe),
			      encoder->crtc->base.id,
			      modes[i]->hdisplay, modes[i]->vdisplay,
			      modes[i]->flags & DRM_MODE_FLAG_INTERLACE ? "i" :"");
 
		fallback = false;
		conn_configured |= (1 << i);
	}
 
	if ((conn_configured & mask) != mask) {
		pass++;
		goto retry;
	}
 
	/*
	 * If the BIOS didn't enable everything it could, fall back to have the
	 * same user experiencing of lighting up as much as possible like the
	 * fbdev helper library.
	 */
	if (num_connectors_enabled != num_connectors_detected &&
	    num_connectors_enabled < INTEL_INFO(dev)->num_pipes) {
		DRM_DEBUG_KMS("fallback: Not all outputs enabled\n");
		DRM_DEBUG_KMS("Enabled: %i, detected: %i\n", num_connectors_enabled,
			      num_connectors_detected);
		fallback = true;
	}
 
	if (fallback) {
bail:
		DRM_DEBUG_KMS("Not using firmware configuration\n");
		memcpy(enabled, save_enabled, dev->mode_config.num_connector);
		kfree(save_enabled);
		return false;
	}
 
	kfree(save_enabled);
	return true;
}
 
static const struct drm_fb_helper_funcs intel_fb_helper_funcs = {
	.initial_config = intel_fb_initial_config,
	.gamma_set = intel_crtc_fb_gamma_set,
	.gamma_get = intel_crtc_fb_gamma_get,
	.fb_probe = intelfb_create,
};
 
/*
 * 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 drm_device *dev,
				 struct intel_fbdev *ifbdev)
{
	struct intel_framebuffer *fb = NULL;
	struct drm_crtc *crtc;
	struct intel_crtc *intel_crtc;
	unsigned int max_size = 0;
 
	/* Find the largest fb */
	for_each_crtc(dev, crtc) {
		struct drm_i915_gem_object *obj =
			intel_fb_obj(crtc->primary->state->fb);
		intel_crtc = to_intel_crtc(crtc);
 
		if (!crtc->state->active || !obj) {
			DRM_DEBUG_KMS("pipe %c not active or no fb, skipping\n",
				      pipe_name(intel_crtc->pipe));
			continue;
		}
 
		if (obj->base.size > max_size) {
			DRM_DEBUG_KMS("found possible fb from plane %c\n",
				      pipe_name(intel_crtc->pipe));
			fb = to_intel_framebuffer(crtc->primary->state->fb);
			max_size = obj->base.size;
		}
	}
 
	if (!fb) {
		DRM_DEBUG_KMS("no active fbs found, not using BIOS config\n");
		goto out;
	}
 
	/* Now make sure all the pipes will fit into it */
	for_each_crtc(dev, crtc) {
		unsigned int cur_size;
 
		intel_crtc = to_intel_crtc(crtc);
 
		if (!crtc->state->active) {
			DRM_DEBUG_KMS("pipe %c not active, skipping\n",
				      pipe_name(intel_crtc->pipe));
			continue;
		}
 
		DRM_DEBUG_KMS("checking plane %c for BIOS fb\n",
			      pipe_name(intel_crtc->pipe));
 
		/*
		 * 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 = intel_crtc->config->base.adjusted_mode.crtc_hdisplay;
		cur_size = cur_size * fb->base.bits_per_pixel / 8;
		if (fb->base.pitches[0] < cur_size) {
			DRM_DEBUG_KMS("fb not wide enough for plane %c (%d vs %d)\n",
				      pipe_name(intel_crtc->pipe),
				      cur_size, fb->base.pitches[0]);
			fb = NULL;
			break;
		}
 
		cur_size = intel_crtc->config->base.adjusted_mode.crtc_vdisplay;
		cur_size = intel_fb_align_height(dev, cur_size,
						 fb->base.pixel_format,
						 fb->base.modifier[0]);
		cur_size *= fb->base.pitches[0];
		DRM_DEBUG_KMS("pipe %c area: %dx%d, bpp: %d, size: %d\n",
			      pipe_name(intel_crtc->pipe),
			      intel_crtc->config->base.adjusted_mode.crtc_hdisplay,
			      intel_crtc->config->base.adjusted_mode.crtc_vdisplay,
			      fb->base.bits_per_pixel,
			      cur_size);
 
		if (cur_size > max_size) {
			DRM_DEBUG_KMS("fb not big enough for plane %c (%d vs %d)\n",
				      pipe_name(intel_crtc->pipe),
				      cur_size, max_size);
			fb = NULL;
			break;
		}
 
		DRM_DEBUG_KMS("fb big enough for plane %c (%d >= %d)\n",
			      pipe_name(intel_crtc->pipe),
			      max_size, cur_size);
	}
 
	if (!fb) {
		DRM_DEBUG_KMS("BIOS fb not suitable for all pipes, not using\n");
		goto out;
	}
 
	ifbdev->preferred_bpp = fb->base.bits_per_pixel;
	ifbdev->fb = fb;
 
	drm_framebuffer_reference(&ifbdev->fb->base);
 
	/* Final pass to check if any active pipes don't have fbs */
	for_each_crtc(dev, crtc) {
		intel_crtc = to_intel_crtc(crtc);
 
		if (!crtc->state->active)
			continue;
 
		WARN(!crtc->primary->fb,
		     "re-used BIOS config but lost an fb on crtc %d\n",
		     crtc->base.id);
	}
 
 
	DRM_DEBUG_KMS("using BIOS fb for initial console\n");
	return true;
 
out:
 
	return false;
}
 
int intel_fbdev_init(struct drm_device *dev)
{
	struct intel_fbdev *ifbdev;
	struct drm_i915_private *dev_priv = dev->dev_private;
	int ret;
 
	if (WARN_ON(INTEL_INFO(dev)->num_pipes == 0))
		return -ENODEV;
 
	ifbdev = kzalloc(sizeof(struct intel_fbdev), GFP_KERNEL);
	if (ifbdev == NULL)
		return -ENOMEM;
 
	drm_fb_helper_prepare(dev, &ifbdev->helper, &intel_fb_helper_funcs);
 
	if (!intel_fbdev_init_bios(dev, ifbdev))
		ifbdev->preferred_bpp = 32;
 
	ret = drm_fb_helper_init(dev, &ifbdev->helper,
				 INTEL_INFO(dev)->num_pipes, 4);
	if (ret) {
		kfree(ifbdev);
		return ret;
	}
 
	ifbdev->helper.atomic = true;
 
	dev_priv->fbdev = ifbdev;
	drm_fb_helper_single_add_all_connectors(&ifbdev->helper);
 
	return 0;
}
 
void intel_fbdev_initial_config(void *data, async_cookie_t cookie)
{
	struct drm_i915_private *dev_priv = data;
	struct intel_fbdev *ifbdev = dev_priv->fbdev;
 
	/* Due to peculiar init order wrt to hpd handling this is separate. */
	drm_fb_helper_initial_config(&ifbdev->helper, ifbdev->preferred_bpp);
}
 
 
void intel_fbdev_output_poll_changed(struct drm_device *dev)
{
	struct drm_i915_private *dev_priv = dev->dev_private;
	if (dev_priv->fbdev)
		drm_fb_helper_hotplug_event(&dev_priv->fbdev->helper);
}

Rev 6084	Rev 6088
1	/*	1	/*
2	* Copyright © 2007 David Airlie	2	* Copyright © 2007 David Airlie
3	*	3	*
4	* Permission is hereby granted, free of charge, to any person obtaining a	4	* Permission is hereby granted, free of charge, to any person obtaining a
5	* copy of this software and associated documentation files (the "Software"),	5	* copy of this software and associated documentation files (the "Software"),
6	* to deal in the Software without restriction, including without limitation	6	* to deal in the Software without restriction, including without limitation
7	* the rights to use, copy, modify, merge, publish, distribute, sublicense,	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	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:	9	* Software is furnished to do so, subject to the following conditions:
10	*	10	*
11	* The above copyright notice and this permission notice (including the next	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	12	* paragraph) shall be included in all copies or substantial portions of the
13	* Software.	13	* Software.
14	*	14	*
15	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR	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,	16	* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
17	* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL	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	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	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	20	* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
21	* DEALINGS IN THE SOFTWARE.	21	* DEALINGS IN THE SOFTWARE.
22	*	22	*
23	* Authors:	23	* Authors:
24	* David Airlie	24	* David Airlie
25	*/	25	*/
26		26
27	#include	27	#include
28	#include	28	#include
29	#include	29	#include
30	#include	30	#include
31	#include	31	#include
32	#include	32	#include
33	//#include	33	//#include
34	#include	34	#include
35	#include	35	#include
36	#include	36	#include
37	//#include	37	#include
38	//#include	38	//#include
39		39
40	#include	40	#include
41	#include	41	#include
42	#include	42	#include
43	#include "intel_drv.h"	43	#include "intel_drv.h"
44	#include	44	#include
45	#include "i915_drv.h"	45	#include "i915_drv.h"
46		46
47	struct fb_info framebuffer_alloc(size_t size, struct device dev)	47	struct fb_info framebuffer_alloc(size_t size, struct device dev)
48	{	48	{
49	#define BYTES_PER_LONG (BITS_PER_LONG/8)	49	#define BYTES_PER_LONG (BITS_PER_LONG/8)
50	#define PADDING (BYTES_PER_LONG - (sizeof(struct fb_info) % BYTES_PER_LONG))	50	#define PADDING (BYTES_PER_LONG - (sizeof(struct fb_info) % BYTES_PER_LONG))
51	int fb_info_size = sizeof(struct fb_info);	51	int fb_info_size = sizeof(struct fb_info);
52	struct fb_info *info;	52	struct fb_info *info;
53	char *p;	53	char *p;
54		54
55	if (size)	55	if (size)
56	fb_info_size += PADDING;	56	fb_info_size += PADDING;
57		57
58	p = kzalloc(fb_info_size + size, GFP_KERNEL);	58	p = kzalloc(fb_info_size + size, GFP_KERNEL);
59		59
60	if (!p)	60	if (!p)
61	return NULL;	61	return NULL;
62		62
63	info = (struct fb_info *) p;	63	info = (struct fb_info *) p;
64		64
65	if (size)	65	if (size)
66	info->par = p + fb_info_size;	66	info->par = p + fb_info_size;
67		67
68	return info;	68	return info;
69	#undef PADDING	69	#undef PADDING
70	#undef BYTES_PER_LONG	70	#undef BYTES_PER_LONG
71	}	71	}
72		72
73	static int intel_fbdev_set_par(struct fb_info *info)	73	static int intel_fbdev_set_par(struct fb_info *info)
74	{	74	{
75	struct drm_fb_helper *fb_helper = info->par;	75	struct drm_fb_helper *fb_helper = info->par;
76	struct intel_fbdev *ifbdev =	76	struct intel_fbdev *ifbdev =
77	container_of(fb_helper, struct intel_fbdev, helper);	77	container_of(fb_helper, struct intel_fbdev, helper);
78	int ret;	78	int ret;
79		79
80	ret = drm_fb_helper_set_par(info);	80	ret = drm_fb_helper_set_par(info);
81		81
82	if (ret == 0) {	82	if (ret == 0) {
83	mutex_lock(&fb_helper->dev->struct_mutex);	83	mutex_lock(&fb_helper->dev->struct_mutex);
84	intel_fb_obj_invalidate(ifbdev->fb->obj, ORIGIN_GTT);	84	intel_fb_obj_invalidate(ifbdev->fb->obj, ORIGIN_GTT);
85	mutex_unlock(&fb_helper->dev->struct_mutex);	85	mutex_unlock(&fb_helper->dev->struct_mutex);
86	}	86	}
87		87
88	return ret;	88	return ret;
89	}	89	}
90		90
91	static int intel_fbdev_blank(int blank, struct fb_info *info)	91	static int intel_fbdev_blank(int blank, struct fb_info *info)
92	{	92	{
93	struct drm_fb_helper *fb_helper = info->par;	93	struct drm_fb_helper *fb_helper = info->par;
94	struct intel_fbdev *ifbdev =	94	struct intel_fbdev *ifbdev =
95	container_of(fb_helper, struct intel_fbdev, helper);	95	container_of(fb_helper, struct intel_fbdev, helper);
96	int ret;	96	int ret;
97		97
98	ret = drm_fb_helper_blank(blank, info);	98	ret = drm_fb_helper_blank(blank, info);
99		99
100	if (ret == 0) {	100	if (ret == 0) {
101	mutex_lock(&fb_helper->dev->struct_mutex);	101	mutex_lock(&fb_helper->dev->struct_mutex);
102	intel_fb_obj_invalidate(ifbdev->fb->obj, ORIGIN_GTT);	102	intel_fb_obj_invalidate(ifbdev->fb->obj, ORIGIN_GTT);
103	mutex_unlock(&fb_helper->dev->struct_mutex);	103	mutex_unlock(&fb_helper->dev->struct_mutex);
104	}	104	}
105		105
106	return ret;	106	return ret;
107	}	107	}
108		108
109	static int intel_fbdev_pan_display(struct fb_var_screeninfo *var,	109	static int intel_fbdev_pan_display(struct fb_var_screeninfo *var,
110	struct fb_info *info)	110	struct fb_info *info)
111	{	111	{
112	struct drm_fb_helper *fb_helper = info->par;	112	struct drm_fb_helper *fb_helper = info->par;
113	struct intel_fbdev *ifbdev =	113	struct intel_fbdev *ifbdev =
114	container_of(fb_helper, struct intel_fbdev, helper);	114	container_of(fb_helper, struct intel_fbdev, helper);
115		115
116	int ret;	116	int ret;
117	ret = drm_fb_helper_pan_display(var, info);	117	ret = drm_fb_helper_pan_display(var, info);
118		118
119	if (ret == 0) {	119	if (ret == 0) {
120	mutex_lock(&fb_helper->dev->struct_mutex);	120	mutex_lock(&fb_helper->dev->struct_mutex);
121	intel_fb_obj_invalidate(ifbdev->fb->obj, ORIGIN_GTT);	121	intel_fb_obj_invalidate(ifbdev->fb->obj, ORIGIN_GTT);
122	mutex_unlock(&fb_helper->dev->struct_mutex);	122	mutex_unlock(&fb_helper->dev->struct_mutex);
123	}	123	}
124		124
125	return ret;	125	return ret;
126	}	126	}
127		127
128	static struct fb_ops intelfb_ops = {	128	static struct fb_ops intelfb_ops = {
129	.owner = THIS_MODULE,	129	.owner = THIS_MODULE,
130	.fb_check_var = drm_fb_helper_check_var,	130	.fb_check_var = drm_fb_helper_check_var,
131	.fb_set_par = intel_fbdev_set_par,	131	.fb_set_par = intel_fbdev_set_par,
132	// .fb_fillrect = cfb_fillrect,	132	// .fb_fillrect = cfb_fillrect,
133	// .fb_copyarea = cfb_copyarea,	133	// .fb_copyarea = cfb_copyarea,
134	// .fb_imageblit = cfb_imageblit,	134	// .fb_imageblit = cfb_imageblit,
135	.fb_pan_display = intel_fbdev_pan_display,	135	.fb_pan_display = intel_fbdev_pan_display,
136	.fb_blank = intel_fbdev_blank,	136	.fb_blank = intel_fbdev_blank,
137	// .fb_setcmap = drm_fb_helper_setcmap,	137	// .fb_setcmap = drm_fb_helper_setcmap,
138	// .fb_debug_enter = drm_fb_helper_debug_enter,	138	// .fb_debug_enter = drm_fb_helper_debug_enter,
139	// .fb_debug_leave = drm_fb_helper_debug_leave,	139	// .fb_debug_leave = drm_fb_helper_debug_leave,
140	};	140	};
141		141
142	static int intelfb_alloc(struct drm_fb_helper *helper,	142	static int intelfb_alloc(struct drm_fb_helper *helper,
143	struct drm_fb_helper_surface_size *sizes)	143	struct drm_fb_helper_surface_size *sizes)
144	{	144	{
145	struct intel_fbdev *ifbdev =	145	struct intel_fbdev *ifbdev =
146	container_of(helper, struct intel_fbdev, helper);	146	container_of(helper, struct intel_fbdev, helper);
147	struct drm_framebuffer *fb;	147	struct drm_framebuffer *fb;
148	struct drm_device *dev = helper->dev;	148	struct drm_device *dev = helper->dev;
149	struct drm_i915_private *dev_priv = to_i915(dev);	149	struct drm_i915_private *dev_priv = to_i915(dev);
150	struct drm_mode_fb_cmd2 mode_cmd = {};	150	struct drm_mode_fb_cmd2 mode_cmd = {};
151	struct drm_i915_gem_object *obj = NULL;	151	struct drm_i915_gem_object *obj = NULL;
152	int size, ret;	152	int size, ret;
153		153
154	/* we don't do packed 24bpp */	154	/* we don't do packed 24bpp */
155	if (sizes->surface_bpp == 24)	155	if (sizes->surface_bpp == 24)
156	sizes->surface_bpp = 32;	156	sizes->surface_bpp = 32;
157		157
158	mode_cmd.width = sizes->surface_width;	158	mode_cmd.width = sizes->surface_width;
159	mode_cmd.height = sizes->surface_height;	159	mode_cmd.height = sizes->surface_height;
160		160
161	mode_cmd.pitches[0] = ALIGN(mode_cmd.width *	161	mode_cmd.pitches[0] = ALIGN(mode_cmd.width *
162	DIV_ROUND_UP(sizes->surface_bpp, 8), 64);	162	DIV_ROUND_UP(sizes->surface_bpp, 8), 64);
163	mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp,	163	mode_cmd.pixel_format = drm_mode_legacy_fb_format(sizes->surface_bpp,
164	sizes->surface_depth);	164	sizes->surface_depth);
165		165
166	size = mode_cmd.pitches[0] * mode_cmd.height;	166	size = mode_cmd.pitches[0] * mode_cmd.height;
167	size = PAGE_ALIGN(size);	167	size = PAGE_ALIGN(size);
168	obj = main_fb_obj;	168	obj = main_fb_obj;
169	obj->map_and_fenceable=true;	169	obj->map_and_fenceable=true;
170	if (!obj) {	170	if (!obj) {
171	DRM_ERROR("failed to allocate framebuffer\n");	171	DRM_ERROR("failed to allocate framebuffer\n");
172	ret = -ENOMEM;	172	ret = -ENOMEM;
173	goto out;	173	goto out;
174	}	174	}
175		175
176	fb = __intel_framebuffer_create(dev, &mode_cmd, obj);	176	fb = __intel_framebuffer_create(dev, &mode_cmd, obj);
177	if (IS_ERR(fb)) {	177	if (IS_ERR(fb)) {
178	ret = PTR_ERR(fb);	178	ret = PTR_ERR(fb);
179	goto out_unref;	179	goto out_unref;
180	}	180	}
181		181
182	/* Flush everything out, we'll be doing GTT only from now on */	182	/* Flush everything out, we'll be doing GTT only from now on */
183	ret = intel_pin_and_fence_fb_obj(NULL, fb, NULL, NULL, NULL);	183	ret = intel_pin_and_fence_fb_obj(NULL, fb, NULL, NULL, NULL);
184	if (ret) {	184	if (ret) {
185	DRM_ERROR("failed to pin obj: %d\n", ret);	185	DRM_ERROR("failed to pin obj: %d\n", ret);
186	goto out_fb;	186	goto out_fb;
187	}	187	}
188		188
189	ifbdev->fb = to_intel_framebuffer(fb);	189	ifbdev->fb = to_intel_framebuffer(fb);
190		190
191	return 0;	191	return 0;
192		192
193	out_fb:	193	out_fb:
194	drm_framebuffer_remove(fb);	194	drm_framebuffer_remove(fb);
195	out_unref:	195	out_unref:
196	drm_gem_object_unreference(&obj->base);	196	drm_gem_object_unreference(&obj->base);
197	out:	197	out:
198	return ret;	198	return ret;
199	}	199	}
200		200
201	static int intelfb_create(struct drm_fb_helper *helper,	201	static int intelfb_create(struct drm_fb_helper *helper,
202	struct drm_fb_helper_surface_size *sizes)	202	struct drm_fb_helper_surface_size *sizes)
203	{	203	{
204	struct intel_fbdev *ifbdev =	204	struct intel_fbdev *ifbdev =
205	container_of(helper, struct intel_fbdev, helper);	205	container_of(helper, struct intel_fbdev, helper);
206	struct intel_framebuffer *intel_fb = ifbdev->fb;	206	struct intel_framebuffer *intel_fb = ifbdev->fb;
207	struct drm_device *dev = helper->dev;	207	struct drm_device *dev = helper->dev;
208	struct drm_i915_private *dev_priv = dev->dev_private;	208	struct drm_i915_private *dev_priv = dev->dev_private;
209	struct fb_info *info;	209	struct fb_info *info;
210	struct drm_framebuffer *fb;	210	struct drm_framebuffer *fb;
211	struct drm_i915_gem_object *obj;	211	struct drm_i915_gem_object *obj;
212	int size, ret;	212	int size, ret;
213	bool prealloc = false;	213	bool prealloc = false;
214		214
215	mutex_lock(&dev->struct_mutex);	215	mutex_lock(&dev->struct_mutex);
216		216
217	#if 0	217	#if 0
218	if (intel_fb &&	218	if (intel_fb &&
219	(sizes->fb_width > intel_fb->base.width \|\|	219	(sizes->fb_width > intel_fb->base.width \|\|
220	sizes->fb_height > intel_fb->base.height)) {	220	sizes->fb_height > intel_fb->base.height)) {
221	DRM_DEBUG_KMS("BIOS fb too small (%dx%d), we require (%dx%d),"	221	DRM_DEBUG_KMS("BIOS fb too small (%dx%d), we require (%dx%d),"
222	" releasing it\n",	222	" releasing it\n",
223	intel_fb->base.width, intel_fb->base.height,	223	intel_fb->base.width, intel_fb->base.height,
224	sizes->fb_width, sizes->fb_height);	224	sizes->fb_width, sizes->fb_height);
225	drm_framebuffer_unreference(&intel_fb->base);	225	drm_framebuffer_unreference(&intel_fb->base);
226	intel_fb = ifbdev->fb = NULL;	226	intel_fb = ifbdev->fb = NULL;
227	}	227	}
228	#endif	228	#endif
229		229
230	if (!intel_fb \|\| WARN_ON(!intel_fb->obj)) {	230	if (!intel_fb \|\| WARN_ON(!intel_fb->obj)) {
231	DRM_DEBUG_KMS("no BIOS fb, allocating a new one\n");	231	DRM_DEBUG_KMS("no BIOS fb, allocating a new one\n");
232	ret = intelfb_alloc(helper, sizes);	232	ret = intelfb_alloc(helper, sizes);
233	if (ret)	233	if (ret)
234	goto out_unlock;	234	goto out_unlock;
235	intel_fb = ifbdev->fb;	235	intel_fb = ifbdev->fb;
236	} else {	236	} else {
237	DRM_DEBUG_KMS("re-using BIOS fb\n");	237	DRM_DEBUG_KMS("re-using BIOS fb\n");
238	prealloc = true;	238	prealloc = true;
239	sizes->fb_width = intel_fb->base.width;	239	sizes->fb_width = intel_fb->base.width;
240	sizes->fb_height = intel_fb->base.height;	240	sizes->fb_height = intel_fb->base.height;
241	}	241	}
242		242
243	obj = intel_fb->obj;	243	obj = intel_fb->obj;
244	size = obj->base.size;	244	size = obj->base.size;
245		245
246	info = drm_fb_helper_alloc_fbi(helper);	246	info = drm_fb_helper_alloc_fbi(helper);
247	if (IS_ERR(info)) {	247	if (IS_ERR(info)) {
248	ret = PTR_ERR(info);	248	ret = PTR_ERR(info);
249	goto out_unpin;	249	goto out_unpin;
250	}	250	}
251		251
252	info->par = helper;	252	info->par = helper;
253		253
254	fb = &ifbdev->fb->base;	254	fb = &ifbdev->fb->base;
255		255
256	if(main_framebuffer == NULL)	256	if(main_framebuffer == NULL)
257	main_framebuffer = fb;	257	main_framebuffer = fb;
258		258
259	ifbdev->helper.fb = fb;	259	ifbdev->helper.fb = fb;
260		260
261	strcpy(info->fix.id, "inteldrmfb");	261	strcpy(info->fix.id, "inteldrmfb");
262		262
263	info->flags = FBINFO_DEFAULT \| FBINFO_CAN_FORCE_OUTPUT;	263	info->flags = FBINFO_DEFAULT \| FBINFO_CAN_FORCE_OUTPUT;
264	info->fbops = &intelfb_ops;	264	info->fbops = &intelfb_ops;
265		265
266	/* setup aperture base/size for vesafb takeover */	266	/* setup aperture base/size for vesafb takeover */
267	info->apertures->ranges[0].base = dev->mode_config.fb_base;	267	info->apertures->ranges[0].base = dev->mode_config.fb_base;
268	info->apertures->ranges[0].size = dev_priv->gtt.mappable_end;	268	info->apertures->ranges[0].size = dev_priv->gtt.mappable_end;
269		269
270		270
271	info->screen_base = (void*) 0xFE000000;	271	info->screen_base = (void*) 0xFE000000;
272	info->screen_size = size;	272	info->screen_size = size;
273		273
274	/* This driver doesn't need a VT switch to restore the mode on resume */	274	/* This driver doesn't need a VT switch to restore the mode on resume */
275	info->skip_vt_switch = true;	275	info->skip_vt_switch = true;
276		276
277	drm_fb_helper_fill_fix(info, fb->pitches[0], fb->depth);	277	drm_fb_helper_fill_fix(info, fb->pitches[0], fb->depth);
278	drm_fb_helper_fill_var(info, &ifbdev->helper, sizes->fb_width, sizes->fb_height);	278	drm_fb_helper_fill_var(info, &ifbdev->helper, sizes->fb_width, sizes->fb_height);
279		279
280	/* Use default scratch pixmap (info->pixmap.flags = FB_PIXMAP_SYSTEM) */	280	/* Use default scratch pixmap (info->pixmap.flags = FB_PIXMAP_SYSTEM) */
281		281
282	DRM_DEBUG_KMS("allocated %dx%d fb: 0x%08llx, bo %p\n",	282	DRM_DEBUG_KMS("allocated %dx%d fb: 0x%08llx, bo %p\n",
283	fb->width, fb->height,	283	fb->width, fb->height,
284	i915_gem_obj_ggtt_offset(obj), obj);	284	i915_gem_obj_ggtt_offset(obj), obj);
285		285
286	mutex_unlock(&dev->struct_mutex);	286	mutex_unlock(&dev->struct_mutex);
287	return 0;	287	return 0;
288		288
289	out_destroy_fbi:	289	out_destroy_fbi:
290	drm_fb_helper_release_fbi(helper);	290	drm_fb_helper_release_fbi(helper);
291	out_unpin:	291	out_unpin:
292	i915_gem_object_ggtt_unpin(obj);	292	i915_gem_object_ggtt_unpin(obj);
293	drm_gem_object_unreference(&obj->base);	293	drm_gem_object_unreference(&obj->base);
294	out_unlock:	294	out_unlock:
295	mutex_unlock(&dev->struct_mutex);	295	mutex_unlock(&dev->struct_mutex);
296	return ret;	296	return ret;
297	}	297	}
298		298
299	/** Sets the color ramps on behalf of RandR */	299	/** Sets the color ramps on behalf of RandR */
300	static void intel_crtc_fb_gamma_set(struct drm_crtc *crtc, u16 red, u16 green,	300	static void intel_crtc_fb_gamma_set(struct drm_crtc *crtc, u16 red, u16 green,
301	u16 blue, int regno)	301	u16 blue, int regno)
302	{	302	{
303	struct intel_crtc *intel_crtc = to_intel_crtc(crtc);	303	struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
304		304
305	intel_crtc->lut_r[regno] = red >> 8;	305	intel_crtc->lut_r[regno] = red >> 8;
306	intel_crtc->lut_g[regno] = green >> 8;	306	intel_crtc->lut_g[regno] = green >> 8;
307	intel_crtc->lut_b[regno] = blue >> 8;	307	intel_crtc->lut_b[regno] = blue >> 8;
308	}	308	}
309		309
310	static void intel_crtc_fb_gamma_get(struct drm_crtc crtc, u16 red, u16 *green,	310	static void intel_crtc_fb_gamma_get(struct drm_crtc crtc, u16 red, u16 *green,
311	u16 *blue, int regno)	311	u16 *blue, int regno)
312	{	312	{
313	struct intel_crtc *intel_crtc = to_intel_crtc(crtc);	313	struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
314		314
315	*red = intel_crtc->lut_r[regno] << 8;	315	*red = intel_crtc->lut_r[regno] << 8;
316	*green = intel_crtc->lut_g[regno] << 8;	316	*green = intel_crtc->lut_g[regno] << 8;
317	*blue = intel_crtc->lut_b[regno] << 8;	317	*blue = intel_crtc->lut_b[regno] << 8;
318	}	318	}
319		319
320	static struct drm_fb_helper_crtc *	320	static struct drm_fb_helper_crtc *
321	intel_fb_helper_crtc(struct drm_fb_helper fb_helper, struct drm_crtc crtc)	321	intel_fb_helper_crtc(struct drm_fb_helper fb_helper, struct drm_crtc crtc)
322	{	322	{
323	int i;	323	int i;
324		324
325	for (i = 0; i < fb_helper->crtc_count; i++)	325	for (i = 0; i < fb_helper->crtc_count; i++)
326	if (fb_helper->crtc_info[i].mode_set.crtc == crtc)	326	if (fb_helper->crtc_info[i].mode_set.crtc == crtc)
327	return &fb_helper->crtc_info[i];	327	return &fb_helper->crtc_info[i];
328		328
329	return NULL;	329	return NULL;
330	}	330	}
331		331
332	/*	332	/*
333	* Try to read the BIOS display configuration and use it for the initial	333	* Try to read the BIOS display configuration and use it for the initial
334	* fb configuration.	334	* fb configuration.
335	*	335	*
336	* The BIOS or boot loader will generally create an initial display	336	* The BIOS or boot loader will generally create an initial display
337	* configuration for us that includes some set of active pipes and displays.	337	* configuration for us that includes some set of active pipes and displays.
338	* This routine tries to figure out which pipes and connectors are active	338	* This routine tries to figure out which pipes and connectors are active
339	* and stuffs them into the crtcs and modes array given to us by the	339	* and stuffs them into the crtcs and modes array given to us by the
340	* drm_fb_helper code.	340	* drm_fb_helper code.
341	*	341	*
342	* The overall sequence is:	342	* The overall sequence is:
343	* intel_fbdev_init - from driver load	343	* intel_fbdev_init - from driver load
344	* intel_fbdev_init_bios - initialize the intel_fbdev using BIOS data	344	* intel_fbdev_init_bios - initialize the intel_fbdev using BIOS data
345	* drm_fb_helper_init - build fb helper structs	345	* drm_fb_helper_init - build fb helper structs
346	* drm_fb_helper_single_add_all_connectors - more fb helper structs	346	* drm_fb_helper_single_add_all_connectors - more fb helper structs
347	* intel_fbdev_initial_config - apply the config	347	* intel_fbdev_initial_config - apply the config
348	* drm_fb_helper_initial_config - call ->probe then register_framebuffer()	348	* drm_fb_helper_initial_config - call ->probe then register_framebuffer()
349	* drm_setup_crtcs - build crtc config for fbdev	349	* drm_setup_crtcs - build crtc config for fbdev
350	* intel_fb_initial_config - find active connectors etc	350	* intel_fb_initial_config - find active connectors etc
351	* drm_fb_helper_single_fb_probe - set up fbdev	351	* drm_fb_helper_single_fb_probe - set up fbdev
352	* intelfb_create - re-use or alloc fb, build out fbdev structs	352	* intelfb_create - re-use or alloc fb, build out fbdev structs
353	*	353	*
354	* Note that we don't make special consideration whether we could actually	354	* Note that we don't make special consideration whether we could actually
355	* switch to the selected modes without a full modeset. E.g. when the display	355	* switch to the selected modes without a full modeset. E.g. when the display
356	* is in VGA mode we need to recalculate watermarks and set a new high-res	356	* is in VGA mode we need to recalculate watermarks and set a new high-res
357	* framebuffer anyway.	357	* framebuffer anyway.
358	*/	358	*/
359	static bool intel_fb_initial_config(struct drm_fb_helper *fb_helper,	359	static bool intel_fb_initial_config(struct drm_fb_helper *fb_helper,
360	struct drm_fb_helper_crtc **crtcs,	360	struct drm_fb_helper_crtc **crtcs,
361	struct drm_display_mode **modes,	361	struct drm_display_mode **modes,
362	struct drm_fb_offset *offsets,	362	struct drm_fb_offset *offsets,
363	bool *enabled, int width, int height)	363	bool *enabled, int width, int height)
364	{	364	{
365	struct drm_device *dev = fb_helper->dev;	365	struct drm_device *dev = fb_helper->dev;
366	int i, j;	366	int i, j;
367	bool *save_enabled;	367	bool *save_enabled;
368	bool fallback = true;	368	bool fallback = true;
369	int num_connectors_enabled = 0;	369	int num_connectors_enabled = 0;
370	int num_connectors_detected = 0;	370	int num_connectors_detected = 0;
371	uint64_t conn_configured = 0, mask;	371	uint64_t conn_configured = 0, mask;
372	int pass = 0;	372	int pass = 0;
373		373
374	save_enabled = kcalloc(dev->mode_config.num_connector, sizeof(bool),	374	save_enabled = kcalloc(dev->mode_config.num_connector, sizeof(bool),
375	GFP_KERNEL);	375	GFP_KERNEL);
376	if (!save_enabled)	376	if (!save_enabled)
377	return false;	377	return false;
378		378
379	memcpy(save_enabled, enabled, dev->mode_config.num_connector);	379	memcpy(save_enabled, enabled, dev->mode_config.num_connector);
380	mask = (1 << fb_helper->connector_count) - 1;	380	mask = (1 << fb_helper->connector_count) - 1;
381	retry:	381	retry:
382	for (i = 0; i < fb_helper->connector_count; i++) {	382	for (i = 0; i < fb_helper->connector_count; i++) {
383	struct drm_fb_helper_connector *fb_conn;	383	struct drm_fb_helper_connector *fb_conn;
384	struct drm_connector *connector;	384	struct drm_connector *connector;
385	struct drm_encoder *encoder;	385	struct drm_encoder *encoder;
386	struct drm_fb_helper_crtc *new_crtc;	386	struct drm_fb_helper_crtc *new_crtc;
387		387
388	fb_conn = fb_helper->connector_info[i];	388	fb_conn = fb_helper->connector_info[i];
389	connector = fb_conn->connector;	389	connector = fb_conn->connector;
390		390
391	if (conn_configured & (1 << i))	391	if (conn_configured & (1 << i))
392	continue;	392	continue;
393		393
394	if (pass == 0 && !connector->has_tile)	394	if (pass == 0 && !connector->has_tile)
395	continue;	395	continue;
396		396
397	if (connector->status == connector_status_connected)	397	if (connector->status == connector_status_connected)
398	num_connectors_detected++;	398	num_connectors_detected++;
399		399
400	if (!enabled[i]) {	400	if (!enabled[i]) {
401	DRM_DEBUG_KMS("connector %s not enabled, skipping\n",	401	DRM_DEBUG_KMS("connector %s not enabled, skipping\n",
402	connector->name);	402	connector->name);
403	conn_configured \|= (1 << i);	403	conn_configured \|= (1 << i);
404	continue;	404	continue;
405	}	405	}
406		406
407	if (connector->force == DRM_FORCE_OFF) {	407	if (connector->force == DRM_FORCE_OFF) {
408	DRM_DEBUG_KMS("connector %s is disabled by user, skipping\n",	408	DRM_DEBUG_KMS("connector %s is disabled by user, skipping\n",
409	connector->name);	409	connector->name);
410	enabled[i] = false;	410	enabled[i] = false;
411	continue;	411	continue;
412	}	412	}
413		413
414	encoder = connector->encoder;	414	encoder = connector->encoder;
415	if (!encoder \|\| WARN_ON(!encoder->crtc)) {	415	if (!encoder \|\| WARN_ON(!encoder->crtc)) {
416	if (connector->force > DRM_FORCE_OFF)	416	if (connector->force > DRM_FORCE_OFF)
417	goto bail;	417	goto bail;
418		418
419	DRM_DEBUG_KMS("connector %s has no encoder or crtc, skipping\n",	419	DRM_DEBUG_KMS("connector %s has no encoder or crtc, skipping\n",
420	connector->name);	420	connector->name);
421	enabled[i] = false;	421	enabled[i] = false;
422	conn_configured \|= (1 << i);	422	conn_configured \|= (1 << i);
423	continue;	423	continue;
424	}	424	}
425		425
426	num_connectors_enabled++;	426	num_connectors_enabled++;
427		427
428	new_crtc = intel_fb_helper_crtc(fb_helper, encoder->crtc);	428	new_crtc = intel_fb_helper_crtc(fb_helper, encoder->crtc);
429		429
430	/*	430	/*
431	* Make sure we're not trying to drive multiple connectors	431	* Make sure we're not trying to drive multiple connectors
432	* with a single CRTC, since our cloning support may not	432	* with a single CRTC, since our cloning support may not
433	* match the BIOS.	433	* match the BIOS.
434	*/	434	*/
435	for (j = 0; j < fb_helper->connector_count; j++) {	435	for (j = 0; j < fb_helper->connector_count; j++) {
436	if (crtcs[j] == new_crtc) {	436	if (crtcs[j] == new_crtc) {
437	DRM_DEBUG_KMS("fallback: cloned configuration\n");	437	DRM_DEBUG_KMS("fallback: cloned configuration\n");
438	goto bail;	438	goto bail;
439	}	439	}
440	}	440	}
441		441
442	DRM_DEBUG_KMS("looking for cmdline mode on connector %s\n",	442	DRM_DEBUG_KMS("looking for cmdline mode on connector %s\n",
443	connector->name);	443	connector->name);
444		444
445	/* go for command line mode first */	445	/* go for command line mode first */
446	modes[i] = drm_pick_cmdline_mode(fb_conn, width, height);	446	modes[i] = drm_pick_cmdline_mode(fb_conn, width, height);
447		447
448	/* try for preferred next */	448	/* try for preferred next */
449	if (!modes[i]) {	449	if (!modes[i]) {
450	DRM_DEBUG_KMS("looking for preferred mode on connector %s %d\n",	450	DRM_DEBUG_KMS("looking for preferred mode on connector %s %d\n",
451	connector->name, connector->has_tile);	451	connector->name, connector->has_tile);
452	modes[i] = drm_has_preferred_mode(fb_conn, width,	452	modes[i] = drm_has_preferred_mode(fb_conn, width,
453	height);	453	height);
454	}	454	}
455		455
456	/* No preferred mode marked by the EDID? Are there any modes? */	456	/* No preferred mode marked by the EDID? Are there any modes? */
457	if (!modes[i] && !list_empty(&connector->modes)) {	457	if (!modes[i] && !list_empty(&connector->modes)) {
458	DRM_DEBUG_KMS("using first mode listed on connector %s\n",	458	DRM_DEBUG_KMS("using first mode listed on connector %s\n",
459	connector->name);	459	connector->name);
460	modes[i] = list_first_entry(&connector->modes,	460	modes[i] = list_first_entry(&connector->modes,
461	struct drm_display_mode,	461	struct drm_display_mode,
462	head);	462	head);
463	}	463	}
464		464
465	/* last resort: use current mode */	465	/* last resort: use current mode */
466	if (!modes[i]) {	466	if (!modes[i]) {
467	/*	467	/*
468	* IMPORTANT: We want to use the adjusted mode (i.e.	468	* IMPORTANT: We want to use the adjusted mode (i.e.
469	* after the panel fitter upscaling) as the initial	469	* after the panel fitter upscaling) as the initial
470	* config, not the input mode, which is what crtc->mode	470	* config, not the input mode, which is what crtc->mode
471	* usually contains. But since our current	471	* usually contains. But since our current
472	* code puts a mode derived from the post-pfit timings	472	* code puts a mode derived from the post-pfit timings
473	* into crtc->mode this works out correctly.	473	* into crtc->mode this works out correctly.
474	*/	474	*/
475	DRM_DEBUG_KMS("looking for current mode on connector %s\n",	475	DRM_DEBUG_KMS("looking for current mode on connector %s\n",
476	connector->name);	476	connector->name);
477	modes[i] = &encoder->crtc->mode;	477	modes[i] = &encoder->crtc->mode;
478	}	478	}
479	crtcs[i] = new_crtc;	479	crtcs[i] = new_crtc;
480		480
481	DRM_DEBUG_KMS("connector %s on pipe %c [CRTC:%d]: %dx%d%s\n",	481	DRM_DEBUG_KMS("connector %s on pipe %c [CRTC:%d]: %dx%d%s\n",
482	connector->name,	482	connector->name,
483	pipe_name(to_intel_crtc(encoder->crtc)->pipe),	483	pipe_name(to_intel_crtc(encoder->crtc)->pipe),
484	encoder->crtc->base.id,	484	encoder->crtc->base.id,
485	modes[i]->hdisplay, modes[i]->vdisplay,	485	modes[i]->hdisplay, modes[i]->vdisplay,
486	modes[i]->flags & DRM_MODE_FLAG_INTERLACE ? "i" :"");	486	modes[i]->flags & DRM_MODE_FLAG_INTERLACE ? "i" :"");
487		487
488	fallback = false;	488	fallback = false;
489	conn_configured \|= (1 << i);	489	conn_configured \|= (1 << i);
490	}	490	}
491		491
492	if ((conn_configured & mask) != mask) {	492	if ((conn_configured & mask) != mask) {
493	pass++;	493	pass++;
494	goto retry;	494	goto retry;
495	}	495	}
496		496
497	/*	497	/*
498	* If the BIOS didn't enable everything it could, fall back to have the	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	499	* same user experiencing of lighting up as much as possible like the
500	* fbdev helper library.	500	* fbdev helper library.

Subversion Repositories Kolibri OS

(root)/drivers/video/drm/i915/intel_fbdev.c – Rev 6084 → 6088