OMAP: DSS2: string parsing cleanups
[pandora-kernel.git] / drivers / video / omap2 / dss / display.c
1 /*
2  * linux/drivers/video/omap2/dss/display.c
3  *
4  * Copyright (C) 2009 Nokia Corporation
5  * Author: Tomi Valkeinen <tomi.valkeinen@nokia.com>
6  *
7  * Some code and ideas taken from drivers/video/omap/ driver
8  * by Imre Deak.
9  *
10  * This program is free software; you can redistribute it and/or modify it
11  * under the terms of the GNU General Public License version 2 as published by
12  * the Free Software Foundation.
13  *
14  * This program is distributed in the hope that it will be useful, but WITHOUT
15  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
16  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
17  * more details.
18  *
19  * You should have received a copy of the GNU General Public License along with
20  * this program.  If not, see <http://www.gnu.org/licenses/>.
21  */
22
23 #define DSS_SUBSYS_NAME "DISPLAY"
24
25 #include <linux/kernel.h>
26 #include <linux/module.h>
27 #include <linux/jiffies.h>
28 #include <linux/platform_device.h>
29
30 #include <video/omapdss.h>
31 #include "dss.h"
32 #include "dss_features.h"
33
34 static ssize_t display_enabled_show(struct device *dev,
35                 struct device_attribute *attr, char *buf)
36 {
37         struct omap_dss_device *dssdev = to_dss_device(dev);
38         bool enabled = dssdev->state != OMAP_DSS_DISPLAY_DISABLED;
39
40         return snprintf(buf, PAGE_SIZE, "%d\n", enabled);
41 }
42
43 static ssize_t display_enabled_store(struct device *dev,
44                 struct device_attribute *attr,
45                 const char *buf, size_t size)
46 {
47         struct omap_dss_device *dssdev = to_dss_device(dev);
48         int r;
49         bool enabled;
50
51         r = strtobool(buf, &enabled);
52         if (r)
53                 return r;
54
55         if (enabled != (dssdev->state != OMAP_DSS_DISPLAY_DISABLED)) {
56                 if (enabled) {
57                         r = dssdev->driver->enable(dssdev);
58                         if (r)
59                                 return r;
60                 } else {
61                         dssdev->driver->disable(dssdev);
62                 }
63         }
64
65         return size;
66 }
67
68 static ssize_t display_tear_show(struct device *dev,
69                 struct device_attribute *attr, char *buf)
70 {
71         struct omap_dss_device *dssdev = to_dss_device(dev);
72         return snprintf(buf, PAGE_SIZE, "%d\n",
73                         dssdev->driver->get_te ?
74                         dssdev->driver->get_te(dssdev) : 0);
75 }
76
77 static ssize_t display_tear_store(struct device *dev,
78                 struct device_attribute *attr, const char *buf, size_t size)
79 {
80         struct omap_dss_device *dssdev = to_dss_device(dev);
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
98 static ssize_t display_timings_show(struct device *dev,
99                 struct device_attribute *attr, char *buf)
100 {
101         struct omap_dss_device *dssdev = to_dss_device(dev);
102         struct omap_video_timings t;
103
104         if (!dssdev->driver->get_timings)
105                 return -ENOENT;
106
107         dssdev->driver->get_timings(dssdev, &t);
108
109         return snprintf(buf, PAGE_SIZE, "%u,%u/%u/%u/%u,%u/%u/%u/%u\n",
110                         t.pixel_clock,
111                         t.x_res, t.hfp, t.hbp, t.hsw,
112                         t.y_res, t.vfp, t.vbp, t.vsw);
113 }
114
115 static ssize_t display_timings_store(struct device *dev,
116                 struct device_attribute *attr, const char *buf, size_t size)
117 {
118         struct omap_dss_device *dssdev = to_dss_device(dev);
119         struct omap_video_timings t;
120         int r, found;
121
122         if (!dssdev->driver->set_timings || !dssdev->driver->check_timings)
123                 return -ENOENT;
124
125         found = 0;
126 #ifdef CONFIG_OMAP2_DSS_VENC
127         if (strncmp("pal", buf, 3) == 0) {
128                 t = omap_dss_pal_timings;
129                 found = 1;
130         } else if (strncmp("ntsc", buf, 4) == 0) {
131                 t = omap_dss_ntsc_timings;
132                 found = 1;
133         }
134 #endif
135         if (!found && sscanf(buf, "%u,%hu/%hu/%hu/%hu,%hu/%hu/%hu/%hu",
136                                 &t.pixel_clock,
137                                 &t.x_res, &t.hfp, &t.hbp, &t.hsw,
138                                 &t.y_res, &t.vfp, &t.vbp, &t.vsw) != 9)
139                 return -EINVAL;
140
141         r = dssdev->driver->check_timings(dssdev, &t);
142         if (r)
143                 return r;
144
145         dssdev->driver->set_timings(dssdev, &t);
146
147         return size;
148 }
149
150 static ssize_t display_rotate_show(struct device *dev,
151                 struct device_attribute *attr, char *buf)
152 {
153         struct omap_dss_device *dssdev = to_dss_device(dev);
154         int rotate;
155         if (!dssdev->driver->get_rotate)
156                 return -ENOENT;
157         rotate = dssdev->driver->get_rotate(dssdev);
158         return snprintf(buf, PAGE_SIZE, "%u\n", rotate);
159 }
160
161 static ssize_t display_rotate_store(struct device *dev,
162                 struct device_attribute *attr, const char *buf, size_t size)
163 {
164         struct omap_dss_device *dssdev = to_dss_device(dev);
165         int rot, r;
166
167         if (!dssdev->driver->set_rotate || !dssdev->driver->get_rotate)
168                 return -ENOENT;
169
170         r = kstrtoint(buf, 0, &rot);
171         if (r)
172                 return r;
173
174         r = dssdev->driver->set_rotate(dssdev, rot);
175         if (r)
176                 return r;
177
178         return size;
179 }
180
181 static ssize_t display_mirror_show(struct device *dev,
182                 struct device_attribute *attr, char *buf)
183 {
184         struct omap_dss_device *dssdev = to_dss_device(dev);
185         int mirror;
186         if (!dssdev->driver->get_mirror)
187                 return -ENOENT;
188         mirror = dssdev->driver->get_mirror(dssdev);
189         return snprintf(buf, PAGE_SIZE, "%u\n", mirror);
190 }
191
192 static ssize_t display_mirror_store(struct device *dev,
193                 struct device_attribute *attr, const char *buf, size_t size)
194 {
195         struct omap_dss_device *dssdev = to_dss_device(dev);
196         int r;
197         bool mirror;
198
199         if (!dssdev->driver->set_mirror || !dssdev->driver->get_mirror)
200                 return -ENOENT;
201
202         r = strtobool(buf, &mirror);
203         if (r)
204                 return r;
205
206         r = dssdev->driver->set_mirror(dssdev, mirror);
207         if (r)
208                 return r;
209
210         return size;
211 }
212
213 static ssize_t display_wss_show(struct device *dev,
214                 struct device_attribute *attr, char *buf)
215 {
216         struct omap_dss_device *dssdev = to_dss_device(dev);
217         unsigned int wss;
218
219         if (!dssdev->driver->get_wss)
220                 return -ENOENT;
221
222         wss = dssdev->driver->get_wss(dssdev);
223
224         return snprintf(buf, PAGE_SIZE, "0x%05x\n", wss);
225 }
226
227 static ssize_t display_wss_store(struct device *dev,
228                 struct device_attribute *attr, const char *buf, size_t size)
229 {
230         struct omap_dss_device *dssdev = to_dss_device(dev);
231         u32 wss;
232         int r;
233
234         if (!dssdev->driver->get_wss || !dssdev->driver->set_wss)
235                 return -ENOENT;
236
237         r = kstrtou32(buf, 0, &wss);
238         if (r)
239                 return r;
240
241         if (wss > 0xfffff)
242                 return -EINVAL;
243
244         r = dssdev->driver->set_wss(dssdev, wss);
245         if (r)
246                 return r;
247
248         return size;
249 }
250
251 static DEVICE_ATTR(enabled, S_IRUGO|S_IWUSR,
252                 display_enabled_show, display_enabled_store);
253 static DEVICE_ATTR(tear_elim, S_IRUGO|S_IWUSR,
254                 display_tear_show, display_tear_store);
255 static DEVICE_ATTR(timings, S_IRUGO|S_IWUSR,
256                 display_timings_show, display_timings_store);
257 static DEVICE_ATTR(rotate, S_IRUGO|S_IWUSR,
258                 display_rotate_show, display_rotate_store);
259 static DEVICE_ATTR(mirror, S_IRUGO|S_IWUSR,
260                 display_mirror_show, display_mirror_store);
261 static DEVICE_ATTR(wss, S_IRUGO|S_IWUSR,
262                 display_wss_show, display_wss_store);
263
264 static struct device_attribute *display_sysfs_attrs[] = {
265         &dev_attr_enabled,
266         &dev_attr_tear_elim,
267         &dev_attr_timings,
268         &dev_attr_rotate,
269         &dev_attr_mirror,
270         &dev_attr_wss,
271         NULL
272 };
273
274 void omapdss_default_get_resolution(struct omap_dss_device *dssdev,
275                         u16 *xres, u16 *yres)
276 {
277         *xres = dssdev->panel.timings.x_res;
278         *yres = dssdev->panel.timings.y_res;
279 }
280 EXPORT_SYMBOL(omapdss_default_get_resolution);
281
282 void default_get_overlay_fifo_thresholds(enum omap_plane plane,
283                 u32 fifo_size, u32 burst_size,
284                 u32 *fifo_low, u32 *fifo_high)
285 {
286         unsigned buf_unit = dss_feat_get_buffer_size_unit();
287
288         *fifo_high = fifo_size - buf_unit;
289         *fifo_low = fifo_size - burst_size;
290 }
291
292 int omapdss_default_get_recommended_bpp(struct omap_dss_device *dssdev)
293 {
294         switch (dssdev->type) {
295         case OMAP_DISPLAY_TYPE_DPI:
296                 if (dssdev->phy.dpi.data_lines == 24)
297                         return 24;
298                 else
299                         return 16;
300
301         case OMAP_DISPLAY_TYPE_DBI:
302         case OMAP_DISPLAY_TYPE_DSI:
303                 if (dssdev->ctrl.pixel_size == 24)
304                         return 24;
305                 else
306                         return 16;
307         case OMAP_DISPLAY_TYPE_VENC:
308         case OMAP_DISPLAY_TYPE_SDI:
309         case OMAP_DISPLAY_TYPE_HDMI:
310                 return 24;
311         default:
312                 BUG();
313         }
314 }
315 EXPORT_SYMBOL(omapdss_default_get_recommended_bpp);
316
317 /* Checks if replication logic should be used. Only use for active matrix,
318  * when overlay is in RGB12U or RGB16 mode, and LCD interface is
319  * 18bpp or 24bpp */
320 bool dss_use_replication(struct omap_dss_device *dssdev,
321                 enum omap_color_mode mode)
322 {
323         int bpp;
324
325         if (mode != OMAP_DSS_COLOR_RGB12U && mode != OMAP_DSS_COLOR_RGB16)
326                 return false;
327
328         if (dssdev->type == OMAP_DISPLAY_TYPE_DPI &&
329                         (dssdev->panel.config & OMAP_DSS_LCD_TFT) == 0)
330                 return false;
331
332         switch (dssdev->type) {
333         case OMAP_DISPLAY_TYPE_DPI:
334                 bpp = dssdev->phy.dpi.data_lines;
335                 break;
336         case OMAP_DISPLAY_TYPE_HDMI:
337         case OMAP_DISPLAY_TYPE_VENC:
338         case OMAP_DISPLAY_TYPE_SDI:
339                 bpp = 24;
340                 break;
341         case OMAP_DISPLAY_TYPE_DBI:
342         case OMAP_DISPLAY_TYPE_DSI:
343                 bpp = dssdev->ctrl.pixel_size;
344                 break;
345         default:
346                 BUG();
347         }
348
349         return bpp > 16;
350 }
351
352 void dss_init_device(struct platform_device *pdev,
353                 struct omap_dss_device *dssdev)
354 {
355         struct device_attribute *attr;
356         int i;
357         int r;
358
359         switch (dssdev->type) {
360 #ifdef CONFIG_OMAP2_DSS_DPI
361         case OMAP_DISPLAY_TYPE_DPI:
362                 r = dpi_init_display(dssdev);
363                 break;
364 #endif
365 #ifdef CONFIG_OMAP2_DSS_RFBI
366         case OMAP_DISPLAY_TYPE_DBI:
367                 r = rfbi_init_display(dssdev);
368                 break;
369 #endif
370 #ifdef CONFIG_OMAP2_DSS_VENC
371         case OMAP_DISPLAY_TYPE_VENC:
372                 r = venc_init_display(dssdev);
373                 break;
374 #endif
375 #ifdef CONFIG_OMAP2_DSS_SDI
376         case OMAP_DISPLAY_TYPE_SDI:
377                 r = sdi_init_display(dssdev);
378                 break;
379 #endif
380 #ifdef CONFIG_OMAP2_DSS_DSI
381         case OMAP_DISPLAY_TYPE_DSI:
382                 r = dsi_init_display(dssdev);
383                 break;
384 #endif
385         case OMAP_DISPLAY_TYPE_HDMI:
386                 r = hdmi_init_display(dssdev);
387                 break;
388         default:
389                 DSSERR("Support for display '%s' not compiled in.\n",
390                                 dssdev->name);
391                 return;
392         }
393
394         if (r) {
395                 DSSERR("failed to init display %s\n", dssdev->name);
396                 return;
397         }
398
399         /* create device sysfs files */
400         i = 0;
401         while ((attr = display_sysfs_attrs[i++]) != NULL) {
402                 r = device_create_file(&dssdev->dev, attr);
403                 if (r)
404                         DSSERR("failed to create sysfs file\n");
405         }
406
407         /* create display? sysfs links */
408         r = sysfs_create_link(&pdev->dev.kobj, &dssdev->dev.kobj,
409                         dev_name(&dssdev->dev));
410         if (r)
411                 DSSERR("failed to create sysfs display link\n");
412 }
413
414 void dss_uninit_device(struct platform_device *pdev,
415                 struct omap_dss_device *dssdev)
416 {
417         struct device_attribute *attr;
418         int i = 0;
419
420         sysfs_remove_link(&pdev->dev.kobj, dev_name(&dssdev->dev));
421
422         while ((attr = display_sysfs_attrs[i++]) != NULL)
423                 device_remove_file(&dssdev->dev, attr);
424
425         if (dssdev->manager)
426                 dssdev->manager->unset_device(dssdev->manager);
427 }
428
429 static int dss_suspend_device(struct device *dev, void *data)
430 {
431         int r;
432         struct omap_dss_device *dssdev = to_dss_device(dev);
433
434         if (dssdev->state != OMAP_DSS_DISPLAY_ACTIVE) {
435                 dssdev->activate_after_resume = false;
436                 return 0;
437         }
438
439         if (!dssdev->driver->suspend) {
440                 DSSERR("display '%s' doesn't implement suspend\n",
441                                 dssdev->name);
442                 return -ENOSYS;
443         }
444
445         r = dssdev->driver->suspend(dssdev);
446         if (r)
447                 return r;
448
449         dssdev->activate_after_resume = true;
450
451         return 0;
452 }
453
454 int dss_suspend_all_devices(void)
455 {
456         int r;
457         struct bus_type *bus = dss_get_bus();
458
459         r = bus_for_each_dev(bus, NULL, NULL, dss_suspend_device);
460         if (r) {
461                 /* resume all displays that were suspended */
462                 dss_resume_all_devices();
463                 return r;
464         }
465
466         return 0;
467 }
468
469 static int dss_resume_device(struct device *dev, void *data)
470 {
471         int r;
472         struct omap_dss_device *dssdev = to_dss_device(dev);
473
474         if (dssdev->activate_after_resume && dssdev->driver->resume) {
475                 r = dssdev->driver->resume(dssdev);
476                 if (r)
477                         return r;
478         }
479
480         dssdev->activate_after_resume = false;
481
482         return 0;
483 }
484
485 int dss_resume_all_devices(void)
486 {
487         struct bus_type *bus = dss_get_bus();
488
489         return bus_for_each_dev(bus, NULL, NULL, dss_resume_device);
490 }
491
492 static int dss_disable_device(struct device *dev, void *data)
493 {
494         struct omap_dss_device *dssdev = to_dss_device(dev);
495
496         if (dssdev->state != OMAP_DSS_DISPLAY_DISABLED)
497                 dssdev->driver->disable(dssdev);
498
499         return 0;
500 }
501
502 void dss_disable_all_devices(void)
503 {
504         struct bus_type *bus = dss_get_bus();
505         bus_for_each_dev(bus, NULL, NULL, dss_disable_device);
506 }
507
508
509 void omap_dss_get_device(struct omap_dss_device *dssdev)
510 {
511         get_device(&dssdev->dev);
512 }
513 EXPORT_SYMBOL(omap_dss_get_device);
514
515 void omap_dss_put_device(struct omap_dss_device *dssdev)
516 {
517         put_device(&dssdev->dev);
518 }
519 EXPORT_SYMBOL(omap_dss_put_device);
520
521 /* ref count of the found device is incremented. ref count
522  * of from-device is decremented. */
523 struct omap_dss_device *omap_dss_get_next_device(struct omap_dss_device *from)
524 {
525         struct device *dev;
526         struct device *dev_start = NULL;
527         struct omap_dss_device *dssdev = NULL;
528
529         int match(struct device *dev, void *data)
530         {
531                 return 1;
532         }
533
534         if (from)
535                 dev_start = &from->dev;
536         dev = bus_find_device(dss_get_bus(), dev_start, NULL, match);
537         if (dev)
538                 dssdev = to_dss_device(dev);
539         if (from)
540                 put_device(&from->dev);
541
542         return dssdev;
543 }
544 EXPORT_SYMBOL(omap_dss_get_next_device);
545
546 struct omap_dss_device *omap_dss_find_device(void *data,
547                 int (*match)(struct omap_dss_device *dssdev, void *data))
548 {
549         struct omap_dss_device *dssdev = NULL;
550
551         while ((dssdev = omap_dss_get_next_device(dssdev)) != NULL) {
552                 if (match(dssdev, data))
553                         return dssdev;
554         }
555
556         return NULL;
557 }
558 EXPORT_SYMBOL(omap_dss_find_device);
559
560 int omap_dss_start_device(struct omap_dss_device *dssdev)
561 {
562         if (!dssdev->driver) {
563                 DSSDBG("no driver\n");
564                 return -ENODEV;
565         }
566
567         if (!try_module_get(dssdev->dev.driver->owner)) {
568                 return -ENODEV;
569         }
570
571         return 0;
572 }
573 EXPORT_SYMBOL(omap_dss_start_device);
574
575 void omap_dss_stop_device(struct omap_dss_device *dssdev)
576 {
577         module_put(dssdev->dev.driver->owner);
578 }
579 EXPORT_SYMBOL(omap_dss_stop_device);
580