1 | // SPDX-License-Identifier: GPL-2.0-only |
2 | /* Copyright (c) 2010, 2011, 2016 The Linux Foundation. All rights reserved. |
3 | */ |
4 | #include <linux/leds.h> |
5 | #include <linux/module.h> |
6 | #include <linux/of.h> |
7 | #include <linux/platform_device.h> |
8 | #include <linux/pm.h> |
9 | #include <linux/regmap.h> |
10 | |
11 | #define PM8058_LED_TYPE_COMMON 0x00 |
12 | #define PM8058_LED_TYPE_KEYPAD 0x01 |
13 | #define PM8058_LED_TYPE_FLASH 0x02 |
14 | |
15 | #define PM8058_LED_TYPE_COMMON_MASK 0xf8 |
16 | #define PM8058_LED_TYPE_KEYPAD_MASK 0xf0 |
17 | #define PM8058_LED_TYPE_COMMON_SHIFT 3 |
18 | #define PM8058_LED_TYPE_KEYPAD_SHIFT 4 |
19 | |
20 | struct pm8058_led { |
21 | struct regmap *map; |
22 | u32 reg; |
23 | u32 ledtype; |
24 | struct led_classdev cdev; |
25 | }; |
26 | |
27 | static void pm8058_led_set(struct led_classdev *cled, |
28 | enum led_brightness value) |
29 | { |
30 | struct pm8058_led *led; |
31 | int ret = 0; |
32 | unsigned int mask = 0; |
33 | unsigned int val = 0; |
34 | |
35 | led = container_of(cled, struct pm8058_led, cdev); |
36 | switch (led->ledtype) { |
37 | case PM8058_LED_TYPE_COMMON: |
38 | mask = PM8058_LED_TYPE_COMMON_MASK; |
39 | val = value << PM8058_LED_TYPE_COMMON_SHIFT; |
40 | break; |
41 | case PM8058_LED_TYPE_KEYPAD: |
42 | case PM8058_LED_TYPE_FLASH: |
43 | mask = PM8058_LED_TYPE_KEYPAD_MASK; |
44 | val = value << PM8058_LED_TYPE_KEYPAD_SHIFT; |
45 | break; |
46 | default: |
47 | break; |
48 | } |
49 | |
50 | ret = regmap_update_bits(map: led->map, reg: led->reg, mask, val); |
51 | if (ret) |
52 | pr_err("Failed to set LED brightness\n" ); |
53 | } |
54 | |
55 | static enum led_brightness pm8058_led_get(struct led_classdev *cled) |
56 | { |
57 | struct pm8058_led *led; |
58 | int ret; |
59 | unsigned int val; |
60 | |
61 | led = container_of(cled, struct pm8058_led, cdev); |
62 | |
63 | ret = regmap_read(map: led->map, reg: led->reg, val: &val); |
64 | if (ret) { |
65 | pr_err("Failed to get LED brightness\n" ); |
66 | return LED_OFF; |
67 | } |
68 | |
69 | switch (led->ledtype) { |
70 | case PM8058_LED_TYPE_COMMON: |
71 | val &= PM8058_LED_TYPE_COMMON_MASK; |
72 | val >>= PM8058_LED_TYPE_COMMON_SHIFT; |
73 | break; |
74 | case PM8058_LED_TYPE_KEYPAD: |
75 | case PM8058_LED_TYPE_FLASH: |
76 | val &= PM8058_LED_TYPE_KEYPAD_MASK; |
77 | val >>= PM8058_LED_TYPE_KEYPAD_SHIFT; |
78 | break; |
79 | default: |
80 | val = LED_OFF; |
81 | break; |
82 | } |
83 | |
84 | return val; |
85 | } |
86 | |
87 | static int pm8058_led_probe(struct platform_device *pdev) |
88 | { |
89 | struct led_init_data init_data = {}; |
90 | struct device *dev = &pdev->dev; |
91 | struct pm8058_led *led; |
92 | struct device_node *np; |
93 | int ret; |
94 | struct regmap *map; |
95 | enum led_brightness maxbright; |
96 | enum led_default_state state; |
97 | |
98 | led = devm_kzalloc(dev, size: sizeof(*led), GFP_KERNEL); |
99 | if (!led) |
100 | return -ENOMEM; |
101 | |
102 | led->ledtype = (u32)(unsigned long)of_device_get_match_data(dev); |
103 | |
104 | map = dev_get_regmap(dev: dev->parent, NULL); |
105 | if (!map) { |
106 | dev_err(dev, "Parent regmap unavailable.\n" ); |
107 | return -ENXIO; |
108 | } |
109 | led->map = map; |
110 | |
111 | np = dev_of_node(dev); |
112 | |
113 | ret = of_property_read_u32(np, propname: "reg" , out_value: &led->reg); |
114 | if (ret) { |
115 | dev_err(dev, "no register offset specified\n" ); |
116 | return -EINVAL; |
117 | } |
118 | |
119 | led->cdev.brightness_set = pm8058_led_set; |
120 | led->cdev.brightness_get = pm8058_led_get; |
121 | if (led->ledtype == PM8058_LED_TYPE_COMMON) |
122 | maxbright = 31; /* 5 bits */ |
123 | else |
124 | maxbright = 15; /* 4 bits */ |
125 | led->cdev.max_brightness = maxbright; |
126 | |
127 | init_data.fwnode = of_fwnode_handle(np); |
128 | |
129 | state = led_init_default_state_get(fwnode: init_data.fwnode); |
130 | switch (state) { |
131 | case LEDS_DEFSTATE_ON: |
132 | led->cdev.brightness = maxbright; |
133 | pm8058_led_set(cled: &led->cdev, value: maxbright); |
134 | break; |
135 | case LEDS_DEFSTATE_KEEP: |
136 | led->cdev.brightness = pm8058_led_get(cled: &led->cdev); |
137 | break; |
138 | default: |
139 | led->cdev.brightness = LED_OFF; |
140 | pm8058_led_set(cled: &led->cdev, value: LED_OFF); |
141 | } |
142 | |
143 | if (led->ledtype == PM8058_LED_TYPE_KEYPAD || |
144 | led->ledtype == PM8058_LED_TYPE_FLASH) |
145 | led->cdev.flags = LED_CORE_SUSPENDRESUME; |
146 | |
147 | ret = devm_led_classdev_register_ext(parent: dev, led_cdev: &led->cdev, init_data: &init_data); |
148 | if (ret) |
149 | dev_err(dev, "Failed to register LED for %pOF\n" , np); |
150 | |
151 | return ret; |
152 | } |
153 | |
154 | static const struct of_device_id pm8058_leds_id_table[] = { |
155 | { |
156 | .compatible = "qcom,pm8058-led" , |
157 | .data = (void *)PM8058_LED_TYPE_COMMON |
158 | }, |
159 | { |
160 | .compatible = "qcom,pm8058-keypad-led" , |
161 | .data = (void *)PM8058_LED_TYPE_KEYPAD |
162 | }, |
163 | { |
164 | .compatible = "qcom,pm8058-flash-led" , |
165 | .data = (void *)PM8058_LED_TYPE_FLASH |
166 | }, |
167 | { }, |
168 | }; |
169 | MODULE_DEVICE_TABLE(of, pm8058_leds_id_table); |
170 | |
171 | static struct platform_driver pm8058_led_driver = { |
172 | .probe = pm8058_led_probe, |
173 | .driver = { |
174 | .name = "pm8058-leds" , |
175 | .of_match_table = pm8058_leds_id_table, |
176 | }, |
177 | }; |
178 | module_platform_driver(pm8058_led_driver); |
179 | |
180 | MODULE_DESCRIPTION("PM8058 LEDs driver" ); |
181 | MODULE_LICENSE("GPL v2" ); |
182 | MODULE_ALIAS("platform:pm8058-leds" ); |
183 | |