[deliverable/linux.git] / drivers / video / fbdev / omap2 / dss / display-sysfs.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 "DISPLAY"

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

#include <video/omapdss.h>
#include "dss.h"

static ssize_t display_name_show(struct omap_dss_device *dssdev, char *buf)
{
	return snprintf(buf, PAGE_SIZE, "%s\n",
			dssdev->name ?
			dssdev->name : "");
}

static ssize_t display_enabled_show(struct omap_dss_device *dssdev, char *buf)
{
	return snprintf(buf, PAGE_SIZE, "%d\n",
			omapdss_device_is_enabled(dssdev));
}

static ssize_t display_enabled_store(struct omap_dss_device *dssdev,
		const char *buf, size_t size)
{
	int r;
	bool enable;

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

	if (enable == omapdss_device_is_enabled(dssdev))
		return size;

	if (omapdss_device_is_connected(dssdev) == false)
		return -ENODEV;

	if (enable) {
		r = dssdev->driver->enable(dssdev);
		if (r)
			return r;
	} else {
		dssdev->driver->disable(dssdev);
	}

	return size;
}

static ssize_t display_tear_show(struct omap_dss_device *dssdev, char *buf)
{
	return snprintf(buf, PAGE_SIZE, "%d\n",
			dssdev->driver->get_te ?
			dssdev->driver->get_te(dssdev) : 0);
}

static ssize_t display_tear_store(struct omap_dss_device *dssdev,
	const char *buf, size_t size)
{
	int r;
	bool te;

	if (!dssdev->driver->enable_te || !dssdev->driver->get_te)
		return -ENOENT;

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

	r = dssdev->driver->enable_te(dssdev, te);
	if (r)
		return r;

	return size;
}

static ssize_t display_timings_show(struct omap_dss_device *dssdev, char *buf)
{
	struct omap_video_timings t;

	if (!dssdev->driver->get_timings)
		return -ENOENT;

	dssdev->driver->get_timings(dssdev, &t);

	return snprintf(buf, PAGE_SIZE, "%u,%u/%u/%u/%u,%u/%u/%u/%u\n",
			t.pixelclock,
			t.x_res, t.hfp, t.hbp, t.hsw,
			t.y_res, t.vfp, t.vbp, t.vsw);
}

static ssize_t display_timings_store(struct omap_dss_device *dssdev,
	const char *buf, size_t size)
{
	struct omap_video_timings t = dssdev->panel.timings;
	int r, found;

	if (!dssdev->driver->set_timings || !dssdev->driver->check_timings)
		return -ENOENT;

	found = 0;
#ifdef CONFIG_OMAP2_DSS_VENC
	if (strncmp("pal", buf, 3) == 0) {
		t = omap_dss_pal_timings;
		found = 1;
	} else if (strncmp("ntsc", buf, 4) == 0) {
		t = omap_dss_ntsc_timings;
		found = 1;
	}
#endif
	if (!found && sscanf(buf, "%u,%hu/%hu/%hu/%hu,%hu/%hu/%hu/%hu",
				&t.pixelclock,
				&t.x_res, &t.hfp, &t.hbp, &t.hsw,
				&t.y_res, &t.vfp, &t.vbp, &t.vsw) != 9)
		return -EINVAL;

	r = dssdev->driver->check_timings(dssdev, &t);
	if (r)
		return r;

	dssdev->driver->disable(dssdev);
	dssdev->driver->set_timings(dssdev, &t);
	r = dssdev->driver->enable(dssdev);
	if (r)
		return r;

	return size;
}

static ssize_t display_rotate_show(struct omap_dss_device *dssdev, char *buf)
{
	int rotate;
	if (!dssdev->driver->get_rotate)
		return -ENOENT;
	rotate = dssdev->driver->get_rotate(dssdev);
	return snprintf(buf, PAGE_SIZE, "%u\n", rotate);
}

static ssize_t display_rotate_store(struct omap_dss_device *dssdev,
	const char *buf, size_t size)
{
	int rot, r;

	if (!dssdev->driver->set_rotate || !dssdev->driver->get_rotate)
		return -ENOENT;

	r = kstrtoint(buf, 0, &rot);
	if (r)
		return r;

	r = dssdev->driver->set_rotate(dssdev, rot);
	if (r)
		return r;

	return size;
}

static ssize_t display_mirror_show(struct omap_dss_device *dssdev, char *buf)
{
	int mirror;
	if (!dssdev->driver->get_mirror)
		return -ENOENT;
	mirror = dssdev->driver->get_mirror(dssdev);
	return snprintf(buf, PAGE_SIZE, "%u\n", mirror);
}

static ssize_t display_mirror_store(struct omap_dss_device *dssdev,
	const char *buf, size_t size)
{
	int r;
	bool mirror;

	if (!dssdev->driver->set_mirror || !dssdev->driver->get_mirror)
		return -ENOENT;

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

	r = dssdev->driver->set_mirror(dssdev, mirror);
	if (r)
		return r;

	return size;
}

static ssize_t display_wss_show(struct omap_dss_device *dssdev, char *buf)
{
	unsigned int wss;

	if (!dssdev->driver->get_wss)
		return -ENOENT;

	wss = dssdev->driver->get_wss(dssdev);

	return snprintf(buf, PAGE_SIZE, "0x%05x\n", wss);
}

static ssize_t display_wss_store(struct omap_dss_device *dssdev,
	const char *buf, size_t size)
{
	u32 wss;
	int r;

	if (!dssdev->driver->get_wss || !dssdev->driver->set_wss)
		return -ENOENT;

	r = kstrtou32(buf, 0, &wss);
	if (r)
		return r;

	if (wss > 0xfffff)
		return -EINVAL;

	r = dssdev->driver->set_wss(dssdev, wss);
	if (r)
		return r;

	return size;
}

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

#define DISPLAY_ATTR(_name, _mode, _show, _store) \
	struct display_attribute display_attr_##_name = \
	__ATTR(_name, _mode, _show, _store)

static DISPLAY_ATTR(name, S_IRUGO, display_name_show, NULL);
static DISPLAY_ATTR(display_name, S_IRUGO, display_name_show, NULL);
static DISPLAY_ATTR(enabled, S_IRUGO|S_IWUSR,
		display_enabled_show, display_enabled_store);
static DISPLAY_ATTR(tear_elim, S_IRUGO|S_IWUSR,
		display_tear_show, display_tear_store);
static DISPLAY_ATTR(timings, S_IRUGO|S_IWUSR,
		display_timings_show, display_timings_store);
static DISPLAY_ATTR(rotate, S_IRUGO|S_IWUSR,
		display_rotate_show, display_rotate_store);
static DISPLAY_ATTR(mirror, S_IRUGO|S_IWUSR,
		display_mirror_show, display_mirror_store);
static DISPLAY_ATTR(wss, S_IRUGO|S_IWUSR,
		display_wss_show, display_wss_store);

static struct attribute *display_sysfs_attrs[] = {
	&display_attr_name.attr,
	&display_attr_display_name.attr,
	&display_attr_enabled.attr,
	&display_attr_tear_elim.attr,
	&display_attr_timings.attr,
	&display_attr_rotate.attr,
	&display_attr_mirror.attr,
	&display_attr_wss.attr,
	NULL
};

static ssize_t display_attr_show(struct kobject *kobj, struct attribute *attr,
		char *buf)
{
	struct omap_dss_device *dssdev;
	struct display_attribute *display_attr;

	dssdev = container_of(kobj, struct omap_dss_device, kobj);
	display_attr = container_of(attr, struct display_attribute, attr);

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

	return display_attr->show(dssdev, buf);
}

static ssize_t display_attr_store(struct kobject *kobj, struct attribute *attr,
		const char *buf, size_t size)
{
	struct omap_dss_device *dssdev;
	struct display_attribute *display_attr;

	dssdev = container_of(kobj, struct omap_dss_device, kobj);
	display_attr = container_of(attr, struct display_attribute, attr);

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

	return display_attr->store(dssdev, buf, size);
}

static const struct sysfs_ops display_sysfs_ops = {
	.show = display_attr_show,
	.store = display_attr_store,
};

static struct kobj_type display_ktype = {
	.sysfs_ops = &display_sysfs_ops,
	.default_attrs = display_sysfs_attrs,
};

int display_init_sysfs(struct platform_device *pdev)
{
	struct omap_dss_device *dssdev = NULL;
	int r;

	for_each_dss_dev(dssdev) {
		r = kobject_init_and_add(&dssdev->kobj, &display_ktype,
			&pdev->dev.kobj, dssdev->alias);
		if (r) {
			DSSERR("failed to create sysfs files\n");
			omap_dss_put_device(dssdev);
			goto err;
		}
	}

	return 0;

err:
	display_uninit_sysfs(pdev);

	return r;
}

void display_uninit_sysfs(struct platform_device *pdev)
{
	struct omap_dss_device *dssdev = NULL;

	for_each_dss_dev(dssdev) {
		if (kobject_name(&dssdev->kobj) == NULL)
			continue;

		kobject_del(&dssdev->kobj);
		kobject_put(&dssdev->kobj);

		memset(&dssdev->kobj, 0, sizeof(dssdev->kobj));
	}
}
Commit	Line	Data
3f30b8c2 TV	1	/*
	2	* Copyright (C) 2009 Nokia Corporation
	3	* Author: Tomi Valkeinen <tomi.valkeinen@nokia.com>
	4	*
	5	* Some code and ideas taken from drivers/video/omap/ driver
	6	* by Imre Deak.
	7	*
	8	* This program is free software; you can redistribute it and/or modify it
	9	* under the terms of the GNU General Public License version 2 as published by
	10	* the Free Software Foundation.
	11	*
	12	* This program is distributed in the hope that it will be useful, but WITHOUT
	13	* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
	14	* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
	15	* more details.
	16	*
	17	* You should have received a copy of the GNU General Public License along with
	18	* this program. If not, see <http://www.gnu.org/licenses/>.
	19	*/
	20
	21	#define DSS_SUBSYS_NAME "DISPLAY"
	22
	23	#include <linux/kernel.h>
	24	#include <linux/module.h>
3f30b8c2	25	#include <linux/platform_device.h>
94140f0d	26	#include <linux/sysfs.h>
3f30b8c2 TV	27
	28	#include <video/omapdss.h>
	29	#include "dss.h"
94140f0d	30
a38bb793	31	static ssize_t display_name_show(struct omap_dss_device dssdev, char buf)
94140f0d	32	{
94140f0d TV	33	return snprintf(buf, PAGE_SIZE, "%s\n",
	34	dssdev->name ?
	35	dssdev->name : "");
	36	}
3f30b8c2	37
a38bb793	38	static ssize_t display_enabled_show(struct omap_dss_device dssdev, char buf)
3f30b8c2	39	{
a7e71e7f TV	40	return snprintf(buf, PAGE_SIZE, "%d\n",
a7e71e7f TV	41	omapdss_device_is_enabled(dssdev));
3f30b8c2 TV	42	}
3f30b8c2 TV	43
a38bb793	44	static ssize_t display_enabled_store(struct omap_dss_device *dssdev,
3f30b8c2 TV	45	const char *buf, size_t size)
3f30b8c2 TV	46	{
3f30b8c2	47	int r;
a7e71e7f	48	bool enable;
3f30b8c2	49
a7e71e7f	50	r = strtobool(buf, &enable);
3f30b8c2 TV	51	if (r)
	52	return r;
	53
a7e71e7f TV	54	if (enable == omapdss_device_is_enabled(dssdev))
	55	return size;
	56
	57	if (omapdss_device_is_connected(dssdev) == false)
	58	return -ENODEV;
	59
	60	if (enable) {
	61	r = dssdev->driver->enable(dssdev);
	62	if (r)
	63	return r;
	64	} else {
	65	dssdev->driver->disable(dssdev);
3f30b8c2 TV	66	}
	67
	68	return size;
	69	}
	70
a38bb793	71	static ssize_t display_tear_show(struct omap_dss_device dssdev, char buf)
3f30b8c2	72	{
3f30b8c2 TV	73	return snprintf(buf, PAGE_SIZE, "%d\n",
	74	dssdev->driver->get_te ?
	75	dssdev->driver->get_te(dssdev) : 0);
	76	}
	77
a38bb793 TV	78	static ssize_t display_tear_store(struct omap_dss_device *dssdev,
a38bb793 TV	79	const char *buf, size_t size)
3f30b8c2	80	{
3f30b8c2 TV	81	int r;
	82	bool te;
	83
	84	if (!dssdev->driver->enable_te \|\| !dssdev->driver->get_te)
	85	return -ENOENT;
	86
	87	r = strtobool(buf, &te);
	88	if (r)
	89	return r;
	90
	91	r = dssdev->driver->enable_te(dssdev, te);
	92	if (r)
	93	return r;
	94
	95	return size;
	96	}
	97
a38bb793	98	static ssize_t display_timings_show(struct omap_dss_device dssdev, char buf)
3f30b8c2	99	{
3f30b8c2 TV	100	struct omap_video_timings t;
	101
	102	if (!dssdev->driver->get_timings)
	103	return -ENOENT;
	104
	105	dssdev->driver->get_timings(dssdev, &t);
	106
	107	return snprintf(buf, PAGE_SIZE, "%u,%u/%u/%u/%u,%u/%u/%u/%u\n",
d8d78941	108	t.pixelclock,
3f30b8c2 TV	109	t.x_res, t.hfp, t.hbp, t.hsw,
	110	t.y_res, t.vfp, t.vbp, t.vsw);
	111	}
	112
a38bb793 TV	113	static ssize_t display_timings_store(struct omap_dss_device *dssdev,
a38bb793 TV	114	const char *buf, size_t size)
3f30b8c2	115	{
3f30b8c2 TV	116	struct omap_video_timings t = dssdev->panel.timings;
	117	int r, found;
	118
	119	if (!dssdev->driver->set_timings \|\| !dssdev->driver->check_timings)
	120	return -ENOENT;
	121
	122	found = 0;
	123	#ifdef CONFIG_OMAP2_DSS_VENC
	124	if (strncmp("pal", buf, 3) == 0) {
	125	t = omap_dss_pal_timings;
	126	found = 1;
	127	} else if (strncmp("ntsc", buf, 4) == 0) {
	128	t = omap_dss_ntsc_timings;
	129	found = 1;
	130	}
	131	#endif
	132	if (!found && sscanf(buf, "%u,%hu/%hu/%hu/%hu,%hu/%hu/%hu/%hu",
d8d78941	133	&t.pixelclock,
3f30b8c2 TV	134	&t.x_res, &t.hfp, &t.hbp, &t.hsw,
	135	&t.y_res, &t.vfp, &t.vbp, &t.vsw) != 9)
	136	return -EINVAL;
	137
	138	r = dssdev->driver->check_timings(dssdev, &t);
	139	if (r)
	140	return r;
	141
	142	dssdev->driver->disable(dssdev);
	143	dssdev->driver->set_timings(dssdev, &t);
	144	r = dssdev->driver->enable(dssdev);
	145	if (r)
	146	return r;
	147
	148	return size;
	149	}
	150
a38bb793	151	static ssize_t display_rotate_show(struct omap_dss_device dssdev, char buf)
3f30b8c2	152	{
3f30b8c2 TV	153	int rotate;
	154	if (!dssdev->driver->get_rotate)
	155	return -ENOENT;
	156	rotate = dssdev->driver->get_rotate(dssdev);
	157	return snprintf(buf, PAGE_SIZE, "%u\n", rotate);
	158	}
	159
a38bb793 TV	160	static ssize_t display_rotate_store(struct omap_dss_device *dssdev,
a38bb793 TV	161	const char *buf, size_t size)
3f30b8c2	162	{
3f30b8c2 TV	163	int rot, r;
	164
	165	if (!dssdev->driver->set_rotate \|\| !dssdev->driver->get_rotate)
	166	return -ENOENT;
	167
	168	r = kstrtoint(buf, 0, &rot);
	169	if (r)
	170	return r;
	171
	172	r = dssdev->driver->set_rotate(dssdev, rot);
	173	if (r)
	174	return r;
	175
	176	return size;
	177	}
	178
a38bb793	179	static ssize_t display_mirror_show(struct omap_dss_device dssdev, char buf)
3f30b8c2	180	{
3f30b8c2 TV	181	int mirror;
	182	if (!dssdev->driver->get_mirror)
	183	return -ENOENT;
	184	mirror = dssdev->driver->get_mirror(dssdev);
	185	return snprintf(buf, PAGE_SIZE, "%u\n", mirror);
	186	}
	187
a38bb793 TV	188	static ssize_t display_mirror_store(struct omap_dss_device *dssdev,
a38bb793 TV	189	const char *buf, size_t size)
3f30b8c2	190	{
3f30b8c2 TV	191	int r;
	192	bool mirror;
	193
	194	if (!dssdev->driver->set_mirror \|\| !dssdev->driver->get_mirror)
	195	return -ENOENT;
	196
	197	r = strtobool(buf, &mirror);
	198	if (r)
	199	return r;
	200
	201	r = dssdev->driver->set_mirror(dssdev, mirror);
	202	if (r)
	203	return r;
	204
	205	return size;
	206	}
	207
a38bb793	208	static ssize_t display_wss_show(struct omap_dss_device dssdev, char buf)
3f30b8c2	209	{
3f30b8c2 TV	210	unsigned int wss;
	211
	212	if (!dssdev->driver->get_wss)
	213	return -ENOENT;
	214
	215	wss = dssdev->driver->get_wss(dssdev);
	216
	217	return snprintf(buf, PAGE_SIZE, "0x%05x\n", wss);
	218	}
	219
a38bb793 TV	220	static ssize_t display_wss_store(struct omap_dss_device *dssdev,
a38bb793 TV	221	const char *buf, size_t size)
3f30b8c2	222	{
3f30b8c2 TV	223	u32 wss;
	224	int r;
	225
	226	if (!dssdev->driver->get_wss \|\| !dssdev->driver->set_wss)
	227	return -ENOENT;
	228
	229	r = kstrtou32(buf, 0, &wss);
	230	if (r)
	231	return r;
	232
	233	if (wss > 0xfffff)
	234	return -EINVAL;
	235
	236	r = dssdev->driver->set_wss(dssdev, wss);
	237	if (r)
	238	return r;
	239
	240	return size;
	241	}
	242
a38bb793 TV	243	struct display_attribute {
	244	struct attribute attr;
	245	ssize_t (show)(struct omap_dss_device , char *);
	246	ssize_t (store)(struct omap_dss_device , const char *, size_t);
	247	};
	248
	249	#define DISPLAY_ATTR(_name, _mode, _show, _store) \
	250	struct display_attribute display_attr_##_name = \
	251	__ATTR(_name, _mode, _show, _store)
	252
	253	static DISPLAY_ATTR(name, S_IRUGO, display_name_show, NULL);
	254	static DISPLAY_ATTR(display_name, S_IRUGO, display_name_show, NULL);
	255	static DISPLAY_ATTR(enabled, S_IRUGO\|S_IWUSR,
3f30b8c2	256	display_enabled_show, display_enabled_store);
a38bb793	257	static DISPLAY_ATTR(tear_elim, S_IRUGO\|S_IWUSR,
3f30b8c2	258	display_tear_show, display_tear_store);
a38bb793	259	static DISPLAY_ATTR(timings, S_IRUGO\|S_IWUSR,
3f30b8c2	260	display_timings_show, display_timings_store);
a38bb793	261	static DISPLAY_ATTR(rotate, S_IRUGO\|S_IWUSR,
3f30b8c2	262	display_rotate_show, display_rotate_store);
a38bb793	263	static DISPLAY_ATTR(mirror, S_IRUGO\|S_IWUSR,
3f30b8c2	264	display_mirror_show, display_mirror_store);
a38bb793	265	static DISPLAY_ATTR(wss, S_IRUGO\|S_IWUSR,
3f30b8c2 TV	266	display_wss_show, display_wss_store);
3f30b8c2 TV	267
a38bb793 TV	268	static struct attribute *display_sysfs_attrs[] = {
	269	&display_attr_name.attr,
	270	&display_attr_display_name.attr,
	271	&display_attr_enabled.attr,
	272	&display_attr_tear_elim.attr,
	273	&display_attr_timings.attr,
	274	&display_attr_rotate.attr,
	275	&display_attr_mirror.attr,
	276	&display_attr_wss.attr,
3f30b8c2 TV	277	NULL
	278	};
	279
a38bb793 TV	280	static ssize_t display_attr_show(struct kobject kobj, struct attribute attr,
	281	char *buf)
	282	{
	283	struct omap_dss_device *dssdev;
	284	struct display_attribute *display_attr;
	285
	286	dssdev = container_of(kobj, struct omap_dss_device, kobj);
	287	display_attr = container_of(attr, struct display_attribute, attr);
	288
	289	if (!display_attr->show)
	290	return -ENOENT;
	291
	292	return display_attr->show(dssdev, buf);
	293	}
	294
	295	static ssize_t display_attr_store(struct kobject kobj, struct attribute attr,
	296	const char *buf, size_t size)
	297	{
	298	struct omap_dss_device *dssdev;
	299	struct display_attribute *display_attr;
	300
	301	dssdev = container_of(kobj, struct omap_dss_device, kobj);
	302	display_attr = container_of(attr, struct display_attribute, attr);
	303
	304	if (!display_attr->store)
	305	return -ENOENT;
	306
	307	return display_attr->store(dssdev, buf, size);
	308	}
	309
	310	static const struct sysfs_ops display_sysfs_ops = {
	311	.show = display_attr_show,
	312	.store = display_attr_store,
	313	};
	314
	315	static struct kobj_type display_ktype = {
	316	.sysfs_ops = &display_sysfs_ops,
	317	.default_attrs = display_sysfs_attrs,
	318	};
	319
94140f0d	320	int display_init_sysfs(struct platform_device *pdev)
3f30b8c2	321	{
94140f0d TV	322	struct omap_dss_device *dssdev = NULL;
94140f0d TV	323	int r;
3f30b8c2	324
94140f0d	325	for_each_dss_dev(dssdev) {
a38bb793 TV	326	r = kobject_init_and_add(&dssdev->kobj, &display_ktype,
a38bb793 TV	327	&pdev->dev.kobj, dssdev->alias);
94140f0d TV	328	if (r) {
94140f0d TV	329	DSSERR("failed to create sysfs files\n");
a38bb793	330	omap_dss_put_device(dssdev);
94140f0d TV	331	goto err;
94140f0d TV	332	}
3f30b8c2 TV	333	}
	334
	335	return 0;
94140f0d TV	336
	337	err:
	338	display_uninit_sysfs(pdev);
	339
	340	return r;
3f30b8c2 TV	341	}
3f30b8c2 TV	342
94140f0d	343	void display_uninit_sysfs(struct platform_device *pdev)
3f30b8c2	344	{
94140f0d	345	struct omap_dss_device *dssdev = NULL;
3f30b8c2	346
94140f0d	347	for_each_dss_dev(dssdev) {
a38bb793 TV	348	if (kobject_name(&dssdev->kobj) == NULL)
	349	continue;
	350
	351	kobject_del(&dssdev->kobj);
	352	kobject_put(&dssdev->kobj);
	353
	354	memset(&dssdev->kobj, 0, sizeof(dssdev->kobj));
94140f0d	355	}
3f30b8c2	356	}