OMAPDSS: VENC: fix NULL pointer dereference in DSS2 VENC sysfs debug attr on OMAP4
[zen-stable.git] / drivers / video / omap2 / dss / core.c
blob8613f86fb56d32b4f45cf1f5900e5edea69abe9c
1 /*
2 * linux/drivers/video/omap2/dss/core.c
4 * Copyright (C) 2009 Nokia Corporation
5 * Author: Tomi Valkeinen <tomi.valkeinen@nokia.com>
7 * Some code and ideas taken from drivers/video/omap/ driver
8 * by Imre Deak.
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.
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.
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/>.
23 #define DSS_SUBSYS_NAME "CORE"
25 #include <linux/kernel.h>
26 #include <linux/module.h>
27 #include <linux/clk.h>
28 #include <linux/err.h>
29 #include <linux/platform_device.h>
30 #include <linux/seq_file.h>
31 #include <linux/debugfs.h>
32 #include <linux/io.h>
33 #include <linux/device.h>
34 #include <linux/regulator/consumer.h>
36 #include <video/omapdss.h>
38 #include "dss.h"
39 #include "dss_features.h"
41 static struct {
42 struct platform_device *pdev;
44 struct regulator *vdds_dsi_reg;
45 struct regulator *vdds_sdi_reg;
46 } core;
48 static char *def_disp_name;
49 module_param_named(def_disp, def_disp_name, charp, 0);
50 MODULE_PARM_DESC(def_disp, "default display name");
52 #ifdef DEBUG
53 bool dss_debug;
54 module_param_named(debug, dss_debug, bool, 0644);
55 #endif
57 static int omap_dss_register_device(struct omap_dss_device *);
58 static void omap_dss_unregister_device(struct omap_dss_device *);
60 /* REGULATORS */
62 struct regulator *dss_get_vdds_dsi(void)
64 struct regulator *reg;
66 if (core.vdds_dsi_reg != NULL)
67 return core.vdds_dsi_reg;
69 reg = regulator_get(&core.pdev->dev, "vdds_dsi");
70 if (!IS_ERR(reg))
71 core.vdds_dsi_reg = reg;
73 return reg;
76 struct regulator *dss_get_vdds_sdi(void)
78 struct regulator *reg;
80 if (core.vdds_sdi_reg != NULL)
81 return core.vdds_sdi_reg;
83 reg = regulator_get(&core.pdev->dev, "vdds_sdi");
84 if (!IS_ERR(reg))
85 core.vdds_sdi_reg = reg;
87 return reg;
90 #if defined(CONFIG_DEBUG_FS) && defined(CONFIG_OMAP2_DSS_DEBUG_SUPPORT)
91 static int dss_debug_show(struct seq_file *s, void *unused)
93 void (*func)(struct seq_file *) = s->private;
94 func(s);
95 return 0;
98 static int dss_debug_open(struct inode *inode, struct file *file)
100 return single_open(file, dss_debug_show, inode->i_private);
103 static const struct file_operations dss_debug_fops = {
104 .open = dss_debug_open,
105 .read = seq_read,
106 .llseek = seq_lseek,
107 .release = single_release,
110 static struct dentry *dss_debugfs_dir;
112 static int dss_initialize_debugfs(void)
114 dss_debugfs_dir = debugfs_create_dir("omapdss", NULL);
115 if (IS_ERR(dss_debugfs_dir)) {
116 int err = PTR_ERR(dss_debugfs_dir);
117 dss_debugfs_dir = NULL;
118 return err;
121 debugfs_create_file("clk", S_IRUGO, dss_debugfs_dir,
122 &dss_debug_dump_clocks, &dss_debug_fops);
124 #ifdef CONFIG_OMAP2_DSS_COLLECT_IRQ_STATS
125 debugfs_create_file("dispc_irq", S_IRUGO, dss_debugfs_dir,
126 &dispc_dump_irqs, &dss_debug_fops);
127 #endif
129 #if defined(CONFIG_OMAP2_DSS_DSI) && defined(CONFIG_OMAP2_DSS_COLLECT_IRQ_STATS)
130 dsi_create_debugfs_files_irq(dss_debugfs_dir, &dss_debug_fops);
131 #endif
133 debugfs_create_file("dss", S_IRUGO, dss_debugfs_dir,
134 &dss_dump_regs, &dss_debug_fops);
135 debugfs_create_file("dispc", S_IRUGO, dss_debugfs_dir,
136 &dispc_dump_regs, &dss_debug_fops);
137 #ifdef CONFIG_OMAP2_DSS_RFBI
138 debugfs_create_file("rfbi", S_IRUGO, dss_debugfs_dir,
139 &rfbi_dump_regs, &dss_debug_fops);
140 #endif
141 #ifdef CONFIG_OMAP2_DSS_DSI
142 dsi_create_debugfs_files_reg(dss_debugfs_dir, &dss_debug_fops);
143 #endif
144 #ifdef CONFIG_OMAP2_DSS_VENC
145 debugfs_create_file("venc", S_IRUGO, dss_debugfs_dir,
146 &venc_dump_regs, &dss_debug_fops);
147 #endif
148 #ifdef CONFIG_OMAP4_DSS_HDMI
149 debugfs_create_file("hdmi", S_IRUGO, dss_debugfs_dir,
150 &hdmi_dump_regs, &dss_debug_fops);
151 #endif
152 return 0;
155 static void dss_uninitialize_debugfs(void)
157 if (dss_debugfs_dir)
158 debugfs_remove_recursive(dss_debugfs_dir);
160 #else /* CONFIG_DEBUG_FS && CONFIG_OMAP2_DSS_DEBUG_SUPPORT */
161 static inline int dss_initialize_debugfs(void)
163 return 0;
165 static inline void dss_uninitialize_debugfs(void)
168 #endif /* CONFIG_DEBUG_FS && CONFIG_OMAP2_DSS_DEBUG_SUPPORT */
170 /* PLATFORM DEVICE */
171 static int omap_dss_probe(struct platform_device *pdev)
173 struct omap_dss_board_info *pdata = pdev->dev.platform_data;
174 int r;
175 int i;
177 core.pdev = pdev;
179 dss_features_init();
181 dss_apply_init();
183 dss_init_overlay_managers(pdev);
184 dss_init_overlays(pdev);
186 r = dss_init_platform_driver();
187 if (r) {
188 DSSERR("Failed to initialize DSS platform driver\n");
189 goto err_dss;
192 r = dispc_init_platform_driver();
193 if (r) {
194 DSSERR("Failed to initialize dispc platform driver\n");
195 goto err_dispc;
198 r = rfbi_init_platform_driver();
199 if (r) {
200 DSSERR("Failed to initialize rfbi platform driver\n");
201 goto err_rfbi;
204 r = venc_init_platform_driver();
205 if (r) {
206 DSSERR("Failed to initialize venc platform driver\n");
207 goto err_venc;
210 r = dsi_init_platform_driver();
211 if (r) {
212 DSSERR("Failed to initialize DSI platform driver\n");
213 goto err_dsi;
216 r = hdmi_init_platform_driver();
217 if (r) {
218 DSSERR("Failed to initialize hdmi\n");
219 goto err_hdmi;
222 r = dss_initialize_debugfs();
223 if (r)
224 goto err_debugfs;
226 for (i = 0; i < pdata->num_devices; ++i) {
227 struct omap_dss_device *dssdev = pdata->devices[i];
229 r = omap_dss_register_device(dssdev);
230 if (r) {
231 DSSERR("device %d %s register failed %d\n", i,
232 dssdev->name ?: "unnamed", r);
234 while (--i >= 0)
235 omap_dss_unregister_device(pdata->devices[i]);
237 goto err_register;
240 if (def_disp_name && strcmp(def_disp_name, dssdev->name) == 0)
241 pdata->default_device = dssdev;
244 return 0;
246 err_register:
247 dss_uninitialize_debugfs();
248 err_debugfs:
249 hdmi_uninit_platform_driver();
250 err_hdmi:
251 dsi_uninit_platform_driver();
252 err_dsi:
253 venc_uninit_platform_driver();
254 err_venc:
255 dispc_uninit_platform_driver();
256 err_dispc:
257 rfbi_uninit_platform_driver();
258 err_rfbi:
259 dss_uninit_platform_driver();
260 err_dss:
262 return r;
265 static int omap_dss_remove(struct platform_device *pdev)
267 struct omap_dss_board_info *pdata = pdev->dev.platform_data;
268 int i;
270 dss_uninitialize_debugfs();
272 hdmi_uninit_platform_driver();
273 dsi_uninit_platform_driver();
274 venc_uninit_platform_driver();
275 rfbi_uninit_platform_driver();
276 dispc_uninit_platform_driver();
277 dss_uninit_platform_driver();
279 dss_uninit_overlays(pdev);
280 dss_uninit_overlay_managers(pdev);
282 for (i = 0; i < pdata->num_devices; ++i)
283 omap_dss_unregister_device(pdata->devices[i]);
285 return 0;
288 static void omap_dss_shutdown(struct platform_device *pdev)
290 DSSDBG("shutdown\n");
291 dss_disable_all_devices();
294 static int omap_dss_suspend(struct platform_device *pdev, pm_message_t state)
296 DSSDBG("suspend %d\n", state.event);
298 return dss_suspend_all_devices();
301 static int omap_dss_resume(struct platform_device *pdev)
303 DSSDBG("resume\n");
305 return dss_resume_all_devices();
308 static struct platform_driver omap_dss_driver = {
309 .probe = omap_dss_probe,
310 .remove = omap_dss_remove,
311 .shutdown = omap_dss_shutdown,
312 .suspend = omap_dss_suspend,
313 .resume = omap_dss_resume,
314 .driver = {
315 .name = "omapdss",
316 .owner = THIS_MODULE,
320 /* BUS */
321 static int dss_bus_match(struct device *dev, struct device_driver *driver)
323 struct omap_dss_device *dssdev = to_dss_device(dev);
325 DSSDBG("bus_match. dev %s/%s, drv %s\n",
326 dev_name(dev), dssdev->driver_name, driver->name);
328 return strcmp(dssdev->driver_name, driver->name) == 0;
331 static ssize_t device_name_show(struct device *dev,
332 struct device_attribute *attr, char *buf)
334 struct omap_dss_device *dssdev = to_dss_device(dev);
335 return snprintf(buf, PAGE_SIZE, "%s\n",
336 dssdev->name ?
337 dssdev->name : "");
340 static struct device_attribute default_dev_attrs[] = {
341 __ATTR(name, S_IRUGO, device_name_show, NULL),
342 __ATTR_NULL,
345 static ssize_t driver_name_show(struct device_driver *drv, char *buf)
347 struct omap_dss_driver *dssdrv = to_dss_driver(drv);
348 return snprintf(buf, PAGE_SIZE, "%s\n",
349 dssdrv->driver.name ?
350 dssdrv->driver.name : "");
352 static struct driver_attribute default_drv_attrs[] = {
353 __ATTR(name, S_IRUGO, driver_name_show, NULL),
354 __ATTR_NULL,
357 static struct bus_type dss_bus_type = {
358 .name = "omapdss",
359 .match = dss_bus_match,
360 .dev_attrs = default_dev_attrs,
361 .drv_attrs = default_drv_attrs,
364 static void dss_bus_release(struct device *dev)
366 DSSDBG("bus_release\n");
369 static struct device dss_bus = {
370 .release = dss_bus_release,
373 struct bus_type *dss_get_bus(void)
375 return &dss_bus_type;
378 /* DRIVER */
379 static int dss_driver_probe(struct device *dev)
381 int r;
382 struct omap_dss_driver *dssdrv = to_dss_driver(dev->driver);
383 struct omap_dss_device *dssdev = to_dss_device(dev);
384 struct omap_dss_board_info *pdata = core.pdev->dev.platform_data;
385 bool force;
387 DSSDBG("driver_probe: dev %s/%s, drv %s\n",
388 dev_name(dev), dssdev->driver_name,
389 dssdrv->driver.name);
391 dss_init_device(core.pdev, dssdev);
393 force = pdata->default_device == dssdev;
394 dss_recheck_connections(dssdev, force);
396 r = dssdrv->probe(dssdev);
398 if (r) {
399 DSSERR("driver probe failed: %d\n", r);
400 dss_uninit_device(core.pdev, dssdev);
401 return r;
404 DSSDBG("probe done for device %s\n", dev_name(dev));
406 dssdev->driver = dssdrv;
408 return 0;
411 static int dss_driver_remove(struct device *dev)
413 struct omap_dss_driver *dssdrv = to_dss_driver(dev->driver);
414 struct omap_dss_device *dssdev = to_dss_device(dev);
416 DSSDBG("driver_remove: dev %s/%s\n", dev_name(dev),
417 dssdev->driver_name);
419 dssdrv->remove(dssdev);
421 dss_uninit_device(core.pdev, dssdev);
423 dssdev->driver = NULL;
425 return 0;
428 int omap_dss_register_driver(struct omap_dss_driver *dssdriver)
430 dssdriver->driver.bus = &dss_bus_type;
431 dssdriver->driver.probe = dss_driver_probe;
432 dssdriver->driver.remove = dss_driver_remove;
434 if (dssdriver->get_resolution == NULL)
435 dssdriver->get_resolution = omapdss_default_get_resolution;
436 if (dssdriver->get_recommended_bpp == NULL)
437 dssdriver->get_recommended_bpp =
438 omapdss_default_get_recommended_bpp;
440 return driver_register(&dssdriver->driver);
442 EXPORT_SYMBOL(omap_dss_register_driver);
444 void omap_dss_unregister_driver(struct omap_dss_driver *dssdriver)
446 driver_unregister(&dssdriver->driver);
448 EXPORT_SYMBOL(omap_dss_unregister_driver);
450 /* DEVICE */
451 static void reset_device(struct device *dev, int check)
453 u8 *dev_p = (u8 *)dev;
454 u8 *dev_end = dev_p + sizeof(*dev);
455 void *saved_pdata;
457 saved_pdata = dev->platform_data;
458 if (check) {
460 * Check if there is any other setting than platform_data
461 * in struct device; warn that these will be reset by our
462 * init.
464 dev->platform_data = NULL;
465 while (dev_p < dev_end) {
466 if (*dev_p) {
467 WARN("%s: struct device fields will be "
468 "discarded\n",
469 __func__);
470 break;
472 dev_p++;
475 memset(dev, 0, sizeof(*dev));
476 dev->platform_data = saved_pdata;
480 static void omap_dss_dev_release(struct device *dev)
482 reset_device(dev, 0);
485 static int omap_dss_register_device(struct omap_dss_device *dssdev)
487 static int dev_num;
489 WARN_ON(!dssdev->driver_name);
491 reset_device(&dssdev->dev, 1);
492 dssdev->dev.bus = &dss_bus_type;
493 dssdev->dev.parent = &dss_bus;
494 dssdev->dev.release = omap_dss_dev_release;
495 dev_set_name(&dssdev->dev, "display%d", dev_num++);
496 return device_register(&dssdev->dev);
499 static void omap_dss_unregister_device(struct omap_dss_device *dssdev)
501 device_unregister(&dssdev->dev);
504 /* BUS */
505 static int omap_dss_bus_register(void)
507 int r;
509 r = bus_register(&dss_bus_type);
510 if (r) {
511 DSSERR("bus register failed\n");
512 return r;
515 dev_set_name(&dss_bus, "omapdss");
516 r = device_register(&dss_bus);
517 if (r) {
518 DSSERR("bus driver register failed\n");
519 bus_unregister(&dss_bus_type);
520 return r;
523 return 0;
526 /* INIT */
528 #ifdef CONFIG_OMAP2_DSS_MODULE
529 static void omap_dss_bus_unregister(void)
531 device_unregister(&dss_bus);
533 bus_unregister(&dss_bus_type);
536 static int __init omap_dss_init(void)
538 int r;
540 r = omap_dss_bus_register();
541 if (r)
542 return r;
544 r = platform_driver_register(&omap_dss_driver);
545 if (r) {
546 omap_dss_bus_unregister();
547 return r;
550 return 0;
553 static void __exit omap_dss_exit(void)
555 if (core.vdds_dsi_reg != NULL) {
556 regulator_put(core.vdds_dsi_reg);
557 core.vdds_dsi_reg = NULL;
560 if (core.vdds_sdi_reg != NULL) {
561 regulator_put(core.vdds_sdi_reg);
562 core.vdds_sdi_reg = NULL;
565 platform_driver_unregister(&omap_dss_driver);
567 omap_dss_bus_unregister();
570 module_init(omap_dss_init);
571 module_exit(omap_dss_exit);
572 #else
573 static int __init omap_dss_init(void)
575 return omap_dss_bus_register();
578 static int __init omap_dss_init2(void)
580 return platform_driver_register(&omap_dss_driver);
583 core_initcall(omap_dss_init);
584 device_initcall(omap_dss_init2);
585 #endif
587 MODULE_AUTHOR("Tomi Valkeinen <tomi.valkeinen@nokia.com>");
588 MODULE_DESCRIPTION("OMAP2/3 Display Subsystem");
589 MODULE_LICENSE("GPL v2");