OMAPDSS: VENC: fix NULL pointer dereference in DSS2 VENC sysfs debug attr on OMAP4
[zen-stable.git] / drivers / video / backlight / jornada720_lcd.c
blob22d231a17e3c4649652ec1992567111e5b70cd6c
1 /*
3 * LCD driver for HP Jornada 700 series (710/720/728)
4 * Copyright (C) 2006-2009 Kristoffer Ericson <kristoffer.ericson@gmail.com>
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License version
8 * 2 or any later version as published by the Free Software Foundation.
12 #include <linux/device.h>
13 #include <linux/fb.h>
14 #include <linux/kernel.h>
15 #include <linux/lcd.h>
16 #include <linux/module.h>
17 #include <linux/platform_device.h>
18 #include <linux/delay.h>
20 #include <mach/jornada720.h>
21 #include <mach/hardware.h>
23 #include <video/s1d13xxxfb.h>
25 #define LCD_MAX_CONTRAST 0xff
26 #define LCD_DEF_CONTRAST 0x80
28 static int jornada_lcd_get_power(struct lcd_device *dev)
30 /* LDD2 in PPC = LCD POWER */
31 if (PPSR & PPC_LDD2)
32 return FB_BLANK_UNBLANK; /* PW ON */
33 else
34 return FB_BLANK_POWERDOWN; /* PW OFF */
37 static int jornada_lcd_get_contrast(struct lcd_device *dev)
39 int ret;
41 if (jornada_lcd_get_power(dev) != FB_BLANK_UNBLANK)
42 return 0;
44 jornada_ssp_start();
46 if (jornada_ssp_byte(GETCONTRAST) != TXDUMMY) {
47 printk(KERN_ERR "lcd: get contrast failed\n");
48 jornada_ssp_end();
49 return -ETIMEDOUT;
50 } else {
51 ret = jornada_ssp_byte(TXDUMMY);
52 jornada_ssp_end();
53 return ret;
57 static int jornada_lcd_set_contrast(struct lcd_device *dev, int value)
59 int ret;
61 jornada_ssp_start();
63 /* start by sending our set contrast cmd to mcu */
64 ret = jornada_ssp_byte(SETCONTRAST);
66 /* push the new value */
67 if (jornada_ssp_byte(value) != TXDUMMY) {
68 printk(KERN_ERR "lcd : set contrast failed\n");
69 jornada_ssp_end();
70 return -ETIMEDOUT;
73 /* if we get here we can assume everything went well */
74 jornada_ssp_end();
76 return 0;
79 static int jornada_lcd_set_power(struct lcd_device *dev, int power)
81 if (power != FB_BLANK_UNBLANK) {
82 PPSR &= ~PPC_LDD2;
83 PPDR |= PPC_LDD2;
84 } else
85 PPSR |= PPC_LDD2;
87 return 0;
90 static struct lcd_ops jornada_lcd_props = {
91 .get_contrast = jornada_lcd_get_contrast,
92 .set_contrast = jornada_lcd_set_contrast,
93 .get_power = jornada_lcd_get_power,
94 .set_power = jornada_lcd_set_power,
97 static int jornada_lcd_probe(struct platform_device *pdev)
99 struct lcd_device *lcd_device;
100 int ret;
102 lcd_device = lcd_device_register(S1D_DEVICENAME, &pdev->dev, NULL, &jornada_lcd_props);
104 if (IS_ERR(lcd_device)) {
105 ret = PTR_ERR(lcd_device);
106 printk(KERN_ERR "lcd : failed to register device\n");
107 return ret;
110 platform_set_drvdata(pdev, lcd_device);
112 /* lets set our default values */
113 jornada_lcd_set_contrast(lcd_device, LCD_DEF_CONTRAST);
114 jornada_lcd_set_power(lcd_device, FB_BLANK_UNBLANK);
115 /* give it some time to startup */
116 msleep(100);
118 return 0;
121 static int jornada_lcd_remove(struct platform_device *pdev)
123 struct lcd_device *lcd_device = platform_get_drvdata(pdev);
125 lcd_device_unregister(lcd_device);
127 return 0;
130 static struct platform_driver jornada_lcd_driver = {
131 .probe = jornada_lcd_probe,
132 .remove = jornada_lcd_remove,
133 .driver = {
134 .name = "jornada_lcd",
138 module_platform_driver(jornada_lcd_driver);
140 MODULE_AUTHOR("Kristoffer Ericson <kristoffer.ericson@gmail.com>");
141 MODULE_DESCRIPTION("HP Jornada 710/720/728 LCD driver");
142 MODULE_LICENSE("GPL");