drivers/video/omap2/dss/overlay.c - SHIFTPHONES/mainline/linux - Gitiles

 /*
  * linux/drivers/video/omap2/dss/overlay.c
  *
  * Copyright (C) 2009 Nokia Corporation
  * Author: Tomi Valkeinen <tomi.valkeinen@nokia.com>
  *
  * Some code and ideas taken from drivers/video/omap/ driver
  * by Imre Deak.
  *
  * This program is free software; you can redistribute it and/or modify it
  * under the terms of the GNU General Public License version 2 as published by
  * the Free Software Foundation.
  *
  * This program is distributed in the hope that it will be useful, but WITHOUT
  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  * more details.
  *
  * You should have received a copy of the GNU General Public License along with
  * this program.  If not, see <http://www.gnu.org/licenses/>.
  */

 #define DSS_SUBSYS_NAME "OVERLAY"

 #include <linux/kernel.h>
 #include <linux/module.h>
 #include <linux/err.h>
 #include <linux/sysfs.h>
 #include <linux/platform_device.h>
 #include <linux/delay.h>
 #include <linux/slab.h>

 #include <video/omapdss.h>

 #include "dss.h"
 #include "dss_features.h"

 static int num_overlays;
 static struct omap_overlay *overlays;

 int omap_dss_get_num_overlays(void)
 {
 	return num_overlays;
 }
 EXPORT_SYMBOL(omap_dss_get_num_overlays);

 struct omap_overlay *omap_dss_get_overlay(int num)
 {
 	if (num >= num_overlays)
 		return NULL;

 	return &overlays[num];
 }
 EXPORT_SYMBOL(omap_dss_get_overlay);

 void dss_init_overlays(struct platform_device *pdev)
 {
 	int i, r;

 	num_overlays = dss_feat_get_num_ovls();

 	overlays = kzalloc(sizeof(struct omap_overlay) * num_overlays,
 			GFP_KERNEL);

 	BUG_ON(overlays == NULL);

 	for (i = 0; i < num_overlays; ++i) {
 		struct omap_overlay *ovl = &overlays[i];

 		switch (i) {
 		case 0:
 			ovl->name = "gfx";
 			ovl->id = OMAP_DSS_GFX;
 			break;
 		case 1:
 			ovl->name = "vid1";
 			ovl->id = OMAP_DSS_VIDEO1;
 			break;
 		case 2:
 			ovl->name = "vid2";
 			ovl->id = OMAP_DSS_VIDEO2;
 			break;
 		case 3:
 			ovl->name = "vid3";
 			ovl->id = OMAP_DSS_VIDEO3;
 			break;
 		}

 		ovl->is_enabled = &dss_ovl_is_enabled;
 		ovl->enable = &dss_ovl_enable;
 		ovl->disable = &dss_ovl_disable;
 		ovl->set_manager = &dss_ovl_set_manager;
 		ovl->unset_manager = &dss_ovl_unset_manager;
 		ovl->set_overlay_info = &dss_ovl_set_info;
 		ovl->get_overlay_info = &dss_ovl_get_info;
 		ovl->wait_for_go = &dss_mgr_wait_for_go_ovl;

 		ovl->caps = dss_feat_get_overlay_caps(ovl->id);
 		ovl->supported_modes =
 			dss_feat_get_supported_color_modes(ovl->id);

 		r = dss_overlay_kobj_init(ovl, pdev);
 		if (r)
 			DSSERR("failed to create sysfs file\n");
 	}
 }

 /* connect overlays to the new device, if not already connected. if force
  * selected, connect always. */
 void dss_recheck_connections(struct omap_dss_device *dssdev, bool force)
 {
 	int i;
 	struct omap_overlay_manager *lcd_mgr;
 	struct omap_overlay_manager *tv_mgr;
 	struct omap_overlay_manager *lcd2_mgr = NULL;
 	struct omap_overlay_manager *lcd3_mgr = NULL;
 	struct omap_overlay_manager *mgr = NULL;

 	lcd_mgr = omap_dss_get_overlay_manager(OMAP_DSS_CHANNEL_LCD);
 	tv_mgr = omap_dss_get_overlay_manager(OMAP_DSS_CHANNEL_DIGIT);
 	if (dss_has_feature(FEAT_MGR_LCD3))
 		lcd3_mgr = omap_dss_get_overlay_manager(OMAP_DSS_CHANNEL_LCD3);
 	if (dss_has_feature(FEAT_MGR_LCD2))
 		lcd2_mgr = omap_dss_get_overlay_manager(OMAP_DSS_CHANNEL_LCD2);

 	if (dssdev->channel == OMAP_DSS_CHANNEL_LCD3) {
 		if (!lcd3_mgr->device || force) {
 			if (lcd3_mgr->device)
 				lcd3_mgr->unset_device(lcd3_mgr);
 			lcd3_mgr->set_device(lcd3_mgr, dssdev);
 			mgr = lcd3_mgr;
 		}
 	} else if (dssdev->channel == OMAP_DSS_CHANNEL_LCD2) {
 		if (!lcd2_mgr->device || force) {
 			if (lcd2_mgr->device)
 				lcd2_mgr->unset_device(lcd2_mgr);
 			lcd2_mgr->set_device(lcd2_mgr, dssdev);
 			mgr = lcd2_mgr;
 		}
 	} else if (dssdev->type != OMAP_DISPLAY_TYPE_VENC
 			&& dssdev->type != OMAP_DISPLAY_TYPE_HDMI) {
 		if (!lcd_mgr->device || force) {
 			if (lcd_mgr->device)
 				lcd_mgr->unset_device(lcd_mgr);
 			lcd_mgr->set_device(lcd_mgr, dssdev);
 			mgr = lcd_mgr;
 		}
 	}

 	if (dssdev->type == OMAP_DISPLAY_TYPE_VENC
 			|| dssdev->type == OMAP_DISPLAY_TYPE_HDMI) {
 		if (!tv_mgr->device || force) {
 			if (tv_mgr->device)
 				tv_mgr->unset_device(tv_mgr);
 			tv_mgr->set_device(tv_mgr, dssdev);
 			mgr = tv_mgr;
 		}
 	}

 	if (mgr) {
 		dispc_runtime_get();

 		for (i = 0; i < dss_feat_get_num_ovls(); i++) {
 			struct omap_overlay *ovl;
 			ovl = omap_dss_get_overlay(i);
 			if (!ovl->manager || force) {
 				if (ovl->manager)
 					ovl->unset_manager(ovl);
 				ovl->set_manager(ovl, mgr);
 			}
 		}

 		dispc_runtime_put();
 	}
 }

 void dss_uninit_overlays(struct platform_device *pdev)
 {
 	int i;

 	for (i = 0; i < num_overlays; ++i) {
 		struct omap_overlay *ovl = &overlays[i];
 		dss_overlay_kobj_uninit(ovl);
 	}

 	kfree(overlays);
 	overlays = NULL;
 	num_overlays = 0;
 }

 int dss_ovl_simple_check(struct omap_overlay *ovl,
 		const struct omap_overlay_info *info)
 {
 	if (info->paddr == 0) {
 		DSSERR("check_overlay: paddr cannot be 0\n");
 		return -EINVAL;
 	}

 	if ((ovl->caps & OMAP_DSS_OVL_CAP_SCALE) == 0) {
 		if (info->out_width != 0 && info->width != info->out_width) {
 			DSSERR("check_overlay: overlay %d doesn't support "
 					"scaling\n", ovl->id);
 			return -EINVAL;
 		}

 		if (info->out_height != 0 && info->height != info->out_height) {
 			DSSERR("check_overlay: overlay %d doesn't support "
 					"scaling\n", ovl->id);
 			return -EINVAL;
 		}
 	}

 	if ((ovl->supported_modes & info->color_mode) == 0) {
 		DSSERR("check_overlay: overlay %d doesn't support mode %d\n",
 				ovl->id, info->color_mode);
 		return -EINVAL;
 	}

 	if (info->zorder >= omap_dss_get_num_overlays()) {
 		DSSERR("check_overlay: zorder %d too high\n", info->zorder);
 		return -EINVAL;
 	}

 	if (dss_feat_rotation_type_supported(info->rotation_type) == 0) {
 		DSSERR("check_overlay: rotation type %d not supported\n",
 				info->rotation_type);
 		return -EINVAL;
 	}

 	return 0;
 }

 int dss_ovl_check(struct omap_overlay *ovl, struct omap_overlay_info *info,
 		const struct omap_video_timings *mgr_timings)
 {
 	u16 outw, outh;
 	u16 dw, dh;

 	dw = mgr_timings->x_res;
 	dh = mgr_timings->y_res;

 	if ((ovl->caps & OMAP_DSS_OVL_CAP_SCALE) == 0) {
 		outw = info->width;
 		outh = info->height;
 	} else {
 		if (info->out_width == 0)
 			outw = info->width;
 		else
 			outw = info->out_width;

 		if (info->out_height == 0)
 			outh = info->height;
 		else
 			outh = info->out_height;
 	}

 	if (dw < info->pos_x + outw) {
 		DSSERR("overlay %d horizontally not inside the display area "
 				"(%d + %d >= %d)\n",
 				ovl->id, info->pos_x, outw, dw);
 		return -EINVAL;
 	}

 	if (dh < info->pos_y + outh) {
 		DSSERR("overlay %d vertically not inside the display area "
 				"(%d + %d >= %d)\n",
 				ovl->id, info->pos_y, outh, dh);
 		return -EINVAL;
 	}

 	return 0;
 }

 /*
  * Checks if replication logic should be used. Only use when overlay is in
  * RGB12U or RGB16 mode, and video port width interface is 18bpp or 24bpp
  */
 bool dss_ovl_use_replication(struct dss_lcd_mgr_config config,
 		enum omap_color_mode mode)
 {
 	if (mode != OMAP_DSS_COLOR_RGB12U && mode != OMAP_DSS_COLOR_RGB16)
 		return false;

 	return config.video_port_width > 16;
 }
	/*
	* linux/drivers/video/omap2/dss/overlay.c
	*
	* Copyright (C) 2009 Nokia Corporation
	* Author: Tomi Valkeinen <tomi.valkeinen@nokia.com>
	*
	* Some code and ideas taken from drivers/video/omap/ driver
	* by Imre Deak.
	*
	* This program is free software; you can redistribute it and/or modify it
	* under the terms of the GNU General Public License version 2 as published by
	* the Free Software Foundation.
	*
	* This program is distributed in the hope that it will be useful, but WITHOUT
	* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
	* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
	* more details.
	*
	* You should have received a copy of the GNU General Public License along with
	* this program. If not, see <http://www.gnu.org/licenses/>.
	*/

	#define DSS_SUBSYS_NAME "OVERLAY"

	#include <linux/kernel.h>
	#include <linux/module.h>
	#include <linux/err.h>
	#include <linux/sysfs.h>
	#include <linux/platform_device.h>
	#include <linux/delay.h>
	#include <linux/slab.h>

	#include <video/omapdss.h>

	#include "dss.h"
	#include "dss_features.h"

	static int num_overlays;
	static struct omap_overlay *overlays;

	int omap_dss_get_num_overlays(void)
	{
	return num_overlays;
	}
	EXPORT_SYMBOL(omap_dss_get_num_overlays);

	struct omap_overlay *omap_dss_get_overlay(int num)
	{
	if (num >= num_overlays)
	return NULL;

	return &overlays[num];
	}
	EXPORT_SYMBOL(omap_dss_get_overlay);

	void dss_init_overlays(struct platform_device *pdev)
	{
	int i, r;

	num_overlays = dss_feat_get_num_ovls();

	overlays = kzalloc(sizeof(struct omap_overlay) * num_overlays,
	GFP_KERNEL);

	BUG_ON(overlays == NULL);

	for (i = 0; i < num_overlays; ++i) {
	struct omap_overlay *ovl = &overlays[i];

	switch (i) {
	case 0:
	ovl->name = "gfx";
	ovl->id = OMAP_DSS_GFX;
	break;
	case 1:
	ovl->name = "vid1";
	ovl->id = OMAP_DSS_VIDEO1;
	break;
	case 2:
	ovl->name = "vid2";
	ovl->id = OMAP_DSS_VIDEO2;
	break;
	case 3:
	ovl->name = "vid3";
	ovl->id = OMAP_DSS_VIDEO3;
	break;
	}

	ovl->is_enabled = &dss_ovl_is_enabled;
	ovl->enable = &dss_ovl_enable;
	ovl->disable = &dss_ovl_disable;
	ovl->set_manager = &dss_ovl_set_manager;
	ovl->unset_manager = &dss_ovl_unset_manager;
	ovl->set_overlay_info = &dss_ovl_set_info;
	ovl->get_overlay_info = &dss_ovl_get_info;
	ovl->wait_for_go = &dss_mgr_wait_for_go_ovl;

	ovl->caps = dss_feat_get_overlay_caps(ovl->id);
	ovl->supported_modes =
	dss_feat_get_supported_color_modes(ovl->id);

	r = dss_overlay_kobj_init(ovl, pdev);
	if (r)
	DSSERR("failed to create sysfs file\n");
	}
	}

	/* connect overlays to the new device, if not already connected. if force
	* selected, connect always. */
	void dss_recheck_connections(struct omap_dss_device *dssdev, bool force)
	{
	int i;
	struct omap_overlay_manager *lcd_mgr;
	struct omap_overlay_manager *tv_mgr;
	struct omap_overlay_manager *lcd2_mgr = NULL;
	struct omap_overlay_manager *lcd3_mgr = NULL;
	struct omap_overlay_manager *mgr = NULL;

	lcd_mgr = omap_dss_get_overlay_manager(OMAP_DSS_CHANNEL_LCD);
	tv_mgr = omap_dss_get_overlay_manager(OMAP_DSS_CHANNEL_DIGIT);
	if (dss_has_feature(FEAT_MGR_LCD3))
	lcd3_mgr = omap_dss_get_overlay_manager(OMAP_DSS_CHANNEL_LCD3);
	if (dss_has_feature(FEAT_MGR_LCD2))
	lcd2_mgr = omap_dss_get_overlay_manager(OMAP_DSS_CHANNEL_LCD2);

	if (dssdev->channel == OMAP_DSS_CHANNEL_LCD3) {
	if (!lcd3_mgr->device \|\| force) {
	if (lcd3_mgr->device)
	lcd3_mgr->unset_device(lcd3_mgr);
	lcd3_mgr->set_device(lcd3_mgr, dssdev);
	mgr = lcd3_mgr;
	}
	} else if (dssdev->channel == OMAP_DSS_CHANNEL_LCD2) {
	if (!lcd2_mgr->device \|\| force) {
	if (lcd2_mgr->device)
	lcd2_mgr->unset_device(lcd2_mgr);
	lcd2_mgr->set_device(lcd2_mgr, dssdev);
	mgr = lcd2_mgr;
	}
	} else if (dssdev->type != OMAP_DISPLAY_TYPE_VENC
	&& dssdev->type != OMAP_DISPLAY_TYPE_HDMI) {
	if (!lcd_mgr->device \|\| force) {
	if (lcd_mgr->device)
	lcd_mgr->unset_device(lcd_mgr);
	lcd_mgr->set_device(lcd_mgr, dssdev);
	mgr = lcd_mgr;
	}
	}

	if (dssdev->type == OMAP_DISPLAY_TYPE_VENC
	\|\| dssdev->type == OMAP_DISPLAY_TYPE_HDMI) {
	if (!tv_mgr->device \|\| force) {
	if (tv_mgr->device)
	tv_mgr->unset_device(tv_mgr);
	tv_mgr->set_device(tv_mgr, dssdev);
	mgr = tv_mgr;
	}
	}

	if (mgr) {
	dispc_runtime_get();

	for (i = 0; i < dss_feat_get_num_ovls(); i++) {
	struct omap_overlay *ovl;
	ovl = omap_dss_get_overlay(i);
	if (!ovl->manager \|\| force) {
	if (ovl->manager)
	ovl->unset_manager(ovl);
	ovl->set_manager(ovl, mgr);
	}
	}

	dispc_runtime_put();
	}
	}

	void dss_uninit_overlays(struct platform_device *pdev)
	{
	int i;

	for (i = 0; i < num_overlays; ++i) {
	struct omap_overlay *ovl = &overlays[i];
	dss_overlay_kobj_uninit(ovl);
	}

	kfree(overlays);
	overlays = NULL;
	num_overlays = 0;
	}

	int dss_ovl_simple_check(struct omap_overlay *ovl,
	const struct omap_overlay_info *info)
	{
	if (info->paddr == 0) {
	DSSERR("check_overlay: paddr cannot be 0\n");
	return -EINVAL;
	}

	if ((ovl->caps & OMAP_DSS_OVL_CAP_SCALE) == 0) {
	if (info->out_width != 0 && info->width != info->out_width) {
	DSSERR("check_overlay: overlay %d doesn't support "
	"scaling\n", ovl->id);
	return -EINVAL;
	}

	if (info->out_height != 0 && info->height != info->out_height) {
	DSSERR("check_overlay: overlay %d doesn't support "
	"scaling\n", ovl->id);
	return -EINVAL;
	}
	}

	if ((ovl->supported_modes & info->color_mode) == 0) {
	DSSERR("check_overlay: overlay %d doesn't support mode %d\n",
	ovl->id, info->color_mode);
	return -EINVAL;
	}

	if (info->zorder >= omap_dss_get_num_overlays()) {
	DSSERR("check_overlay: zorder %d too high\n", info->zorder);
	return -EINVAL;
	}

	if (dss_feat_rotation_type_supported(info->rotation_type) == 0) {
	DSSERR("check_overlay: rotation type %d not supported\n",
	info->rotation_type);
	return -EINVAL;
	}

	return 0;
	}

	int dss_ovl_check(struct omap_overlay ovl, struct omap_overlay_info info,
	const struct omap_video_timings *mgr_timings)
	{
	u16 outw, outh;
	u16 dw, dh;

	dw = mgr_timings->x_res;
	dh = mgr_timings->y_res;

	if ((ovl->caps & OMAP_DSS_OVL_CAP_SCALE) == 0) {
	outw = info->width;
	outh = info->height;
	} else {
	if (info->out_width == 0)
	outw = info->width;
	else
	outw = info->out_width;

	if (info->out_height == 0)
	outh = info->height;
	else
	outh = info->out_height;
	}

	if (dw < info->pos_x + outw) {
	DSSERR("overlay %d horizontally not inside the display area "
	"(%d + %d >= %d)\n",
	ovl->id, info->pos_x, outw, dw);
	return -EINVAL;
	}

	if (dh < info->pos_y + outh) {
	DSSERR("overlay %d vertically not inside the display area "
	"(%d + %d >= %d)\n",
	ovl->id, info->pos_y, outh, dh);
	return -EINVAL;
	}

	return 0;
	}

	/*
	* Checks if replication logic should be used. Only use when overlay is in
	* RGB12U or RGB16 mode, and video port width interface is 18bpp or 24bpp
	*/
	bool dss_ovl_use_replication(struct dss_lcd_mgr_config config,
	enum omap_color_mode mode)
	{
	if (mode != OMAP_DSS_COLOR_RGB12U && mode != OMAP_DSS_COLOR_RGB16)
	return false;

	return config.video_port_width > 16;
	}