drivers/video/omap2/dss/manager.c - kernel/msm-4.9 - Gitiles

 /*
  * linux/drivers/video/omap2/dss/manager.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 "MANAGER"

 #include <linux/kernel.h>
 #include <linux/slab.h>
 #include <linux/module.h>
 #include <linux/platform_device.h>
 #include <linux/jiffies.h>

 #include <video/omapdss.h>

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

 static int num_managers;
 static struct omap_overlay_manager *managers;

 static ssize_t manager_name_show(struct omap_overlay_manager *mgr, char *buf)
 {
 	return snprintf(buf, PAGE_SIZE, "%s\n", mgr->name);
 }

 static ssize_t manager_display_show(struct omap_overlay_manager *mgr, char *buf)
 {
 	return snprintf(buf, PAGE_SIZE, "%s\n",
 			mgr->device ? mgr->device->name : "<none>");
 }

 static ssize_t manager_display_store(struct omap_overlay_manager *mgr,
 		const char *buf, size_t size)
 {
 	int r = 0;
 	size_t len = size;
 	struct omap_dss_device *dssdev = NULL;

 	int match(struct omap_dss_device *dssdev, void *data)
 	{
 		const char *str = data;
 		return sysfs_streq(dssdev->name, str);
 	}

 	if (buf[size-1] == '\n')
 		--len;

 	if (len > 0)
 		dssdev = omap_dss_find_device((void *)buf, match);

 	if (len > 0 && dssdev == NULL)
 		return -EINVAL;

 	if (dssdev)
 		DSSDBG("display %s found\n", dssdev->name);

 	if (mgr->device) {
 		r = mgr->unset_device(mgr);
 		if (r) {
 			DSSERR("failed to unset display\n");
 			goto put_device;
 		}
 	}

 	if (dssdev) {
 		r = mgr->set_device(mgr, dssdev);
 		if (r) {
 			DSSERR("failed to set manager\n");
 			goto put_device;
 		}

 		r = mgr->apply(mgr);
 		if (r) {
 			DSSERR("failed to apply dispc config\n");
 			goto put_device;
 		}
 	}

 put_device:
 	if (dssdev)
 		omap_dss_put_device(dssdev);

 	return r ? r : size;
 }

 static ssize_t manager_default_color_show(struct omap_overlay_manager *mgr,
 					  char *buf)
 {
 	struct omap_overlay_manager_info info;

 	mgr->get_manager_info(mgr, &info);

 	return snprintf(buf, PAGE_SIZE, "%#x\n", info.default_color);
 }

 static ssize_t manager_default_color_store(struct omap_overlay_manager *mgr,
 					   const char *buf, size_t size)
 {
 	struct omap_overlay_manager_info info;
 	u32 color;
 	int r;

 	r = kstrtouint(buf, 0, &color);
 	if (r)
 		return r;

 	mgr->get_manager_info(mgr, &info);

 	info.default_color = color;

 	r = mgr->set_manager_info(mgr, &info);
 	if (r)
 		return r;

 	r = mgr->apply(mgr);
 	if (r)
 		return r;

 	return size;
 }

 static const char *trans_key_type_str[] = {
 	"gfx-destination",
 	"video-source",
 };

 static ssize_t manager_trans_key_type_show(struct omap_overlay_manager *mgr,
 					   char *buf)
 {
 	enum omap_dss_trans_key_type key_type;
 	struct omap_overlay_manager_info info;

 	mgr->get_manager_info(mgr, &info);

 	key_type = info.trans_key_type;
 	BUG_ON(key_type >= ARRAY_SIZE(trans_key_type_str));

 	return snprintf(buf, PAGE_SIZE, "%s\n", trans_key_type_str[key_type]);
 }

 static ssize_t manager_trans_key_type_store(struct omap_overlay_manager *mgr,
 					    const char *buf, size_t size)
 {
 	enum omap_dss_trans_key_type key_type;
 	struct omap_overlay_manager_info info;
 	int r;

 	for (key_type = OMAP_DSS_COLOR_KEY_GFX_DST;
 			key_type < ARRAY_SIZE(trans_key_type_str); key_type++) {
 		if (sysfs_streq(buf, trans_key_type_str[key_type]))
 			break;
 	}

 	if (key_type == ARRAY_SIZE(trans_key_type_str))
 		return -EINVAL;

 	mgr->get_manager_info(mgr, &info);

 	info.trans_key_type = key_type;

 	r = mgr->set_manager_info(mgr, &info);
 	if (r)
 		return r;

 	r = mgr->apply(mgr);
 	if (r)
 		return r;

 	return size;
 }

 static ssize_t manager_trans_key_value_show(struct omap_overlay_manager *mgr,
 					    char *buf)
 {
 	struct omap_overlay_manager_info info;

 	mgr->get_manager_info(mgr, &info);

 	return snprintf(buf, PAGE_SIZE, "%#x\n", info.trans_key);
 }

 static ssize_t manager_trans_key_value_store(struct omap_overlay_manager *mgr,
 					     const char *buf, size_t size)
 {
 	struct omap_overlay_manager_info info;
 	u32 key_value;
 	int r;

 	r = kstrtouint(buf, 0, &key_value);
 	if (r)
 		return r;

 	mgr->get_manager_info(mgr, &info);

 	info.trans_key = key_value;

 	r = mgr->set_manager_info(mgr, &info);
 	if (r)
 		return r;

 	r = mgr->apply(mgr);
 	if (r)
 		return r;

 	return size;
 }

 static ssize_t manager_trans_key_enabled_show(struct omap_overlay_manager *mgr,
 					      char *buf)
 {
 	struct omap_overlay_manager_info info;

 	mgr->get_manager_info(mgr, &info);

 	return snprintf(buf, PAGE_SIZE, "%d\n", info.trans_enabled);
 }

 static ssize_t manager_trans_key_enabled_store(struct omap_overlay_manager *mgr,
 					       const char *buf, size_t size)
 {
 	struct omap_overlay_manager_info info;
 	bool enable;
 	int r;

 	r = strtobool(buf, &enable);
 	if (r)
 		return r;

 	mgr->get_manager_info(mgr, &info);

 	info.trans_enabled = enable;

 	r = mgr->set_manager_info(mgr, &info);
 	if (r)
 		return r;

 	r = mgr->apply(mgr);
 	if (r)
 		return r;

 	return size;
 }

 static ssize_t manager_alpha_blending_enabled_show(
 		struct omap_overlay_manager *mgr, char *buf)
 {
 	struct omap_overlay_manager_info info;

 	mgr->get_manager_info(mgr, &info);

 	WARN_ON(!dss_has_feature(FEAT_ALPHA_FIXED_ZORDER));

 	return snprintf(buf, PAGE_SIZE, "%d\n",
 		info.partial_alpha_enabled);
 }

 static ssize_t manager_alpha_blending_enabled_store(
 		struct omap_overlay_manager *mgr,
 		const char *buf, size_t size)
 {
 	struct omap_overlay_manager_info info;
 	bool enable;
 	int r;

 	WARN_ON(!dss_has_feature(FEAT_ALPHA_FIXED_ZORDER));

 	r = strtobool(buf, &enable);
 	if (r)
 		return r;

 	mgr->get_manager_info(mgr, &info);

 	info.partial_alpha_enabled = enable;

 	r = mgr->set_manager_info(mgr, &info);
 	if (r)
 		return r;

 	r = mgr->apply(mgr);
 	if (r)
 		return r;

 	return size;
 }

 static ssize_t manager_cpr_enable_show(struct omap_overlay_manager *mgr,
 		char *buf)
 {
 	struct omap_overlay_manager_info info;

 	mgr->get_manager_info(mgr, &info);

 	return snprintf(buf, PAGE_SIZE, "%d\n", info.cpr_enable);
 }

 static ssize_t manager_cpr_enable_store(struct omap_overlay_manager *mgr,
 		const char *buf, size_t size)
 {
 	struct omap_overlay_manager_info info;
 	int r;
 	bool enable;

 	if (!dss_has_feature(FEAT_CPR))
 		return -ENODEV;

 	r = strtobool(buf, &enable);
 	if (r)
 		return r;

 	mgr->get_manager_info(mgr, &info);

 	if (info.cpr_enable == enable)
 		return size;

 	info.cpr_enable = enable;

 	r = mgr->set_manager_info(mgr, &info);
 	if (r)
 		return r;

 	r = mgr->apply(mgr);
 	if (r)
 		return r;

 	return size;
 }

 static ssize_t manager_cpr_coef_show(struct omap_overlay_manager *mgr,
 		char *buf)
 {
 	struct omap_overlay_manager_info info;

 	mgr->get_manager_info(mgr, &info);

 	return snprintf(buf, PAGE_SIZE,
 			"%d %d %d %d %d %d %d %d %d\n",
 			info.cpr_coefs.rr,
 			info.cpr_coefs.rg,
 			info.cpr_coefs.rb,
 			info.cpr_coefs.gr,
 			info.cpr_coefs.gg,
 			info.cpr_coefs.gb,
 			info.cpr_coefs.br,
 			info.cpr_coefs.bg,
 			info.cpr_coefs.bb);
 }

 static ssize_t manager_cpr_coef_store(struct omap_overlay_manager *mgr,
 		const char *buf, size_t size)
 {
 	struct omap_overlay_manager_info info;
 	struct omap_dss_cpr_coefs coefs;
 	int r, i;
 	s16 *arr;

 	if (!dss_has_feature(FEAT_CPR))
 		return -ENODEV;

 	if (sscanf(buf, "%hd %hd %hd %hd %hd %hd %hd %hd %hd",
 				&coefs.rr, &coefs.rg, &coefs.rb,
 				&coefs.gr, &coefs.gg, &coefs.gb,
 				&coefs.br, &coefs.bg, &coefs.bb) != 9)
 		return -EINVAL;

 	arr = (s16[]){ coefs.rr, coefs.rg, coefs.rb,
 		coefs.gr, coefs.gg, coefs.gb,
 		coefs.br, coefs.bg, coefs.bb };

 	for (i = 0; i < 9; ++i) {
 		if (arr[i] < -512 || arr[i] > 511)
 			return -EINVAL;
 	}

 	mgr->get_manager_info(mgr, &info);

 	info.cpr_coefs = coefs;

 	r = mgr->set_manager_info(mgr, &info);
 	if (r)
 		return r;

 	r = mgr->apply(mgr);
 	if (r)
 		return r;

 	return size;
 }

 struct manager_attribute {
 	struct attribute attr;
 	ssize_t (*show)(struct omap_overlay_manager *, char *);
 	ssize_t	(*store)(struct omap_overlay_manager *, const char *, size_t);
 };

 #define MANAGER_ATTR(_name, _mode, _show, _store) \
 	struct manager_attribute manager_attr_##_name = \
 	__ATTR(_name, _mode, _show, _store)

 static MANAGER_ATTR(name, S_IRUGO, manager_name_show, NULL);
 static MANAGER_ATTR(display, S_IRUGO|S_IWUSR,
 		manager_display_show, manager_display_store);
 static MANAGER_ATTR(default_color, S_IRUGO|S_IWUSR,
 		manager_default_color_show, manager_default_color_store);
 static MANAGER_ATTR(trans_key_type, S_IRUGO|S_IWUSR,
 		manager_trans_key_type_show, manager_trans_key_type_store);
 static MANAGER_ATTR(trans_key_value, S_IRUGO|S_IWUSR,
 		manager_trans_key_value_show, manager_trans_key_value_store);
 static MANAGER_ATTR(trans_key_enabled, S_IRUGO|S_IWUSR,
 		manager_trans_key_enabled_show,
 		manager_trans_key_enabled_store);
 static MANAGER_ATTR(alpha_blending_enabled, S_IRUGO|S_IWUSR,
 		manager_alpha_blending_enabled_show,
 		manager_alpha_blending_enabled_store);
 static MANAGER_ATTR(cpr_enable, S_IRUGO|S_IWUSR,
 		manager_cpr_enable_show,
 		manager_cpr_enable_store);
 static MANAGER_ATTR(cpr_coef, S_IRUGO|S_IWUSR,
 		manager_cpr_coef_show,
 		manager_cpr_coef_store);


 static struct attribute *manager_sysfs_attrs[] = {
 	&manager_attr_name.attr,
 	&manager_attr_display.attr,
 	&manager_attr_default_color.attr,
 	&manager_attr_trans_key_type.attr,
 	&manager_attr_trans_key_value.attr,
 	&manager_attr_trans_key_enabled.attr,
 	&manager_attr_alpha_blending_enabled.attr,
 	&manager_attr_cpr_enable.attr,
 	&manager_attr_cpr_coef.attr,
 	NULL
 };

 static ssize_t manager_attr_show(struct kobject *kobj, struct attribute *attr,
 		char *buf)
 {
 	struct omap_overlay_manager *manager;
 	struct manager_attribute *manager_attr;

 	manager = container_of(kobj, struct omap_overlay_manager, kobj);
 	manager_attr = container_of(attr, struct manager_attribute, attr);

 	if (!manager_attr->show)
 		return -ENOENT;

 	return manager_attr->show(manager, buf);
 }

 static ssize_t manager_attr_store(struct kobject *kobj, struct attribute *attr,
 		const char *buf, size_t size)
 {
 	struct omap_overlay_manager *manager;
 	struct manager_attribute *manager_attr;

 	manager = container_of(kobj, struct omap_overlay_manager, kobj);
 	manager_attr = container_of(attr, struct manager_attribute, attr);

 	if (!manager_attr->store)
 		return -ENOENT;

 	return manager_attr->store(manager, buf, size);
 }

 static const struct sysfs_ops manager_sysfs_ops = {
 	.show = manager_attr_show,
 	.store = manager_attr_store,
 };

 static struct kobj_type manager_ktype = {
 	.sysfs_ops = &manager_sysfs_ops,
 	.default_attrs = manager_sysfs_attrs,
 };

 static int dss_mgr_wait_for_vsync(struct omap_overlay_manager *mgr)
 {
 	unsigned long timeout = msecs_to_jiffies(500);
 	u32 irq;
 	int r;

 	r = dispc_runtime_get();
 	if (r)
 		return r;

 	if (mgr->device->type == OMAP_DISPLAY_TYPE_VENC)
 		irq = DISPC_IRQ_EVSYNC_ODD;
 	else if (mgr->device->type == OMAP_DISPLAY_TYPE_HDMI)
 		irq = DISPC_IRQ_EVSYNC_EVEN;
 	else
 		irq = dispc_mgr_get_vsync_irq(mgr->id);

 	r = omap_dispc_wait_for_irq_interruptible_timeout(irq, timeout);

 	dispc_runtime_put();

 	return r;
 }

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

 	num_managers = dss_feat_get_num_mgrs();

 	managers = kzalloc(sizeof(struct omap_overlay_manager) * num_managers,
 			GFP_KERNEL);

 	BUG_ON(managers == NULL);

 	for (i = 0; i < num_managers; ++i) {
 		struct omap_overlay_manager *mgr = &managers[i];

 		switch (i) {
 		case 0:
 			mgr->name = "lcd";
 			mgr->id = OMAP_DSS_CHANNEL_LCD;
 			break;
 		case 1:
 			mgr->name = "tv";
 			mgr->id = OMAP_DSS_CHANNEL_DIGIT;
 			break;
 		case 2:
 			mgr->name = "lcd2";
 			mgr->id = OMAP_DSS_CHANNEL_LCD2;
 			break;
 		}

 		mgr->set_device = &dss_mgr_set_device;
 		mgr->unset_device = &dss_mgr_unset_device;
 		mgr->apply = &omap_dss_mgr_apply;
 		mgr->set_manager_info = &dss_mgr_set_info;
 		mgr->get_manager_info = &dss_mgr_get_info;
 		mgr->wait_for_go = &dss_mgr_wait_for_go;
 		mgr->wait_for_vsync = &dss_mgr_wait_for_vsync;

 		mgr->caps = 0;
 		mgr->supported_displays =
 			dss_feat_get_supported_displays(mgr->id);

 		INIT_LIST_HEAD(&mgr->overlays);

 		r = kobject_init_and_add(&mgr->kobj, &manager_ktype,
 				&pdev->dev.kobj, "manager%d", i);

 		if (r)
 			DSSERR("failed to create sysfs file\n");
 	}

 	return 0;
 }

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

 	for (i = 0; i < num_managers; ++i) {
 		struct omap_overlay_manager *mgr = &managers[i];

 		kobject_del(&mgr->kobj);
 		kobject_put(&mgr->kobj);
 	}

 	kfree(managers);
 	managers = NULL;
 	num_managers = 0;
 }

 int omap_dss_get_num_overlay_managers(void)
 {
 	return num_managers;
 }
 EXPORT_SYMBOL(omap_dss_get_num_overlay_managers);

 struct omap_overlay_manager *omap_dss_get_overlay_manager(int num)
 {
 	if (num >= num_managers)
 		return NULL;

 	return &managers[num];
 }
 EXPORT_SYMBOL(omap_dss_get_overlay_manager);

 int dss_mgr_simple_check(struct omap_overlay_manager *mgr,
 		const struct omap_overlay_manager_info *info)
 {
 	if (dss_has_feature(FEAT_ALPHA_FIXED_ZORDER)) {
 		/*
 		 * OMAP3 supports only graphics source transparency color key
 		 * and alpha blending simultaneously. See TRM 15.4.2.4.2.2
 		 * Alpha Mode.
 		 */
 		if (info->partial_alpha_enabled && info->trans_enabled
 			&& info->trans_key_type != OMAP_DSS_COLOR_KEY_GFX_DST) {
 			DSSERR("check_manager: illegal transparency key\n");
 			return -EINVAL;
 		}
 	}

 	return 0;
 }

 static int dss_mgr_check_zorder(struct omap_overlay_manager *mgr,
 		struct omap_overlay_info **overlay_infos)
 {
 	struct omap_overlay *ovl1, *ovl2;
 	struct omap_overlay_info *info1, *info2;

 	list_for_each_entry(ovl1, &mgr->overlays, list) {
 		info1 = overlay_infos[ovl1->id];

 		if (info1 == NULL)
 			continue;

 		list_for_each_entry(ovl2, &mgr->overlays, list) {
 			if (ovl1 == ovl2)
 				continue;

 			info2 = overlay_infos[ovl2->id];

 			if (info2 == NULL)
 				continue;

 			if (info1->zorder == info2->zorder) {
 				DSSERR("overlays %d and %d have the same "
 						"zorder %d\n",
 					ovl1->id, ovl2->id, info1->zorder);
 				return -EINVAL;
 			}
 		}
 	}

 	return 0;
 }

 int dss_mgr_check_timings(struct omap_overlay_manager *mgr,
 		const struct omap_video_timings *timings)
 {
 	if (!dispc_mgr_timings_ok(mgr->id, timings)) {
 		DSSERR("check_manager: invalid timings\n");
 		return -EINVAL;
 	}

 	return 0;
 }

 int dss_mgr_check(struct omap_overlay_manager *mgr,
 		struct omap_overlay_manager_info *info,
 		const struct omap_video_timings *mgr_timings,
 		struct omap_overlay_info **overlay_infos)
 {
 	struct omap_overlay *ovl;
 	int r;

 	if (dss_has_feature(FEAT_ALPHA_FREE_ZORDER)) {
 		r = dss_mgr_check_zorder(mgr, overlay_infos);
 		if (r)
 			return r;
 	}

 	r = dss_mgr_check_timings(mgr, mgr_timings);
 	if (r)
 		return r;

 	list_for_each_entry(ovl, &mgr->overlays, list) {
 		struct omap_overlay_info *oi;
 		int r;

 		oi = overlay_infos[ovl->id];

 		if (oi == NULL)
 			continue;

 		r = dss_ovl_check(ovl, oi, mgr_timings);
 		if (r)
 			return r;
 	}

 	return 0;
 }
	/*
	* linux/drivers/video/omap2/dss/manager.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 "MANAGER"

	#include <linux/kernel.h>
	#include <linux/slab.h>
	#include <linux/module.h>
	#include <linux/platform_device.h>
	#include <linux/jiffies.h>

	#include <video/omapdss.h>

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

	static int num_managers;
	static struct omap_overlay_manager *managers;

	static ssize_t manager_name_show(struct omap_overlay_manager mgr, char buf)
	{
	return snprintf(buf, PAGE_SIZE, "%s\n", mgr->name);
	}

	static ssize_t manager_display_show(struct omap_overlay_manager mgr, char buf)
	{
	return snprintf(buf, PAGE_SIZE, "%s\n",
	mgr->device ? mgr->device->name : "<none>");
	}

	static ssize_t manager_display_store(struct omap_overlay_manager *mgr,
	const char *buf, size_t size)
	{
	int r = 0;
	size_t len = size;
	struct omap_dss_device *dssdev = NULL;

	int match(struct omap_dss_device dssdev, void data)
	{
	const char *str = data;
	return sysfs_streq(dssdev->name, str);
	}

	if (buf[size-1] == '\n')
	--len;

	if (len > 0)
	dssdev = omap_dss_find_device((void *)buf, match);

	if (len > 0 && dssdev == NULL)
	return -EINVAL;

	if (dssdev)
	DSSDBG("display %s found\n", dssdev->name);

	if (mgr->device) {
	r = mgr->unset_device(mgr);
	if (r) {
	DSSERR("failed to unset display\n");
	goto put_device;
	}
	}

	if (dssdev) {
	r = mgr->set_device(mgr, dssdev);
	if (r) {
	DSSERR("failed to set manager\n");
	goto put_device;
	}

	r = mgr->apply(mgr);
	if (r) {
	DSSERR("failed to apply dispc config\n");
	goto put_device;
	}
	}

	put_device:
	if (dssdev)
	omap_dss_put_device(dssdev);

	return r ? r : size;
	}

	static ssize_t manager_default_color_show(struct omap_overlay_manager *mgr,
	char *buf)
	{
	struct omap_overlay_manager_info info;

	mgr->get_manager_info(mgr, &info);

	return snprintf(buf, PAGE_SIZE, "%#x\n", info.default_color);
	}

	static ssize_t manager_default_color_store(struct omap_overlay_manager *mgr,
	const char *buf, size_t size)
	{
	struct omap_overlay_manager_info info;
	u32 color;
	int r;

	r = kstrtouint(buf, 0, &color);
	if (r)
	return r;

	mgr->get_manager_info(mgr, &info);

	info.default_color = color;

	r = mgr->set_manager_info(mgr, &info);
	if (r)
	return r;

	r = mgr->apply(mgr);
	if (r)
	return r;

	return size;
	}

	static const char *trans_key_type_str[] = {
	"gfx-destination",
	"video-source",
	};

	static ssize_t manager_trans_key_type_show(struct omap_overlay_manager *mgr,
	char *buf)
	{
	enum omap_dss_trans_key_type key_type;
	struct omap_overlay_manager_info info;

	mgr->get_manager_info(mgr, &info);

	key_type = info.trans_key_type;
	BUG_ON(key_type >= ARRAY_SIZE(trans_key_type_str));

	return snprintf(buf, PAGE_SIZE, "%s\n", trans_key_type_str[key_type]);
	}

	static ssize_t manager_trans_key_type_store(struct omap_overlay_manager *mgr,
	const char *buf, size_t size)
	{
	enum omap_dss_trans_key_type key_type;
	struct omap_overlay_manager_info info;
	int r;

	for (key_type = OMAP_DSS_COLOR_KEY_GFX_DST;
	key_type < ARRAY_SIZE(trans_key_type_str); key_type++) {
	if (sysfs_streq(buf, trans_key_type_str[key_type]))
	break;
	}

	if (key_type == ARRAY_SIZE(trans_key_type_str))
	return -EINVAL;

	mgr->get_manager_info(mgr, &info);

	info.trans_key_type = key_type;

	r = mgr->set_manager_info(mgr, &info);
	if (r)
	return r;

	r = mgr->apply(mgr);
	if (r)
	return r;

	return size;
	}

	static ssize_t manager_trans_key_value_show(struct omap_overlay_manager *mgr,
	char *buf)
	{
	struct omap_overlay_manager_info info;

	mgr->get_manager_info(mgr, &info);

	return snprintf(buf, PAGE_SIZE, "%#x\n", info.trans_key);
	}

	static ssize_t manager_trans_key_value_store(struct omap_overlay_manager *mgr,
	const char *buf, size_t size)
	{
	struct omap_overlay_manager_info info;
	u32 key_value;
	int r;

	r = kstrtouint(buf, 0, &key_value);
	if (r)
	return r;

	mgr->get_manager_info(mgr, &info);

	info.trans_key = key_value;

	r = mgr->set_manager_info(mgr, &info);
	if (r)
	return r;

	r = mgr->apply(mgr);
	if (r)
	return r;

	return size;
	}

	static ssize_t manager_trans_key_enabled_show(struct omap_overlay_manager *mgr,
	char *buf)
	{
	struct omap_overlay_manager_info info;

	mgr->get_manager_info(mgr, &info);

	return snprintf(buf, PAGE_SIZE, "%d\n", info.trans_enabled);
	}

	static ssize_t manager_trans_key_enabled_store(struct omap_overlay_manager *mgr,
	const char *buf, size_t size)
	{
	struct omap_overlay_manager_info info;
	bool enable;
	int r;

	r = strtobool(buf, &enable);
	if (r)
	return r;

	mgr->get_manager_info(mgr, &info);

	info.trans_enabled = enable;

	r = mgr->set_manager_info(mgr, &info);
	if (r)
	return r;

	r = mgr->apply(mgr);
	if (r)
	return r;

	return size;
	}

	static ssize_t manager_alpha_blending_enabled_show(
	struct omap_overlay_manager mgr, char buf)
	{
	struct omap_overlay_manager_info info;

	mgr->get_manager_info(mgr, &info);

	WARN_ON(!dss_has_feature(FEAT_ALPHA_FIXED_ZORDER));

	return snprintf(buf, PAGE_SIZE, "%d\n",
	info.partial_alpha_enabled);
	}

	static ssize_t manager_alpha_blending_enabled_store(
	struct omap_overlay_manager *mgr,
	const char *buf, size_t size)
	{
	struct omap_overlay_manager_info info;
	bool enable;
	int r;

	WARN_ON(!dss_has_feature(FEAT_ALPHA_FIXED_ZORDER));

	r = strtobool(buf, &enable);
	if (r)
	return r;

	mgr->get_manager_info(mgr, &info);

	info.partial_alpha_enabled = enable;

	r = mgr->set_manager_info(mgr, &info);
	if (r)
	return r;

	r = mgr->apply(mgr);
	if (r)
	return r;

	return size;
	}

	static ssize_t manager_cpr_enable_show(struct omap_overlay_manager *mgr,
	char *buf)
	{
	struct omap_overlay_manager_info info;

	mgr->get_manager_info(mgr, &info);

	return snprintf(buf, PAGE_SIZE, "%d\n", info.cpr_enable);
	}

	static ssize_t manager_cpr_enable_store(struct omap_overlay_manager *mgr,
	const char *buf, size_t size)
	{
	struct omap_overlay_manager_info info;
	int r;
	bool enable;

	if (!dss_has_feature(FEAT_CPR))
	return -ENODEV;

	r = strtobool(buf, &enable);
	if (r)
	return r;

	mgr->get_manager_info(mgr, &info);

	if (info.cpr_enable == enable)
	return size;

	info.cpr_enable = enable;

	r = mgr->set_manager_info(mgr, &info);
	if (r)
	return r;

	r = mgr->apply(mgr);
	if (r)
	return r;

	return size;
	}

	static ssize_t manager_cpr_coef_show(struct omap_overlay_manager *mgr,
	char *buf)
	{
	struct omap_overlay_manager_info info;

	mgr->get_manager_info(mgr, &info);

	return snprintf(buf, PAGE_SIZE,
	"%d %d %d %d %d %d %d %d %d\n",
	info.cpr_coefs.rr,
	info.cpr_coefs.rg,
	info.cpr_coefs.rb,
	info.cpr_coefs.gr,
	info.cpr_coefs.gg,
	info.cpr_coefs.gb,
	info.cpr_coefs.br,
	info.cpr_coefs.bg,
	info.cpr_coefs.bb);
	}

	static ssize_t manager_cpr_coef_store(struct omap_overlay_manager *mgr,
	const char *buf, size_t size)
	{
	struct omap_overlay_manager_info info;
	struct omap_dss_cpr_coefs coefs;
	int r, i;
	s16 *arr;

	if (!dss_has_feature(FEAT_CPR))
	return -ENODEV;

	if (sscanf(buf, "%hd %hd %hd %hd %hd %hd %hd %hd %hd",
	&coefs.rr, &coefs.rg, &coefs.rb,
	&coefs.gr, &coefs.gg, &coefs.gb,
	&coefs.br, &coefs.bg, &coefs.bb) != 9)
	return -EINVAL;

	arr = (s16[]){ coefs.rr, coefs.rg, coefs.rb,
	coefs.gr, coefs.gg, coefs.gb,
	coefs.br, coefs.bg, coefs.bb };

	for (i = 0; i < 9; ++i) {
	if (arr[i] < -512 \|\| arr[i] > 511)
	return -EINVAL;
	}

	mgr->get_manager_info(mgr, &info);

	info.cpr_coefs = coefs;

	r = mgr->set_manager_info(mgr, &info);
	if (r)
	return r;

	r = mgr->apply(mgr);
	if (r)
	return r;

	return size;
	}

	struct manager_attribute {
	struct attribute attr;
	ssize_t (show)(struct omap_overlay_manager , char *);
	ssize_t (store)(struct omap_overlay_manager , const char *, size_t);
	};

	#define MANAGER_ATTR(_name, _mode, _show, _store) \
	struct manager_attribute manager_attr_##_name = \
	__ATTR(_name, _mode, _show, _store)

	static MANAGER_ATTR(name, S_IRUGO, manager_name_show, NULL);
	static MANAGER_ATTR(display, S_IRUGO\|S_IWUSR,
	manager_display_show, manager_display_store);
	static MANAGER_ATTR(default_color, S_IRUGO\|S_IWUSR,
	manager_default_color_show, manager_default_color_store);
	static MANAGER_ATTR(trans_key_type, S_IRUGO\|S_IWUSR,
	manager_trans_key_type_show, manager_trans_key_type_store);
	static MANAGER_ATTR(trans_key_value, S_IRUGO\|S_IWUSR,
	manager_trans_key_value_show, manager_trans_key_value_store);
	static MANAGER_ATTR(trans_key_enabled, S_IRUGO\|S_IWUSR,
	manager_trans_key_enabled_show,
	manager_trans_key_enabled_store);
	static MANAGER_ATTR(alpha_blending_enabled, S_IRUGO\|S_IWUSR,
	manager_alpha_blending_enabled_show,
	manager_alpha_blending_enabled_store);
	static MANAGER_ATTR(cpr_enable, S_IRUGO\|S_IWUSR,
	manager_cpr_enable_show,
	manager_cpr_enable_store);
	static MANAGER_ATTR(cpr_coef, S_IRUGO\|S_IWUSR,
	manager_cpr_coef_show,
	manager_cpr_coef_store);


	static struct attribute *manager_sysfs_attrs[] = {
	&manager_attr_name.attr,
	&manager_attr_display.attr,
	&manager_attr_default_color.attr,
	&manager_attr_trans_key_type.attr,
	&manager_attr_trans_key_value.attr,
	&manager_attr_trans_key_enabled.attr,
	&manager_attr_alpha_blending_enabled.attr,
	&manager_attr_cpr_enable.attr,
	&manager_attr_cpr_coef.attr,
	NULL
	};

	static ssize_t manager_attr_show(struct kobject kobj, struct attribute attr,
	char *buf)
	{
	struct omap_overlay_manager *manager;
	struct manager_attribute *manager_attr;

	manager = container_of(kobj, struct omap_overlay_manager, kobj);
	manager_attr = container_of(attr, struct manager_attribute, attr);

	if (!manager_attr->show)
	return -ENOENT;

	return manager_attr->show(manager, buf);
	}

	static ssize_t manager_attr_store(struct kobject kobj, struct attribute attr,
	const char *buf, size_t size)
	{
	struct omap_overlay_manager *manager;
	struct manager_attribute *manager_attr;

	manager = container_of(kobj, struct omap_overlay_manager, kobj);
	manager_attr = container_of(attr, struct manager_attribute, attr);

	if (!manager_attr->store)
	return -ENOENT;

	return manager_attr->store(manager, buf, size);
	}

	static const struct sysfs_ops manager_sysfs_ops = {
	.show = manager_attr_show,
	.store = manager_attr_store,
	};

	static struct kobj_type manager_ktype = {
	.sysfs_ops = &manager_sysfs_ops,
	.default_attrs = manager_sysfs_attrs,
	};

	static int dss_mgr_wait_for_vsync(struct omap_overlay_manager *mgr)
	{
	unsigned long timeout = msecs_to_jiffies(500);
	u32 irq;
	int r;

	r = dispc_runtime_get();
	if (r)
	return r;

	if (mgr->device->type == OMAP_DISPLAY_TYPE_VENC)
	irq = DISPC_IRQ_EVSYNC_ODD;
	else if (mgr->device->type == OMAP_DISPLAY_TYPE_HDMI)
	irq = DISPC_IRQ_EVSYNC_EVEN;
	else
	irq = dispc_mgr_get_vsync_irq(mgr->id);

	r = omap_dispc_wait_for_irq_interruptible_timeout(irq, timeout);

	dispc_runtime_put();

	return r;
	}

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

	num_managers = dss_feat_get_num_mgrs();

	managers = kzalloc(sizeof(struct omap_overlay_manager) * num_managers,
	GFP_KERNEL);

	BUG_ON(managers == NULL);

	for (i = 0; i < num_managers; ++i) {
	struct omap_overlay_manager *mgr = &managers[i];

	switch (i) {
	case 0:
	mgr->name = "lcd";
	mgr->id = OMAP_DSS_CHANNEL_LCD;
	break;
	case 1:
	mgr->name = "tv";
	mgr->id = OMAP_DSS_CHANNEL_DIGIT;
	break;
	case 2:
	mgr->name = "lcd2";
	mgr->id = OMAP_DSS_CHANNEL_LCD2;
	break;
	}

	mgr->set_device = &dss_mgr_set_device;
	mgr->unset_device = &dss_mgr_unset_device;
	mgr->apply = &omap_dss_mgr_apply;
	mgr->set_manager_info = &dss_mgr_set_info;
	mgr->get_manager_info = &dss_mgr_get_info;
	mgr->wait_for_go = &dss_mgr_wait_for_go;
	mgr->wait_for_vsync = &dss_mgr_wait_for_vsync;

	mgr->caps = 0;
	mgr->supported_displays =
	dss_feat_get_supported_displays(mgr->id);

	INIT_LIST_HEAD(&mgr->overlays);

	r = kobject_init_and_add(&mgr->kobj, &manager_ktype,
	&pdev->dev.kobj, "manager%d", i);

	if (r)
	DSSERR("failed to create sysfs file\n");
	}

	return 0;
	}

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

	for (i = 0; i < num_managers; ++i) {
	struct omap_overlay_manager *mgr = &managers[i];

	kobject_del(&mgr->kobj);
	kobject_put(&mgr->kobj);
	}

	kfree(managers);
	managers = NULL;
	num_managers = 0;
	}

	int omap_dss_get_num_overlay_managers(void)
	{
	return num_managers;
	}
	EXPORT_SYMBOL(omap_dss_get_num_overlay_managers);

	struct omap_overlay_manager *omap_dss_get_overlay_manager(int num)
	{
	if (num >= num_managers)
	return NULL;

	return &managers[num];
	}
	EXPORT_SYMBOL(omap_dss_get_overlay_manager);

	int dss_mgr_simple_check(struct omap_overlay_manager *mgr,
	const struct omap_overlay_manager_info *info)
	{
	if (dss_has_feature(FEAT_ALPHA_FIXED_ZORDER)) {
	/*
	* OMAP3 supports only graphics source transparency color key
	* and alpha blending simultaneously. See TRM 15.4.2.4.2.2
	* Alpha Mode.
	*/
	if (info->partial_alpha_enabled && info->trans_enabled
	&& info->trans_key_type != OMAP_DSS_COLOR_KEY_GFX_DST) {
	DSSERR("check_manager: illegal transparency key\n");
	return -EINVAL;
	}
	}

	return 0;
	}

	static int dss_mgr_check_zorder(struct omap_overlay_manager *mgr,
	struct omap_overlay_info **overlay_infos)
	{
	struct omap_overlay ovl1, ovl2;
	struct omap_overlay_info info1, info2;

	list_for_each_entry(ovl1, &mgr->overlays, list) {
	info1 = overlay_infos[ovl1->id];

	if (info1 == NULL)
	continue;

	list_for_each_entry(ovl2, &mgr->overlays, list) {
	if (ovl1 == ovl2)
	continue;

	info2 = overlay_infos[ovl2->id];

	if (info2 == NULL)
	continue;

	if (info1->zorder == info2->zorder) {
	DSSERR("overlays %d and %d have the same "
	"zorder %d\n",
	ovl1->id, ovl2->id, info1->zorder);
	return -EINVAL;
	}
	}
	}

	return 0;
	}

	int dss_mgr_check_timings(struct omap_overlay_manager *mgr,
	const struct omap_video_timings *timings)
	{
	if (!dispc_mgr_timings_ok(mgr->id, timings)) {
	DSSERR("check_manager: invalid timings\n");
	return -EINVAL;
	}

	return 0;
	}

	int dss_mgr_check(struct omap_overlay_manager *mgr,
	struct omap_overlay_manager_info *info,
	const struct omap_video_timings *mgr_timings,
	struct omap_overlay_info **overlay_infos)
	{
	struct omap_overlay *ovl;
	int r;

	if (dss_has_feature(FEAT_ALPHA_FREE_ZORDER)) {
	r = dss_mgr_check_zorder(mgr, overlay_infos);
	if (r)
	return r;
	}

	r = dss_mgr_check_timings(mgr, mgr_timings);
	if (r)
	return r;

	list_for_each_entry(ovl, &mgr->overlays, list) {
	struct omap_overlay_info *oi;
	int r;

	oi = overlay_infos[ovl->id];

	if (oi == NULL)
	continue;

	r = dss_ovl_check(ovl, oi, mgr_timings);
	if (r)
	return r;
	}

	return 0;
	}