block: BFQ: Add several invariant checks
[linux-block.git] / drivers / video / backlight / jornada720_lcd.c
CommitLineData
7de31d0d 1// SPDX-License-Identifier: GPL-2.0-or-later
9e124435
KE
2/*
3 *
4 * LCD driver for HP Jornada 700 series (710/720/728)
5 * Copyright (C) 2006-2009 Kristoffer Ericson <kristoffer.ericson@gmail.com>
9e124435
KE
6 */
7
8#include <linux/device.h>
9#include <linux/fb.h>
10#include <linux/kernel.h>
11#include <linux/lcd.h>
12#include <linux/module.h>
13#include <linux/platform_device.h>
14#include <linux/delay.h>
15
16#include <mach/jornada720.h>
17#include <mach/hardware.h>
18
19#include <video/s1d13xxxfb.h>
20
21#define LCD_MAX_CONTRAST 0xff
22#define LCD_DEF_CONTRAST 0x80
23
b2dcd7be 24static int jornada_lcd_get_power(struct lcd_device *ld)
9e124435 25{
3e51cd93 26 return PPSR & PPC_LDD2 ? FB_BLANK_UNBLANK : FB_BLANK_POWERDOWN;
9e124435
KE
27}
28
b2dcd7be 29static int jornada_lcd_get_contrast(struct lcd_device *ld)
9e124435
KE
30{
31 int ret;
32
b2dcd7be 33 if (jornada_lcd_get_power(ld) != FB_BLANK_UNBLANK)
9e124435
KE
34 return 0;
35
36 jornada_ssp_start();
37
1e3b0970 38 if (jornada_ssp_byte(GETCONTRAST) == TXDUMMY) {
9e124435 39 ret = jornada_ssp_byte(TXDUMMY);
1e3b0970 40 goto success;
9e124435 41 }
1e3b0970
LJ
42
43 dev_err(&ld->dev, "failed to set contrast\n");
44 ret = -ETIMEDOUT;
45
46success:
47 jornada_ssp_end();
48 return ret;
9e124435
KE
49}
50
b2dcd7be 51static int jornada_lcd_set_contrast(struct lcd_device *ld, int value)
9e124435 52{
1e3b0970 53 int ret = 0;
9e124435
KE
54
55 jornada_ssp_start();
56
57 /* start by sending our set contrast cmd to mcu */
1e3b0970
LJ
58 if (jornada_ssp_byte(SETCONTRAST) == TXDUMMY) {
59 /* if successful push the new value */
60 if (jornada_ssp_byte(value) == TXDUMMY)
61 goto success;
9e124435
KE
62 }
63
1e3b0970
LJ
64 dev_err(&ld->dev, "failed to set contrast\n");
65 ret = -ETIMEDOUT;
9e124435 66
1e3b0970
LJ
67success:
68 jornada_ssp_end();
69 return ret;
9e124435
KE
70}
71
b2dcd7be 72static int jornada_lcd_set_power(struct lcd_device *ld, int power)
9e124435
KE
73{
74 if (power != FB_BLANK_UNBLANK) {
75 PPSR &= ~PPC_LDD2;
76 PPDR |= PPC_LDD2;
b2dcd7be 77 } else {
9e124435 78 PPSR |= PPC_LDD2;
b2dcd7be 79 }
9e124435
KE
80
81 return 0;
82}
83
84static struct lcd_ops jornada_lcd_props = {
85 .get_contrast = jornada_lcd_get_contrast,
86 .set_contrast = jornada_lcd_set_contrast,
87 .get_power = jornada_lcd_get_power,
88 .set_power = jornada_lcd_set_power,
89};
90
91static int jornada_lcd_probe(struct platform_device *pdev)
92{
93 struct lcd_device *lcd_device;
94 int ret;
95
964598f2
JH
96 lcd_device = devm_lcd_device_register(&pdev->dev, S1D_DEVICENAME,
97 &pdev->dev, NULL, &jornada_lcd_props);
9e124435
KE
98
99 if (IS_ERR(lcd_device)) {
100 ret = PTR_ERR(lcd_device);
b2dcd7be 101 dev_err(&pdev->dev, "failed to register device\n");
9e124435
KE
102 return ret;
103 }
104
105 platform_set_drvdata(pdev, lcd_device);
106
107 /* lets set our default values */
108 jornada_lcd_set_contrast(lcd_device, LCD_DEF_CONTRAST);
109 jornada_lcd_set_power(lcd_device, FB_BLANK_UNBLANK);
110 /* give it some time to startup */
111 msleep(100);
112
113 return 0;
114}
115
9e124435
KE
116static struct platform_driver jornada_lcd_driver = {
117 .probe = jornada_lcd_probe,
9e124435
KE
118 .driver = {
119 .name = "jornada_lcd",
120 },
121};
122
81178e02 123module_platform_driver(jornada_lcd_driver);
9e124435
KE
124
125MODULE_AUTHOR("Kristoffer Ericson <kristoffer.ericson@gmail.com>");
126MODULE_DESCRIPTION("HP Jornada 710/720/728 LCD driver");
127MODULE_LICENSE("GPL");