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