1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * TI Palmas MFD Driver
4 *
5 * Copyright 2011-2012 Texas Instruments Inc.
6 *
7 * Author: Graeme Gregory <gg@slimlogic.co.uk>
8 */
9
10 #include <linux/module.h>
11 #include <linux/moduleparam.h>
12 #include <linux/init.h>
13 #include <linux/slab.h>
14 #include <linux/i2c.h>
15 #include <linux/interrupt.h>
16 #include <linux/irq.h>
17 #include <linux/regmap.h>
18 #include <linux/err.h>
19 #include <linux/mfd/core.h>
20 #include <linux/mfd/palmas.h>
21 #include <linux/of.h>
22 #include <linux/of_platform.h>
23
24 static const struct regmap_config palmas_regmap_config[PALMAS_NUM_CLIENTS] = {
25 {
26 .reg_bits = 8,
27 .val_bits = 8,
28 .max_register = PALMAS_BASE_TO_REG(PALMAS_PU_PD_OD_BASE,
29 PALMAS_PRIMARY_SECONDARY_PAD3),
30 },
31 {
32 .reg_bits = 8,
33 .val_bits = 8,
34 .max_register = PALMAS_BASE_TO_REG(PALMAS_GPADC_BASE,
35 PALMAS_GPADC_SMPS_VSEL_MONITORING),
36 },
37 {
38 .reg_bits = 8,
39 .val_bits = 8,
40 .max_register = PALMAS_BASE_TO_REG(PALMAS_TRIM_GPADC_BASE,
41 PALMAS_GPADC_TRIM16),
42 },
43 };
44
45 static const struct regmap_irq tps65917_irqs[] = {
46 /* INT1 IRQs */
47 [TPS65917_RESERVED1] = {
48 .mask = TPS65917_RESERVED,
49 },
50 [TPS65917_PWRON_IRQ] = {
51 .mask = TPS65917_INT1_STATUS_PWRON,
52 },
53 [TPS65917_LONG_PRESS_KEY_IRQ] = {
54 .mask = TPS65917_INT1_STATUS_LONG_PRESS_KEY,
55 },
56 [TPS65917_RESERVED2] = {
57 .mask = TPS65917_RESERVED,
58 },
59 [TPS65917_PWRDOWN_IRQ] = {
60 .mask = TPS65917_INT1_STATUS_PWRDOWN,
61 },
62 [TPS65917_HOTDIE_IRQ] = {
63 .mask = TPS65917_INT1_STATUS_HOTDIE,
64 },
65 [TPS65917_VSYS_MON_IRQ] = {
66 .mask = TPS65917_INT1_STATUS_VSYS_MON,
67 },
68 [TPS65917_RESERVED3] = {
69 .mask = TPS65917_RESERVED,
70 },
71 /* INT2 IRQs*/
72 [TPS65917_RESERVED4] = {
73 .mask = TPS65917_RESERVED,
74 .reg_offset = 1,
75 },
76 [TPS65917_OTP_ERROR_IRQ] = {
77 .mask = TPS65917_INT2_STATUS_OTP_ERROR,
78 .reg_offset = 1,
79 },
80 [TPS65917_WDT_IRQ] = {
81 .mask = TPS65917_INT2_STATUS_WDT,
82 .reg_offset = 1,
83 },
84 [TPS65917_RESERVED5] = {
85 .mask = TPS65917_RESERVED,
86 .reg_offset = 1,
87 },
88 [TPS65917_RESET_IN_IRQ] = {
89 .mask = TPS65917_INT2_STATUS_RESET_IN,
90 .reg_offset = 1,
91 },
92 [TPS65917_FSD_IRQ] = {
93 .mask = TPS65917_INT2_STATUS_FSD,
94 .reg_offset = 1,
95 },
96 [TPS65917_SHORT_IRQ] = {
97 .mask = TPS65917_INT2_STATUS_SHORT,
98 .reg_offset = 1,
99 },
100 [TPS65917_RESERVED6] = {
101 .mask = TPS65917_RESERVED,
102 .reg_offset = 1,
103 },
104 /* INT3 IRQs */
105 [TPS65917_GPADC_AUTO_0_IRQ] = {
106 .mask = TPS65917_INT3_STATUS_GPADC_AUTO_0,
107 .reg_offset = 2,
108 },
109 [TPS65917_GPADC_AUTO_1_IRQ] = {
110 .mask = TPS65917_INT3_STATUS_GPADC_AUTO_1,
111 .reg_offset = 2,
112 },
113 [TPS65917_GPADC_EOC_SW_IRQ] = {
114 .mask = TPS65917_INT3_STATUS_GPADC_EOC_SW,
115 .reg_offset = 2,
116 },
117 [TPS65917_RESREVED6] = {
118 .mask = TPS65917_RESERVED6,
119 .reg_offset = 2,
120 },
121 [TPS65917_RESERVED7] = {
122 .mask = TPS65917_RESERVED,
123 .reg_offset = 2,
124 },
125 [TPS65917_RESERVED8] = {
126 .mask = TPS65917_RESERVED,
127 .reg_offset = 2,
128 },
129 [TPS65917_RESERVED9] = {
130 .mask = TPS65917_RESERVED,
131 .reg_offset = 2,
132 },
133 [TPS65917_VBUS_IRQ] = {
134 .mask = TPS65917_INT3_STATUS_VBUS,
135 .reg_offset = 2,
136 },
137 /* INT4 IRQs */
138 [TPS65917_GPIO_0_IRQ] = {
139 .mask = TPS65917_INT4_STATUS_GPIO_0,
140 .reg_offset = 3,
141 },
142 [TPS65917_GPIO_1_IRQ] = {
143 .mask = TPS65917_INT4_STATUS_GPIO_1,
144 .reg_offset = 3,
145 },
146 [TPS65917_GPIO_2_IRQ] = {
147 .mask = TPS65917_INT4_STATUS_GPIO_2,
148 .reg_offset = 3,
149 },
150 [TPS65917_GPIO_3_IRQ] = {
151 .mask = TPS65917_INT4_STATUS_GPIO_3,
152 .reg_offset = 3,
153 },
154 [TPS65917_GPIO_4_IRQ] = {
155 .mask = TPS65917_INT4_STATUS_GPIO_4,
156 .reg_offset = 3,
157 },
158 [TPS65917_GPIO_5_IRQ] = {
159 .mask = TPS65917_INT4_STATUS_GPIO_5,
160 .reg_offset = 3,
161 },
162 [TPS65917_GPIO_6_IRQ] = {
163 .mask = TPS65917_INT4_STATUS_GPIO_6,
164 .reg_offset = 3,
165 },
166 [TPS65917_RESERVED10] = {
167 .mask = TPS65917_RESERVED10,
168 .reg_offset = 3,
169 },
170 };
171
172 static const struct regmap_irq palmas_irqs[] = {
173 /* INT1 IRQs */
174 [PALMAS_CHARG_DET_N_VBUS_OVV_IRQ] = {
175 .mask = PALMAS_INT1_STATUS_CHARG_DET_N_VBUS_OVV,
176 },
177 [PALMAS_PWRON_IRQ] = {
178 .mask = PALMAS_INT1_STATUS_PWRON,
179 },
180 [PALMAS_LONG_PRESS_KEY_IRQ] = {
181 .mask = PALMAS_INT1_STATUS_LONG_PRESS_KEY,
182 },
183 [PALMAS_RPWRON_IRQ] = {
184 .mask = PALMAS_INT1_STATUS_RPWRON,
185 },
186 [PALMAS_PWRDOWN_IRQ] = {
187 .mask = PALMAS_INT1_STATUS_PWRDOWN,
188 },
189 [PALMAS_HOTDIE_IRQ] = {
190 .mask = PALMAS_INT1_STATUS_HOTDIE,
191 },
192 [PALMAS_VSYS_MON_IRQ] = {
193 .mask = PALMAS_INT1_STATUS_VSYS_MON,
194 },
195 [PALMAS_VBAT_MON_IRQ] = {
196 .mask = PALMAS_INT1_STATUS_VBAT_MON,
197 },
198 /* INT2 IRQs*/
199 [PALMAS_RTC_ALARM_IRQ] = {
200 .mask = PALMAS_INT2_STATUS_RTC_ALARM,
201 .reg_offset = 1,
202 },
203 [PALMAS_RTC_TIMER_IRQ] = {
204 .mask = PALMAS_INT2_STATUS_RTC_TIMER,
205 .reg_offset = 1,
206 },
207 [PALMAS_WDT_IRQ] = {
208 .mask = PALMAS_INT2_STATUS_WDT,
209 .reg_offset = 1,
210 },
211 [PALMAS_BATREMOVAL_IRQ] = {
212 .mask = PALMAS_INT2_STATUS_BATREMOVAL,
213 .reg_offset = 1,
214 },
215 [PALMAS_RESET_IN_IRQ] = {
216 .mask = PALMAS_INT2_STATUS_RESET_IN,
217 .reg_offset = 1,
218 },
219 [PALMAS_FBI_BB_IRQ] = {
220 .mask = PALMAS_INT2_STATUS_FBI_BB,
221 .reg_offset = 1,
222 },
223 [PALMAS_SHORT_IRQ] = {
224 .mask = PALMAS_INT2_STATUS_SHORT,
225 .reg_offset = 1,
226 },
227 [PALMAS_VAC_ACOK_IRQ] = {
228 .mask = PALMAS_INT2_STATUS_VAC_ACOK,
229 .reg_offset = 1,
230 },
231 /* INT3 IRQs */
232 [PALMAS_GPADC_AUTO_0_IRQ] = {
233 .mask = PALMAS_INT3_STATUS_GPADC_AUTO_0,
234 .reg_offset = 2,
235 },
236 [PALMAS_GPADC_AUTO_1_IRQ] = {
237 .mask = PALMAS_INT3_STATUS_GPADC_AUTO_1,
238 .reg_offset = 2,
239 },
240 [PALMAS_GPADC_EOC_SW_IRQ] = {
241 .mask = PALMAS_INT3_STATUS_GPADC_EOC_SW,
242 .reg_offset = 2,
243 },
244 [PALMAS_GPADC_EOC_RT_IRQ] = {
245 .mask = PALMAS_INT3_STATUS_GPADC_EOC_RT,
246 .reg_offset = 2,
247 },
248 [PALMAS_ID_OTG_IRQ] = {
249 .mask = PALMAS_INT3_STATUS_ID_OTG,
250 .reg_offset = 2,
251 },
252 [PALMAS_ID_IRQ] = {
253 .mask = PALMAS_INT3_STATUS_ID,
254 .reg_offset = 2,
255 },
256 [PALMAS_VBUS_OTG_IRQ] = {
257 .mask = PALMAS_INT3_STATUS_VBUS_OTG,
258 .reg_offset = 2,
259 },
260 [PALMAS_VBUS_IRQ] = {
261 .mask = PALMAS_INT3_STATUS_VBUS,
262 .reg_offset = 2,
263 },
264 /* INT4 IRQs */
265 [PALMAS_GPIO_0_IRQ] = {
266 .mask = PALMAS_INT4_STATUS_GPIO_0,
267 .reg_offset = 3,
268 },
269 [PALMAS_GPIO_1_IRQ] = {
270 .mask = PALMAS_INT4_STATUS_GPIO_1,
271 .reg_offset = 3,
272 },
273 [PALMAS_GPIO_2_IRQ] = {
274 .mask = PALMAS_INT4_STATUS_GPIO_2,
275 .reg_offset = 3,
276 },
277 [PALMAS_GPIO_3_IRQ] = {
278 .mask = PALMAS_INT4_STATUS_GPIO_3,
279 .reg_offset = 3,
280 },
281 [PALMAS_GPIO_4_IRQ] = {
282 .mask = PALMAS_INT4_STATUS_GPIO_4,
283 .reg_offset = 3,
284 },
285 [PALMAS_GPIO_5_IRQ] = {
286 .mask = PALMAS_INT4_STATUS_GPIO_5,
287 .reg_offset = 3,
288 },
289 [PALMAS_GPIO_6_IRQ] = {
290 .mask = PALMAS_INT4_STATUS_GPIO_6,
291 .reg_offset = 3,
292 },
293 [PALMAS_GPIO_7_IRQ] = {
294 .mask = PALMAS_INT4_STATUS_GPIO_7,
295 .reg_offset = 3,
296 },
297 };
298
299 static struct regmap_irq_chip palmas_irq_chip = {
300 .name = "palmas",
301 .irqs = palmas_irqs,
302 .num_irqs = ARRAY_SIZE(palmas_irqs),
303
304 .num_regs = 4,
305 .irq_reg_stride = 5,
306 .status_base = PALMAS_BASE_TO_REG(PALMAS_INTERRUPT_BASE,
307 PALMAS_INT1_STATUS),
308 .mask_base = PALMAS_BASE_TO_REG(PALMAS_INTERRUPT_BASE,
309 PALMAS_INT1_MASK),
310 };
311
312 static struct regmap_irq_chip tps65917_irq_chip = {
313 .name = "tps65917",
314 .irqs = tps65917_irqs,
315 .num_irqs = ARRAY_SIZE(tps65917_irqs),
316
317 .num_regs = 4,
318 .irq_reg_stride = 5,
319 .status_base = PALMAS_BASE_TO_REG(PALMAS_INTERRUPT_BASE,
320 PALMAS_INT1_STATUS),
321 .mask_base = PALMAS_BASE_TO_REG(PALMAS_INTERRUPT_BASE,
322 PALMAS_INT1_MASK),
323 };
324
palmas_ext_control_req_config(struct palmas * palmas,enum palmas_external_requestor_id id,int ext_ctrl,bool enable)325 int palmas_ext_control_req_config(struct palmas *palmas,
326 enum palmas_external_requestor_id id, int ext_ctrl, bool enable)
327 {
328 struct palmas_pmic_driver_data *pmic_ddata = palmas->pmic_ddata;
329 int preq_mask_bit = 0;
330 int reg_add = 0;
331 int bit_pos, ret;
332
333 if (!(ext_ctrl & PALMAS_EXT_REQ))
334 return 0;
335
336 if (id >= PALMAS_EXTERNAL_REQSTR_ID_MAX)
337 return 0;
338
339 if (ext_ctrl & PALMAS_EXT_CONTROL_NSLEEP) {
340 reg_add = PALMAS_NSLEEP_RES_ASSIGN;
341 preq_mask_bit = 0;
342 } else if (ext_ctrl & PALMAS_EXT_CONTROL_ENABLE1) {
343 reg_add = PALMAS_ENABLE1_RES_ASSIGN;
344 preq_mask_bit = 1;
345 } else if (ext_ctrl & PALMAS_EXT_CONTROL_ENABLE2) {
346 reg_add = PALMAS_ENABLE2_RES_ASSIGN;
347 preq_mask_bit = 2;
348 }
349
350 bit_pos = pmic_ddata->sleep_req_info[id].bit_pos;
351 reg_add += pmic_ddata->sleep_req_info[id].reg_offset;
352 if (enable)
353 ret = palmas_update_bits(palmas, PALMAS_RESOURCE_BASE,
354 reg_add, BIT(bit_pos), BIT(bit_pos));
355 else
356 ret = palmas_update_bits(palmas, PALMAS_RESOURCE_BASE,
357 reg_add, BIT(bit_pos), 0);
358 if (ret < 0) {
359 dev_err(palmas->dev, "Resource reg 0x%02x update failed %d\n",
360 reg_add, ret);
361 return ret;
362 }
363
364 /* Unmask the PREQ */
365 ret = palmas_update_bits(palmas, PALMAS_PMU_CONTROL_BASE,
366 PALMAS_POWER_CTRL, BIT(preq_mask_bit), 0);
367 if (ret < 0) {
368 dev_err(palmas->dev, "POWER_CTRL register update failed %d\n",
369 ret);
370 return ret;
371 }
372 return ret;
373 }
374 EXPORT_SYMBOL_GPL(palmas_ext_control_req_config);
375
palmas_set_pdata_irq_flag(struct i2c_client * i2c,struct palmas_platform_data * pdata)376 static int palmas_set_pdata_irq_flag(struct i2c_client *i2c,
377 struct palmas_platform_data *pdata)
378 {
379 struct irq_data *irq_data = irq_get_irq_data(i2c->irq);
380 if (!irq_data) {
381 dev_err(&i2c->dev, "Invalid IRQ: %d\n", i2c->irq);
382 return -EINVAL;
383 }
384
385 pdata->irq_flags = irqd_get_trigger_type(irq_data);
386 dev_info(&i2c->dev, "Irq flag is 0x%08x\n", pdata->irq_flags);
387 return 0;
388 }
389
palmas_dt_to_pdata(struct i2c_client * i2c,struct palmas_platform_data * pdata)390 static void palmas_dt_to_pdata(struct i2c_client *i2c,
391 struct palmas_platform_data *pdata)
392 {
393 struct device_node *node = i2c->dev.of_node;
394 int ret;
395 u32 prop;
396
397 ret = of_property_read_u32(node, "ti,mux-pad1", &prop);
398 if (!ret) {
399 pdata->mux_from_pdata = 1;
400 pdata->pad1 = prop;
401 }
402
403 ret = of_property_read_u32(node, "ti,mux-pad2", &prop);
404 if (!ret) {
405 pdata->mux_from_pdata = 1;
406 pdata->pad2 = prop;
407 }
408
409 /* The default for this register is all masked */
410 ret = of_property_read_u32(node, "ti,power-ctrl", &prop);
411 if (!ret)
412 pdata->power_ctrl = prop;
413 else
414 pdata->power_ctrl = PALMAS_POWER_CTRL_NSLEEP_MASK |
415 PALMAS_POWER_CTRL_ENABLE1_MASK |
416 PALMAS_POWER_CTRL_ENABLE2_MASK;
417 if (i2c->irq)
418 palmas_set_pdata_irq_flag(i2c, pdata);
419
420 pdata->pm_off = of_property_read_bool(node,
421 "ti,system-power-controller");
422 }
423
424 static struct palmas *palmas_dev;
palmas_power_off(void)425 static void palmas_power_off(void)
426 {
427 unsigned int addr;
428 int ret, slave;
429 u8 powerhold_mask;
430 struct device_node *np = palmas_dev->dev->of_node;
431
432 if (of_property_read_bool(np, "ti,palmas-override-powerhold")) {
433 addr = PALMAS_BASE_TO_REG(PALMAS_PU_PD_OD_BASE,
434 PALMAS_PRIMARY_SECONDARY_PAD2);
435 slave = PALMAS_BASE_TO_SLAVE(PALMAS_PU_PD_OD_BASE);
436
437 if (of_device_is_compatible(np, "ti,tps65917"))
438 powerhold_mask =
439 TPS65917_PRIMARY_SECONDARY_PAD2_GPIO_5_MASK;
440 else
441 powerhold_mask =
442 PALMAS_PRIMARY_SECONDARY_PAD2_GPIO_7_MASK;
443
444 ret = regmap_update_bits(palmas_dev->regmap[slave], addr,
445 powerhold_mask, 0);
446 if (ret)
447 dev_err(palmas_dev->dev,
448 "Unable to write PRIMARY_SECONDARY_PAD2 %d\n",
449 ret);
450 }
451
452 slave = PALMAS_BASE_TO_SLAVE(PALMAS_PMU_CONTROL_BASE);
453 addr = PALMAS_BASE_TO_REG(PALMAS_PMU_CONTROL_BASE, PALMAS_DEV_CTRL);
454
455 ret = regmap_update_bits(
456 palmas_dev->regmap[slave],
457 addr,
458 PALMAS_DEV_CTRL_DEV_ON,
459 0);
460
461 if (ret)
462 pr_err("%s: Unable to write to DEV_CTRL_DEV_ON: %d\n",
463 __func__, ret);
464 }
465
466 static unsigned int palmas_features = PALMAS_PMIC_FEATURE_SMPS10_BOOST;
467 static unsigned int tps659038_features;
468
469 struct palmas_driver_data {
470 unsigned int *features;
471 struct regmap_irq_chip *irq_chip;
472 };
473
474 static struct palmas_driver_data palmas_data = {
475 .features = &palmas_features,
476 .irq_chip = &palmas_irq_chip,
477 };
478
479 static struct palmas_driver_data tps659038_data = {
480 .features = &tps659038_features,
481 .irq_chip = &palmas_irq_chip,
482 };
483
484 static struct palmas_driver_data tps65917_data = {
485 .features = &tps659038_features,
486 .irq_chip = &tps65917_irq_chip,
487 };
488
489 static const struct of_device_id of_palmas_match_tbl[] = {
490 {
491 .compatible = "ti,palmas",
492 .data = &palmas_data,
493 },
494 {
495 .compatible = "ti,tps659038",
496 .data = &tps659038_data,
497 },
498 {
499 .compatible = "ti,tps65917",
500 .data = &tps65917_data,
501 },
502 { },
503 };
504 MODULE_DEVICE_TABLE(of, of_palmas_match_tbl);
505
palmas_i2c_probe(struct i2c_client * i2c)506 static int palmas_i2c_probe(struct i2c_client *i2c)
507 {
508 struct palmas *palmas;
509 struct palmas_platform_data *pdata;
510 struct palmas_driver_data *driver_data;
511 struct device_node *node = i2c->dev.of_node;
512 int ret = 0, i;
513 unsigned int reg, addr;
514 int slave;
515
516 pdata = dev_get_platdata(&i2c->dev);
517
518 if (node && !pdata) {
519 pdata = devm_kzalloc(&i2c->dev, sizeof(*pdata), GFP_KERNEL);
520
521 if (!pdata)
522 return -ENOMEM;
523
524 palmas_dt_to_pdata(i2c, pdata);
525 }
526
527 if (!pdata)
528 return -EINVAL;
529
530 palmas = devm_kzalloc(&i2c->dev, sizeof(struct palmas), GFP_KERNEL);
531 if (palmas == NULL)
532 return -ENOMEM;
533
534 i2c_set_clientdata(i2c, palmas);
535 palmas->dev = &i2c->dev;
536 palmas->irq = i2c->irq;
537
538 driver_data = (struct palmas_driver_data *) device_get_match_data(&i2c->dev);
539 palmas->features = *driver_data->features;
540
541 for (i = 0; i < PALMAS_NUM_CLIENTS; i++) {
542 if (i == 0)
543 palmas->i2c_clients[i] = i2c;
544 else {
545 palmas->i2c_clients[i] =
546 i2c_new_dummy_device(i2c->adapter,
547 i2c->addr + i);
548 if (IS_ERR(palmas->i2c_clients[i])) {
549 dev_err(palmas->dev,
550 "can't attach client %d\n", i);
551 ret = PTR_ERR(palmas->i2c_clients[i]);
552 goto err_i2c;
553 }
554 palmas->i2c_clients[i]->dev.of_node = of_node_get(node);
555 }
556 palmas->regmap[i] = devm_regmap_init_i2c(palmas->i2c_clients[i],
557 &palmas_regmap_config[i]);
558 if (IS_ERR(palmas->regmap[i])) {
559 ret = PTR_ERR(palmas->regmap[i]);
560 dev_err(palmas->dev,
561 "Failed to allocate regmap %d, err: %d\n",
562 i, ret);
563 goto err_i2c;
564 }
565 }
566
567 if (!palmas->irq) {
568 dev_warn(palmas->dev, "IRQ missing: skipping irq request\n");
569 goto no_irq;
570 }
571
572 /* Change interrupt line output polarity */
573 if (pdata->irq_flags & IRQ_TYPE_LEVEL_HIGH)
574 reg = PALMAS_POLARITY_CTRL_INT_POLARITY;
575 else
576 reg = 0;
577 ret = palmas_update_bits(palmas, PALMAS_PU_PD_OD_BASE,
578 PALMAS_POLARITY_CTRL, PALMAS_POLARITY_CTRL_INT_POLARITY,
579 reg);
580 if (ret < 0) {
581 dev_err(palmas->dev, "POLARITY_CTRL update failed: %d\n", ret);
582 goto err_i2c;
583 }
584
585 /* Change IRQ into clear on read mode for efficiency */
586 slave = PALMAS_BASE_TO_SLAVE(PALMAS_INTERRUPT_BASE);
587 addr = PALMAS_BASE_TO_REG(PALMAS_INTERRUPT_BASE, PALMAS_INT_CTRL);
588 reg = PALMAS_INT_CTRL_INT_CLEAR;
589
590 regmap_write(palmas->regmap[slave], addr, reg);
591
592 ret = regmap_add_irq_chip(palmas->regmap[slave], palmas->irq,
593 IRQF_ONESHOT | pdata->irq_flags, 0,
594 driver_data->irq_chip, &palmas->irq_data);
595 if (ret < 0)
596 goto err_i2c;
597
598 no_irq:
599 slave = PALMAS_BASE_TO_SLAVE(PALMAS_PU_PD_OD_BASE);
600 addr = PALMAS_BASE_TO_REG(PALMAS_PU_PD_OD_BASE,
601 PALMAS_PRIMARY_SECONDARY_PAD1);
602
603 if (pdata->mux_from_pdata) {
604 reg = pdata->pad1;
605 ret = regmap_write(palmas->regmap[slave], addr, reg);
606 if (ret)
607 goto err_irq;
608 } else {
609 ret = regmap_read(palmas->regmap[slave], addr, ®);
610 if (ret)
611 goto err_irq;
612 }
613
614 if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_0))
615 palmas->gpio_muxed |= PALMAS_GPIO_0_MUXED;
616 if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_1_MASK))
617 palmas->gpio_muxed |= PALMAS_GPIO_1_MUXED;
618 else if ((reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_1_MASK) ==
619 (2 << PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_1_SHIFT))
620 palmas->led_muxed |= PALMAS_LED1_MUXED;
621 else if ((reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_1_MASK) ==
622 (3 << PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_1_SHIFT))
623 palmas->pwm_muxed |= PALMAS_PWM1_MUXED;
624 if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_2_MASK))
625 palmas->gpio_muxed |= PALMAS_GPIO_2_MUXED;
626 else if ((reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_2_MASK) ==
627 (2 << PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_2_SHIFT))
628 palmas->led_muxed |= PALMAS_LED2_MUXED;
629 else if ((reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_2_MASK) ==
630 (3 << PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_2_SHIFT))
631 palmas->pwm_muxed |= PALMAS_PWM2_MUXED;
632 if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_3))
633 palmas->gpio_muxed |= PALMAS_GPIO_3_MUXED;
634
635 addr = PALMAS_BASE_TO_REG(PALMAS_PU_PD_OD_BASE,
636 PALMAS_PRIMARY_SECONDARY_PAD2);
637
638 if (pdata->mux_from_pdata) {
639 reg = pdata->pad2;
640 ret = regmap_write(palmas->regmap[slave], addr, reg);
641 if (ret)
642 goto err_irq;
643 } else {
644 ret = regmap_read(palmas->regmap[slave], addr, ®);
645 if (ret)
646 goto err_irq;
647 }
648
649 if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD2_GPIO_4))
650 palmas->gpio_muxed |= PALMAS_GPIO_4_MUXED;
651 if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD2_GPIO_5_MASK))
652 palmas->gpio_muxed |= PALMAS_GPIO_5_MUXED;
653 if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD2_GPIO_6))
654 palmas->gpio_muxed |= PALMAS_GPIO_6_MUXED;
655 if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD2_GPIO_7_MASK))
656 palmas->gpio_muxed |= PALMAS_GPIO_7_MUXED;
657
658 dev_info(palmas->dev, "Muxing GPIO %x, PWM %x, LED %x\n",
659 palmas->gpio_muxed, palmas->pwm_muxed,
660 palmas->led_muxed);
661
662 reg = pdata->power_ctrl;
663
664 slave = PALMAS_BASE_TO_SLAVE(PALMAS_PMU_CONTROL_BASE);
665 addr = PALMAS_BASE_TO_REG(PALMAS_PMU_CONTROL_BASE, PALMAS_POWER_CTRL);
666
667 ret = regmap_write(palmas->regmap[slave], addr, reg);
668 if (ret)
669 goto err_irq;
670
671 /*
672 * If we are probing with DT do this the DT way and return here
673 * otherwise continue and add devices using mfd helpers.
674 */
675 if (node) {
676 ret = devm_of_platform_populate(&i2c->dev);
677 if (ret < 0) {
678 goto err_irq;
679 } else if (pdata->pm_off && !pm_power_off) {
680 palmas_dev = palmas;
681 pm_power_off = palmas_power_off;
682 }
683 }
684
685 return ret;
686
687 err_irq:
688 regmap_del_irq_chip(palmas->irq, palmas->irq_data);
689 err_i2c:
690 for (i = 1; i < PALMAS_NUM_CLIENTS; i++) {
691 if (palmas->i2c_clients[i])
692 i2c_unregister_device(palmas->i2c_clients[i]);
693 }
694 return ret;
695 }
696
palmas_i2c_remove(struct i2c_client * i2c)697 static void palmas_i2c_remove(struct i2c_client *i2c)
698 {
699 struct palmas *palmas = i2c_get_clientdata(i2c);
700 int i;
701
702 regmap_del_irq_chip(palmas->irq, palmas->irq_data);
703
704 for (i = 1; i < PALMAS_NUM_CLIENTS; i++) {
705 if (palmas->i2c_clients[i])
706 i2c_unregister_device(palmas->i2c_clients[i]);
707 }
708
709 if (palmas == palmas_dev) {
710 pm_power_off = NULL;
711 palmas_dev = NULL;
712 }
713 }
714
715 static const struct i2c_device_id palmas_i2c_id[] = {
716 { "palmas", },
717 { "twl6035", },
718 { "twl6037", },
719 { "tps65913", },
720 { /* end */ }
721 };
722 MODULE_DEVICE_TABLE(i2c, palmas_i2c_id);
723
724 static struct i2c_driver palmas_i2c_driver = {
725 .driver = {
726 .name = "palmas",
727 .of_match_table = of_palmas_match_tbl,
728 },
729 .probe = palmas_i2c_probe,
730 .remove = palmas_i2c_remove,
731 .id_table = palmas_i2c_id,
732 };
733
palmas_i2c_init(void)734 static int __init palmas_i2c_init(void)
735 {
736 return i2c_add_driver(&palmas_i2c_driver);
737 }
738 /* init early so consumer devices can complete system boot */
739 subsys_initcall(palmas_i2c_init);
740
palmas_i2c_exit(void)741 static void __exit palmas_i2c_exit(void)
742 {
743 i2c_del_driver(&palmas_i2c_driver);
744 }
745 module_exit(palmas_i2c_exit);
746
747 MODULE_AUTHOR("Graeme Gregory <gg@slimlogic.co.uk>");
748 MODULE_DESCRIPTION("Palmas chip family multi-function driver");
749 MODULE_LICENSE("GPL");
750