Commit | Line | Data |
---|---|---|
d2912cb1 | 1 | // SPDX-License-Identifier: GPL-2.0-only |
c25826a7 BD |
2 | /* drivers/video/backlight/platform_lcd.c |
3 | * | |
4 | * Copyright 2008 Simtec Electronics | |
5 | * Ben Dooks <ben@simtec.co.uk> | |
6 | * | |
7 | * Generic platform-device LCD power control interface. | |
c25826a7 BD |
8 | */ |
9 | ||
10 | #include <linux/module.h> | |
11 | #include <linux/platform_device.h> | |
12 | #include <linux/fb.h> | |
13 | #include <linux/backlight.h> | |
14 | #include <linux/lcd.h> | |
5a0e3ad6 | 15 | #include <linux/slab.h> |
c25826a7 BD |
16 | |
17 | #include <video/platform_lcd.h> | |
18 | ||
19 | struct platform_lcd { | |
20 | struct device *us; | |
21 | struct lcd_device *lcd; | |
22 | struct plat_lcd_data *pdata; | |
23 | ||
24 | unsigned int power; | |
8690c70e | 25 | unsigned int suspended:1; |
c25826a7 BD |
26 | }; |
27 | ||
28 | static inline struct platform_lcd *to_our_lcd(struct lcd_device *lcd) | |
29 | { | |
30 | return lcd_get_data(lcd); | |
31 | } | |
32 | ||
33 | static int platform_lcd_get_power(struct lcd_device *lcd) | |
34 | { | |
35 | struct platform_lcd *plcd = to_our_lcd(lcd); | |
36 | ||
37 | return plcd->power; | |
38 | } | |
39 | ||
40 | static int platform_lcd_set_power(struct lcd_device *lcd, int power) | |
41 | { | |
42 | struct platform_lcd *plcd = to_our_lcd(lcd); | |
43 | int lcd_power = 1; | |
44 | ||
45 | if (power == FB_BLANK_POWERDOWN || plcd->suspended) | |
46 | lcd_power = 0; | |
47 | ||
48 | plcd->pdata->set_power(plcd->pdata, lcd_power); | |
49 | plcd->power = power; | |
50 | ||
51 | return 0; | |
52 | } | |
53 | ||
54 | static int platform_lcd_match(struct lcd_device *lcd, struct fb_info *info) | |
55 | { | |
56 | struct platform_lcd *plcd = to_our_lcd(lcd); | |
57 | struct plat_lcd_data *pdata = plcd->pdata; | |
58 | ||
59 | if (pdata->match_fb) | |
60 | return pdata->match_fb(pdata, info); | |
61 | ||
62 | return plcd->us->parent == info->device; | |
63 | } | |
64 | ||
65 | static struct lcd_ops platform_lcd_ops = { | |
66 | .get_power = platform_lcd_get_power, | |
67 | .set_power = platform_lcd_set_power, | |
68 | .check_fb = platform_lcd_match, | |
69 | }; | |
70 | ||
1b9e450d | 71 | static int platform_lcd_probe(struct platform_device *pdev) |
c25826a7 BD |
72 | { |
73 | struct plat_lcd_data *pdata; | |
74 | struct platform_lcd *plcd; | |
75 | struct device *dev = &pdev->dev; | |
76 | int err; | |
77 | ||
c512794c | 78 | pdata = dev_get_platdata(&pdev->dev); |
c25826a7 BD |
79 | if (!pdata) { |
80 | dev_err(dev, "no platform data supplied\n"); | |
81 | return -EINVAL; | |
82 | } | |
83 | ||
46e1915e AB |
84 | if (pdata->probe) { |
85 | err = pdata->probe(pdata); | |
86 | if (err) | |
87 | return err; | |
88 | } | |
89 | ||
48e78e8c MB |
90 | plcd = devm_kzalloc(&pdev->dev, sizeof(struct platform_lcd), |
91 | GFP_KERNEL); | |
c6915be4 | 92 | if (!plcd) |
c25826a7 | 93 | return -ENOMEM; |
c25826a7 BD |
94 | |
95 | plcd->us = dev; | |
96 | plcd->pdata = pdata; | |
1f9ca1ee JH |
97 | plcd->lcd = devm_lcd_device_register(&pdev->dev, dev_name(dev), dev, |
98 | plcd, &platform_lcd_ops); | |
c25826a7 BD |
99 | if (IS_ERR(plcd->lcd)) { |
100 | dev_err(dev, "cannot register lcd device\n"); | |
1f9ca1ee | 101 | return PTR_ERR(plcd->lcd); |
c25826a7 BD |
102 | } |
103 | ||
104 | platform_set_drvdata(pdev, plcd); | |
126ed36d BD |
105 | platform_lcd_set_power(plcd->lcd, FB_BLANK_NORMAL); |
106 | ||
c25826a7 BD |
107 | return 0; |
108 | } | |
109 | ||
1d80d0fd | 110 | #ifdef CONFIG_PM_SLEEP |
67a67272 | 111 | static int platform_lcd_suspend(struct device *dev) |
c25826a7 | 112 | { |
67a67272 | 113 | struct platform_lcd *plcd = dev_get_drvdata(dev); |
c25826a7 BD |
114 | |
115 | plcd->suspended = 1; | |
116 | platform_lcd_set_power(plcd->lcd, plcd->power); | |
117 | ||
118 | return 0; | |
119 | } | |
120 | ||
67a67272 | 121 | static int platform_lcd_resume(struct device *dev) |
c25826a7 | 122 | { |
67a67272 | 123 | struct platform_lcd *plcd = dev_get_drvdata(dev); |
c25826a7 BD |
124 | |
125 | plcd->suspended = 0; | |
126 | platform_lcd_set_power(plcd->lcd, plcd->power); | |
127 | ||
128 | return 0; | |
129 | } | |
1d80d0fd | 130 | #endif |
67a67272 JH |
131 | |
132 | static SIMPLE_DEV_PM_OPS(platform_lcd_pm_ops, platform_lcd_suspend, | |
133 | platform_lcd_resume); | |
c25826a7 BD |
134 | |
135 | static struct platform_driver platform_lcd_driver = { | |
136 | .driver = { | |
137 | .name = "platform-lcd", | |
67a67272 | 138 | .pm = &platform_lcd_pm_ops, |
c25826a7 BD |
139 | }, |
140 | .probe = platform_lcd_probe, | |
c25826a7 BD |
141 | }; |
142 | ||
81178e02 | 143 | module_platform_driver(platform_lcd_driver); |
c25826a7 BD |
144 | |
145 | MODULE_AUTHOR("Ben Dooks <ben-linux@fluff.org>"); | |
146 | MODULE_LICENSE("GPL v2"); | |
147 | MODULE_ALIAS("platform:platform-lcd"); |