Commit | Line | Data |
---|---|---|
36edc939 | 1 | // SPDX-License-Identifier: GPL-2.0-only |
8c40b7d0 NS |
2 | /* |
3 | * Copyright 2015-16 Golden Delicious Computers | |
4 | * | |
5 | * Author: Nikolaus Schaller <hns@goldelico.com> | |
6 | * | |
8c40b7d0 NS |
7 | * LED driver for the IS31FL319{0,1,3,6,9} to drive 1, 3, 6 or 9 light |
8 | * effect LEDs. | |
8c40b7d0 NS |
9 | */ |
10 | ||
11 | #include <linux/err.h> | |
12 | #include <linux/i2c.h> | |
13 | #include <linux/leds.h> | |
69a9b172 | 14 | #include <linux/mod_devicetable.h> |
8c40b7d0 | 15 | #include <linux/module.h> |
69a9b172 | 16 | #include <linux/property.h> |
8c40b7d0 NS |
17 | #include <linux/regmap.h> |
18 | #include <linux/slab.h> | |
dddb4e38 GF |
19 | #include <linux/delay.h> |
20 | #include <linux/gpio/consumer.h> | |
8c40b7d0 NS |
21 | |
22 | /* register numbers */ | |
23 | #define IS31FL319X_SHUTDOWN 0x00 | |
fa877cf1 VK |
24 | |
25 | /* registers for 3190, 3191 and 3193 */ | |
26 | #define IS31FL3190_BREATHING 0x01 | |
27 | #define IS31FL3190_LEDMODE 0x02 | |
28 | #define IS31FL3190_CURRENT 0x03 | |
29 | #define IS31FL3190_PWM(channel) (0x04 + channel) | |
30 | #define IS31FL3190_DATA_UPDATE 0x07 | |
31 | #define IS31FL3190_T0(channel) (0x0a + channel) | |
32 | #define IS31FL3190_T1T2(channel) (0x10 + channel) | |
33 | #define IS31FL3190_T3T4(channel) (0x16 + channel) | |
34 | #define IS31FL3190_TIME_UPDATE 0x1c | |
35 | #define IS31FL3190_LEDCONTROL 0x1d | |
36 | #define IS31FL3190_RESET 0x2f | |
37 | ||
38 | #define IS31FL3190_CURRENT_uA_MIN 5000 | |
39 | #define IS31FL3190_CURRENT_uA_DEFAULT 42000 | |
40 | #define IS31FL3190_CURRENT_uA_MAX 42000 | |
135780f1 | 41 | #define IS31FL3190_CURRENT_SHIFT 2 |
fa877cf1 VK |
42 | #define IS31FL3190_CURRENT_MASK GENMASK(4, 2) |
43 | #define IS31FL3190_CURRENT_5_mA 0x02 | |
44 | #define IS31FL3190_CURRENT_10_mA 0x01 | |
45 | #define IS31FL3190_CURRENT_17dot5_mA 0x04 | |
46 | #define IS31FL3190_CURRENT_30_mA 0x03 | |
47 | #define IS31FL3190_CURRENT_42_mA 0x00 | |
48 | ||
49 | /* registers for 3196 and 3199 */ | |
8e6dde1b VK |
50 | #define IS31FL3196_CTRL1 0x01 |
51 | #define IS31FL3196_CTRL2 0x02 | |
52 | #define IS31FL3196_CONFIG1 0x03 | |
53 | #define IS31FL3196_CONFIG2 0x04 | |
54 | #define IS31FL3196_RAMP_MODE 0x05 | |
55 | #define IS31FL3196_BREATH_MARK 0x06 | |
56 | #define IS31FL3196_PWM(channel) (0x07 + channel) | |
57 | #define IS31FL3196_DATA_UPDATE 0x10 | |
58 | #define IS31FL3196_T0(channel) (0x11 + channel) | |
59 | #define IS31FL3196_T123_1 0x1a | |
60 | #define IS31FL3196_T123_2 0x1b | |
61 | #define IS31FL3196_T123_3 0x1c | |
62 | #define IS31FL3196_T4(channel) (0x1d + channel) | |
63 | #define IS31FL3196_TIME_UPDATE 0x26 | |
64 | #define IS31FL3196_RESET 0xff | |
65 | ||
66 | #define IS31FL3196_REG_CNT (IS31FL3196_RESET + 1) | |
8c40b7d0 NS |
67 | |
68 | #define IS31FL319X_MAX_LEDS 9 | |
69 | ||
70 | /* CS (Current Setting) in CONFIG2 register */ | |
8e6dde1b VK |
71 | #define IS31FL3196_CONFIG2_CS_SHIFT 4 |
72 | #define IS31FL3196_CONFIG2_CS_MASK GENMASK(2, 0) | |
73 | #define IS31FL3196_CONFIG2_CS_STEP_REF 12 | |
8c40b7d0 | 74 | |
8e6dde1b VK |
75 | #define IS31FL3196_CURRENT_uA_MIN 5000 |
76 | #define IS31FL3196_CURRENT_uA_MAX 40000 | |
77 | #define IS31FL3196_CURRENT_uA_STEP 5000 | |
78 | #define IS31FL3196_CURRENT_uA_DEFAULT 20000 | |
8c40b7d0 NS |
79 | |
80 | /* Audio gain in CONFIG2 register */ | |
8e6dde1b VK |
81 | #define IS31FL3196_AUDIO_GAIN_DB_MAX ((u32)21) |
82 | #define IS31FL3196_AUDIO_GAIN_DB_STEP 3 | |
8c40b7d0 NS |
83 | |
84 | /* | |
85 | * regmap is used as a cache of chip's register space, | |
86 | * to avoid reading back brightness values from chip, | |
87 | * which is known to hang. | |
88 | */ | |
89 | struct is31fl319x_chip { | |
90 | const struct is31fl319x_chipdef *cdef; | |
91 | struct i2c_client *client; | |
dddb4e38 | 92 | struct gpio_desc *shutdown_gpio; |
8c40b7d0 NS |
93 | struct regmap *regmap; |
94 | struct mutex lock; | |
95 | u32 audio_gain_db; | |
96 | ||
97 | struct is31fl319x_led { | |
98 | struct is31fl319x_chip *chip; | |
99 | struct led_classdev cdev; | |
100 | u32 max_microamp; | |
101 | bool configured; | |
102 | } leds[IS31FL319X_MAX_LEDS]; | |
103 | }; | |
104 | ||
105 | struct is31fl319x_chipdef { | |
106 | int num_leds; | |
bd34266f VK |
107 | u8 reset_reg; |
108 | const struct regmap_config *is31fl319x_regmap_config; | |
109 | int (*brightness_set)(struct led_classdev *cdev, enum led_brightness brightness); | |
110 | u32 current_default; | |
111 | u32 current_min; | |
112 | u32 current_max; | |
113 | bool is_3196or3199; | |
8c40b7d0 NS |
114 | }; |
115 | ||
bd34266f VK |
116 | static bool is31fl319x_readable_reg(struct device *dev, unsigned int reg) |
117 | { | |
118 | /* we have no readable registers */ | |
119 | return false; | |
120 | } | |
8c40b7d0 | 121 | |
fa877cf1 VK |
122 | static bool is31fl3190_volatile_reg(struct device *dev, unsigned int reg) |
123 | { | |
124 | /* volatile registers are not cached */ | |
125 | switch (reg) { | |
126 | case IS31FL3190_DATA_UPDATE: | |
127 | case IS31FL3190_TIME_UPDATE: | |
128 | case IS31FL3190_RESET: | |
129 | return true; /* always write-through */ | |
130 | default: | |
131 | return false; | |
132 | } | |
133 | } | |
134 | ||
135 | static const struct reg_default is31fl3190_reg_defaults[] = { | |
136 | { IS31FL3190_LEDMODE, 0x00 }, | |
137 | { IS31FL3190_CURRENT, 0x00 }, | |
138 | { IS31FL3190_PWM(0), 0x00 }, | |
139 | { IS31FL3190_PWM(1), 0x00 }, | |
140 | { IS31FL3190_PWM(2), 0x00 }, | |
141 | }; | |
142 | ||
4a598907 | 143 | static const struct regmap_config is31fl3190_regmap_config = { |
fa877cf1 VK |
144 | .reg_bits = 8, |
145 | .val_bits = 8, | |
146 | .max_register = IS31FL3190_RESET, | |
147 | .cache_type = REGCACHE_FLAT, | |
148 | .readable_reg = is31fl319x_readable_reg, | |
149 | .volatile_reg = is31fl3190_volatile_reg, | |
150 | .reg_defaults = is31fl3190_reg_defaults, | |
151 | .num_reg_defaults = ARRAY_SIZE(is31fl3190_reg_defaults), | |
152 | }; | |
153 | ||
bd34266f VK |
154 | static bool is31fl3196_volatile_reg(struct device *dev, unsigned int reg) |
155 | { | |
156 | /* volatile registers are not cached */ | |
157 | switch (reg) { | |
158 | case IS31FL3196_DATA_UPDATE: | |
159 | case IS31FL3196_TIME_UPDATE: | |
160 | case IS31FL3196_RESET: | |
161 | return true; /* always write-through */ | |
162 | default: | |
163 | return false; | |
164 | } | |
165 | } | |
8c40b7d0 | 166 | |
bd34266f VK |
167 | static const struct reg_default is31fl3196_reg_defaults[] = { |
168 | { IS31FL3196_CONFIG1, 0x00 }, | |
169 | { IS31FL3196_CONFIG2, 0x00 }, | |
170 | { IS31FL3196_PWM(0), 0x00 }, | |
171 | { IS31FL3196_PWM(1), 0x00 }, | |
172 | { IS31FL3196_PWM(2), 0x00 }, | |
173 | { IS31FL3196_PWM(3), 0x00 }, | |
174 | { IS31FL3196_PWM(4), 0x00 }, | |
175 | { IS31FL3196_PWM(5), 0x00 }, | |
176 | { IS31FL3196_PWM(6), 0x00 }, | |
177 | { IS31FL3196_PWM(7), 0x00 }, | |
178 | { IS31FL3196_PWM(8), 0x00 }, | |
8c40b7d0 NS |
179 | }; |
180 | ||
4a598907 | 181 | static const struct regmap_config is31fl3196_regmap_config = { |
bd34266f VK |
182 | .reg_bits = 8, |
183 | .val_bits = 8, | |
184 | .max_register = IS31FL3196_REG_CNT, | |
185 | .cache_type = REGCACHE_FLAT, | |
186 | .readable_reg = is31fl319x_readable_reg, | |
187 | .volatile_reg = is31fl3196_volatile_reg, | |
188 | .reg_defaults = is31fl3196_reg_defaults, | |
189 | .num_reg_defaults = ARRAY_SIZE(is31fl3196_reg_defaults), | |
8c40b7d0 | 190 | }; |
8c40b7d0 | 191 | |
fa877cf1 VK |
192 | static int is31fl3190_brightness_set(struct led_classdev *cdev, |
193 | enum led_brightness brightness) | |
194 | { | |
195 | struct is31fl319x_led *led = container_of(cdev, struct is31fl319x_led, cdev); | |
196 | struct is31fl319x_chip *is31 = led->chip; | |
197 | int chan = led - is31->leds; | |
198 | int ret; | |
199 | int i; | |
200 | u8 ctrl = 0; | |
201 | ||
77426834 | 202 | dev_dbg(&is31->client->dev, "channel %d: %d\n", chan, brightness); |
fa877cf1 VK |
203 | |
204 | mutex_lock(&is31->lock); | |
205 | ||
206 | /* update PWM register */ | |
207 | ret = regmap_write(is31->regmap, IS31FL3190_PWM(chan), brightness); | |
208 | if (ret < 0) | |
209 | goto out; | |
210 | ||
211 | /* read current brightness of all PWM channels */ | |
212 | for (i = 0; i < is31->cdef->num_leds; i++) { | |
213 | unsigned int pwm_value; | |
214 | bool on; | |
215 | ||
216 | /* | |
217 | * since neither cdev nor the chip can provide | |
218 | * the current setting, we read from the regmap cache | |
219 | */ | |
220 | ||
221 | ret = regmap_read(is31->regmap, IS31FL3190_PWM(i), &pwm_value); | |
222 | on = ret >= 0 && pwm_value > LED_OFF; | |
223 | ||
224 | ctrl |= on << i; | |
225 | } | |
226 | ||
227 | if (ctrl > 0) { | |
228 | dev_dbg(&is31->client->dev, "power up %02x\n", ctrl); | |
229 | regmap_write(is31->regmap, IS31FL3190_LEDCONTROL, ctrl); | |
230 | /* update PWMs */ | |
231 | regmap_write(is31->regmap, IS31FL3190_DATA_UPDATE, 0x00); | |
232 | /* enable chip from shut down and enable all channels */ | |
233 | ret = regmap_write(is31->regmap, IS31FL319X_SHUTDOWN, 0x20); | |
234 | } else { | |
235 | dev_dbg(&is31->client->dev, "power down\n"); | |
236 | /* shut down (no need to clear LEDCONTROL) */ | |
237 | ret = regmap_write(is31->regmap, IS31FL319X_SHUTDOWN, 0x01); | |
238 | } | |
239 | ||
240 | out: | |
241 | mutex_unlock(&is31->lock); | |
242 | ||
243 | return ret; | |
244 | } | |
245 | ||
8e6dde1b | 246 | static int is31fl3196_brightness_set(struct led_classdev *cdev, |
8c40b7d0 NS |
247 | enum led_brightness brightness) |
248 | { | |
77426834 | 249 | struct is31fl319x_led *led = container_of(cdev, struct is31fl319x_led, cdev); |
8c40b7d0 NS |
250 | struct is31fl319x_chip *is31 = led->chip; |
251 | int chan = led - is31->leds; | |
252 | int ret; | |
253 | int i; | |
254 | u8 ctrl1 = 0, ctrl2 = 0; | |
255 | ||
77426834 | 256 | dev_dbg(&is31->client->dev, "channel %d: %d\n", chan, brightness); |
8c40b7d0 NS |
257 | |
258 | mutex_lock(&is31->lock); | |
259 | ||
260 | /* update PWM register */ | |
8e6dde1b | 261 | ret = regmap_write(is31->regmap, IS31FL3196_PWM(chan), brightness); |
8c40b7d0 NS |
262 | if (ret < 0) |
263 | goto out; | |
264 | ||
265 | /* read current brightness of all PWM channels */ | |
266 | for (i = 0; i < is31->cdef->num_leds; i++) { | |
267 | unsigned int pwm_value; | |
268 | bool on; | |
269 | ||
270 | /* | |
271 | * since neither cdev nor the chip can provide | |
272 | * the current setting, we read from the regmap cache | |
273 | */ | |
274 | ||
8e6dde1b | 275 | ret = regmap_read(is31->regmap, IS31FL3196_PWM(i), &pwm_value); |
8c40b7d0 NS |
276 | on = ret >= 0 && pwm_value > LED_OFF; |
277 | ||
278 | if (i < 3) | |
279 | ctrl1 |= on << i; /* 0..2 => bit 0..2 */ | |
280 | else if (i < 6) | |
281 | ctrl1 |= on << (i + 1); /* 3..5 => bit 4..6 */ | |
282 | else | |
283 | ctrl2 |= on << (i - 6); /* 6..8 => bit 0..2 */ | |
284 | } | |
285 | ||
286 | if (ctrl1 > 0 || ctrl2 > 0) { | |
287 | dev_dbg(&is31->client->dev, "power up %02x %02x\n", | |
288 | ctrl1, ctrl2); | |
8e6dde1b VK |
289 | regmap_write(is31->regmap, IS31FL3196_CTRL1, ctrl1); |
290 | regmap_write(is31->regmap, IS31FL3196_CTRL2, ctrl2); | |
8c40b7d0 | 291 | /* update PWMs */ |
8e6dde1b | 292 | regmap_write(is31->regmap, IS31FL3196_DATA_UPDATE, 0x00); |
8c40b7d0 NS |
293 | /* enable chip from shut down */ |
294 | ret = regmap_write(is31->regmap, IS31FL319X_SHUTDOWN, 0x01); | |
295 | } else { | |
296 | dev_dbg(&is31->client->dev, "power down\n"); | |
297 | /* shut down (no need to clear CTRL1/2) */ | |
298 | ret = regmap_write(is31->regmap, IS31FL319X_SHUTDOWN, 0x00); | |
299 | } | |
300 | ||
301 | out: | |
302 | mutex_unlock(&is31->lock); | |
303 | ||
304 | return ret; | |
305 | } | |
306 | ||
bd34266f VK |
307 | static const struct is31fl319x_chipdef is31fl3190_cdef = { |
308 | .num_leds = 1, | |
fa877cf1 VK |
309 | .reset_reg = IS31FL3190_RESET, |
310 | .is31fl319x_regmap_config = &is31fl3190_regmap_config, | |
311 | .brightness_set = is31fl3190_brightness_set, | |
312 | .current_default = IS31FL3190_CURRENT_uA_DEFAULT, | |
313 | .current_min = IS31FL3190_CURRENT_uA_MIN, | |
314 | .current_max = IS31FL3190_CURRENT_uA_MAX, | |
315 | .is_3196or3199 = false, | |
bd34266f VK |
316 | }; |
317 | ||
318 | static const struct is31fl319x_chipdef is31fl3193_cdef = { | |
319 | .num_leds = 3, | |
fa877cf1 VK |
320 | .reset_reg = IS31FL3190_RESET, |
321 | .is31fl319x_regmap_config = &is31fl3190_regmap_config, | |
322 | .brightness_set = is31fl3190_brightness_set, | |
323 | .current_default = IS31FL3190_CURRENT_uA_DEFAULT, | |
324 | .current_min = IS31FL3190_CURRENT_uA_MIN, | |
325 | .current_max = IS31FL3190_CURRENT_uA_MAX, | |
326 | .is_3196or3199 = false, | |
bd34266f VK |
327 | }; |
328 | ||
329 | static const struct is31fl319x_chipdef is31fl3196_cdef = { | |
330 | .num_leds = 6, | |
331 | .reset_reg = IS31FL3196_RESET, | |
332 | .is31fl319x_regmap_config = &is31fl3196_regmap_config, | |
333 | .brightness_set = is31fl3196_brightness_set, | |
334 | .current_default = IS31FL3196_CURRENT_uA_DEFAULT, | |
335 | .current_min = IS31FL3196_CURRENT_uA_MIN, | |
336 | .current_max = IS31FL3196_CURRENT_uA_MAX, | |
337 | .is_3196or3199 = true, | |
338 | }; | |
339 | ||
340 | static const struct is31fl319x_chipdef is31fl3199_cdef = { | |
341 | .num_leds = 9, | |
342 | .reset_reg = IS31FL3196_RESET, | |
343 | .is31fl319x_regmap_config = &is31fl3196_regmap_config, | |
344 | .brightness_set = is31fl3196_brightness_set, | |
345 | .current_default = IS31FL3196_CURRENT_uA_DEFAULT, | |
346 | .current_min = IS31FL3196_CURRENT_uA_MIN, | |
347 | .current_max = IS31FL3196_CURRENT_uA_MAX, | |
348 | .is_3196or3199 = true, | |
349 | }; | |
350 | ||
351 | static const struct of_device_id of_is31fl319x_match[] = { | |
352 | { .compatible = "issi,is31fl3190", .data = &is31fl3190_cdef, }, | |
353 | { .compatible = "issi,is31fl3191", .data = &is31fl3190_cdef, }, | |
354 | { .compatible = "issi,is31fl3193", .data = &is31fl3193_cdef, }, | |
355 | { .compatible = "issi,is31fl3196", .data = &is31fl3196_cdef, }, | |
356 | { .compatible = "issi,is31fl3199", .data = &is31fl3199_cdef, }, | |
357 | { .compatible = "si-en,sn3190", .data = &is31fl3190_cdef, }, | |
358 | { .compatible = "si-en,sn3191", .data = &is31fl3190_cdef, }, | |
359 | { .compatible = "si-en,sn3193", .data = &is31fl3193_cdef, }, | |
360 | { .compatible = "si-en,sn3196", .data = &is31fl3196_cdef, }, | |
361 | { .compatible = "si-en,sn3199", .data = &is31fl3199_cdef, }, | |
362 | { } | |
363 | }; | |
364 | MODULE_DEVICE_TABLE(of, of_is31fl319x_match); | |
365 | ||
69a9b172 AS |
366 | static int is31fl319x_parse_child_fw(const struct device *dev, |
367 | const struct fwnode_handle *child, | |
bd34266f VK |
368 | struct is31fl319x_led *led, |
369 | struct is31fl319x_chip *is31) | |
8c40b7d0 NS |
370 | { |
371 | struct led_classdev *cdev = &led->cdev; | |
372 | int ret; | |
373 | ||
69a9b172 AS |
374 | if (fwnode_property_read_string(child, "label", &cdev->name)) |
375 | cdev->name = fwnode_get_name(child); | |
8c40b7d0 | 376 | |
69a9b172 | 377 | ret = fwnode_property_read_string(child, "linux,default-trigger", &cdev->default_trigger); |
8c40b7d0 NS |
378 | if (ret < 0 && ret != -EINVAL) /* is optional */ |
379 | return ret; | |
380 | ||
bd34266f | 381 | led->max_microamp = is31->cdef->current_default; |
69a9b172 | 382 | ret = fwnode_property_read_u32(child, "led-max-microamp", &led->max_microamp); |
8c40b7d0 | 383 | if (!ret) { |
bd34266f | 384 | if (led->max_microamp < is31->cdef->current_min) |
8c40b7d0 NS |
385 | return -EINVAL; /* not supported */ |
386 | led->max_microamp = min(led->max_microamp, | |
bd34266f | 387 | is31->cdef->current_max); |
8c40b7d0 NS |
388 | } |
389 | ||
390 | return 0; | |
391 | } | |
392 | ||
69a9b172 | 393 | static int is31fl319x_parse_fw(struct device *dev, struct is31fl319x_chip *is31) |
8c40b7d0 | 394 | { |
10cc4876 | 395 | struct fwnode_handle *fwnode = dev_fwnode(dev); |
8c40b7d0 NS |
396 | int count; |
397 | int ret; | |
398 | ||
77426834 | 399 | is31->shutdown_gpio = devm_gpiod_get_optional(dev, "shutdown", GPIOD_OUT_HIGH); |
0d77252b AS |
400 | if (IS_ERR(is31->shutdown_gpio)) |
401 | return dev_err_probe(dev, PTR_ERR(is31->shutdown_gpio), | |
402 | "Failed to get shutdown gpio\n"); | |
dddb4e38 | 403 | |
2779f472 | 404 | is31->cdef = device_get_match_data(dev); |
8c40b7d0 | 405 | |
69a9b172 | 406 | count = 0; |
10cc4876 | 407 | device_for_each_child_node_scoped(dev, child) |
69a9b172 | 408 | count++; |
8c40b7d0 | 409 | |
2779f472 | 410 | dev_dbg(dev, "probing with %d leds defined in DT\n", count); |
8c40b7d0 | 411 | |
0d77252b AS |
412 | if (!count || count > is31->cdef->num_leds) |
413 | return dev_err_probe(dev, -ENODEV, | |
414 | "Number of leds defined must be between 1 and %u\n", | |
415 | is31->cdef->num_leds); | |
8c40b7d0 | 416 | |
10cc4876 | 417 | device_for_each_child_node_scoped(dev, child) { |
8c40b7d0 NS |
418 | struct is31fl319x_led *led; |
419 | u32 reg; | |
420 | ||
69a9b172 | 421 | ret = fwnode_property_read_u32(child, "reg", ®); |
10cc4876 JC |
422 | if (ret) |
423 | return dev_err_probe(dev, ret, "Failed to read led 'reg' property\n"); | |
8c40b7d0 | 424 | |
10cc4876 JC |
425 | if (reg < 1 || reg > is31->cdef->num_leds) |
426 | return dev_err_probe(dev, -EINVAL, "invalid led reg %u\n", reg); | |
8c40b7d0 NS |
427 | |
428 | led = &is31->leds[reg - 1]; | |
429 | ||
10cc4876 JC |
430 | if (led->configured) |
431 | return dev_err_probe(dev, -EINVAL, "led %u is already configured\n", reg); | |
8c40b7d0 | 432 | |
69a9b172 | 433 | ret = is31fl319x_parse_child_fw(dev, child, led, is31); |
10cc4876 JC |
434 | if (ret) |
435 | return dev_err_probe(dev, ret, "led %u DT parsing failed\n", reg); | |
8c40b7d0 NS |
436 | |
437 | led->configured = true; | |
438 | } | |
439 | ||
440 | is31->audio_gain_db = 0; | |
bd34266f | 441 | if (is31->cdef->is_3196or3199) { |
69a9b172 | 442 | ret = fwnode_property_read_u32(fwnode, "audio-gain-db", &is31->audio_gain_db); |
bd34266f VK |
443 | if (!ret) |
444 | is31->audio_gain_db = min(is31->audio_gain_db, | |
445 | IS31FL3196_AUDIO_GAIN_DB_MAX); | |
446 | } | |
8c40b7d0 NS |
447 | |
448 | return 0; | |
8c40b7d0 NS |
449 | } |
450 | ||
fa877cf1 VK |
451 | static inline int is31fl3190_microamp_to_cs(struct device *dev, u32 microamp) |
452 | { | |
453 | switch (microamp) { | |
454 | case 5000: | |
455 | return IS31FL3190_CURRENT_5_mA; | |
456 | case 10000: | |
457 | return IS31FL3190_CURRENT_10_mA; | |
458 | case 17500: | |
459 | return IS31FL3190_CURRENT_17dot5_mA; | |
460 | case 30000: | |
461 | return IS31FL3190_CURRENT_30_mA; | |
462 | case 42000: | |
463 | return IS31FL3190_CURRENT_42_mA; | |
464 | default: | |
465 | dev_warn(dev, "Unsupported current value: %d, using 5000 µA!\n", microamp); | |
466 | return IS31FL3190_CURRENT_5_mA; | |
467 | } | |
468 | } | |
469 | ||
8e6dde1b | 470 | static inline int is31fl3196_microamp_to_cs(struct device *dev, u32 microamp) |
77426834 VK |
471 | { |
472 | /* round down to nearest supported value (range check done by caller) */ | |
8e6dde1b | 473 | u32 step = microamp / IS31FL3196_CURRENT_uA_STEP; |
8c40b7d0 | 474 | |
8e6dde1b VK |
475 | return ((IS31FL3196_CONFIG2_CS_STEP_REF - step) & |
476 | IS31FL3196_CONFIG2_CS_MASK) << | |
477 | IS31FL3196_CONFIG2_CS_SHIFT; /* CS encoding */ | |
8c40b7d0 NS |
478 | } |
479 | ||
8e6dde1b | 480 | static inline int is31fl3196_db_to_gain(u32 dezibel) |
77426834 VK |
481 | { |
482 | /* round down to nearest supported value (range check done by caller) */ | |
8e6dde1b | 483 | return dezibel / IS31FL3196_AUDIO_GAIN_DB_STEP; |
8c40b7d0 NS |
484 | } |
485 | ||
a82c7cf8 AS |
486 | static void is31f1319x_mutex_destroy(void *lock) |
487 | { | |
488 | mutex_destroy(lock); | |
489 | } | |
490 | ||
38ba0bb2 | 491 | static int is31fl319x_probe(struct i2c_client *client) |
8c40b7d0 NS |
492 | { |
493 | struct is31fl319x_chip *is31; | |
494 | struct device *dev = &client->dev; | |
8c40b7d0 NS |
495 | int err; |
496 | int i = 0; | |
bd34266f | 497 | u32 aggregated_led_microamp; |
8c40b7d0 | 498 | |
7d9d60bd | 499 | if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) |
8c40b7d0 NS |
500 | return -EIO; |
501 | ||
502 | is31 = devm_kzalloc(&client->dev, sizeof(*is31), GFP_KERNEL); | |
503 | if (!is31) | |
504 | return -ENOMEM; | |
505 | ||
506 | mutex_init(&is31->lock); | |
a82c7cf8 | 507 | err = devm_add_action_or_reset(dev, is31f1319x_mutex_destroy, &is31->lock); |
e1af5c81 AS |
508 | if (err) |
509 | return err; | |
8c40b7d0 | 510 | |
69a9b172 | 511 | err = is31fl319x_parse_fw(&client->dev, is31); |
8c40b7d0 | 512 | if (err) |
e1af5c81 | 513 | return err; |
8c40b7d0 | 514 | |
dddb4e38 GF |
515 | if (is31->shutdown_gpio) { |
516 | gpiod_direction_output(is31->shutdown_gpio, 0); | |
517 | mdelay(5); | |
518 | gpiod_direction_output(is31->shutdown_gpio, 1); | |
519 | } | |
520 | ||
8c40b7d0 | 521 | is31->client = client; |
bd34266f | 522 | is31->regmap = devm_regmap_init_i2c(client, is31->cdef->is31fl319x_regmap_config); |
e1af5c81 AS |
523 | if (IS_ERR(is31->regmap)) |
524 | return dev_err_probe(dev, PTR_ERR(is31->regmap), "failed to allocate register map\n"); | |
8c40b7d0 NS |
525 | |
526 | i2c_set_clientdata(client, is31); | |
527 | ||
528 | /* check for write-reply from chip (we can't read any registers) */ | |
bd34266f | 529 | err = regmap_write(is31->regmap, is31->cdef->reset_reg, 0x00); |
e1af5c81 AS |
530 | if (err < 0) |
531 | return dev_err_probe(dev, err, "no response from chip write\n"); | |
8c40b7d0 NS |
532 | |
533 | /* | |
534 | * Kernel conventions require per-LED led-max-microamp property. | |
535 | * But the chip does not allow to limit individual LEDs. | |
536 | * So we take minimum from all subnodes for safety of hardware. | |
537 | */ | |
bd34266f | 538 | aggregated_led_microamp = is31->cdef->current_max; |
8c40b7d0 NS |
539 | for (i = 0; i < is31->cdef->num_leds; i++) |
540 | if (is31->leds[i].configured && | |
541 | is31->leds[i].max_microamp < aggregated_led_microamp) | |
542 | aggregated_led_microamp = is31->leds[i].max_microamp; | |
543 | ||
bd34266f VK |
544 | if (is31->cdef->is_3196or3199) |
545 | regmap_write(is31->regmap, IS31FL3196_CONFIG2, | |
546 | is31fl3196_microamp_to_cs(dev, aggregated_led_microamp) | | |
547 | is31fl3196_db_to_gain(is31->audio_gain_db)); | |
fa877cf1 VK |
548 | else |
549 | regmap_update_bits(is31->regmap, IS31FL3190_CURRENT, IS31FL3190_CURRENT_MASK, | |
135780f1 | 550 | is31fl3190_microamp_to_cs(dev, aggregated_led_microamp) << IS31FL3190_CURRENT_SHIFT); |
8c40b7d0 NS |
551 | |
552 | for (i = 0; i < is31->cdef->num_leds; i++) { | |
553 | struct is31fl319x_led *led = &is31->leds[i]; | |
554 | ||
555 | if (!led->configured) | |
556 | continue; | |
557 | ||
558 | led->chip = is31; | |
bd34266f | 559 | led->cdev.brightness_set_blocking = is31->cdef->brightness_set; |
8c40b7d0 NS |
560 | |
561 | err = devm_led_classdev_register(&client->dev, &led->cdev); | |
562 | if (err < 0) | |
e1af5c81 | 563 | return err; |
8c40b7d0 NS |
564 | } |
565 | ||
566 | return 0; | |
8c40b7d0 NS |
567 | } |
568 | ||
569 | /* | |
570 | * i2c-core (and modalias) requires that id_table be properly filled, | |
571 | * even though it is not used for DeviceTree based instantiation. | |
572 | */ | |
573 | static const struct i2c_device_id is31fl319x_id[] = { | |
574 | { "is31fl3190" }, | |
575 | { "is31fl3191" }, | |
576 | { "is31fl3193" }, | |
577 | { "is31fl3196" }, | |
578 | { "is31fl3199" }, | |
dc6d28f4 VK |
579 | { "sn3190" }, |
580 | { "sn3191" }, | |
581 | { "sn3193" }, | |
582 | { "sn3196" }, | |
8c40b7d0 NS |
583 | { "sn3199" }, |
584 | {}, | |
585 | }; | |
586 | MODULE_DEVICE_TABLE(i2c, is31fl319x_id); | |
587 | ||
588 | static struct i2c_driver is31fl319x_driver = { | |
589 | .driver = { | |
590 | .name = "leds-is31fl319x", | |
69a9b172 | 591 | .of_match_table = of_is31fl319x_match, |
8c40b7d0 | 592 | }, |
d9ff8a8e | 593 | .probe = is31fl319x_probe, |
8c40b7d0 NS |
594 | .id_table = is31fl319x_id, |
595 | }; | |
596 | ||
597 | module_i2c_driver(is31fl319x_driver); | |
598 | ||
599 | MODULE_AUTHOR("H. Nikolaus Schaller <hns@goldelico.com>"); | |
600 | MODULE_AUTHOR("Andrey Utkin <andrey_utkin@fastmail.com>"); | |
601 | MODULE_DESCRIPTION("IS31FL319X LED driver"); | |
602 | MODULE_LICENSE("GPL v2"); |