xref: /linux/drivers/mfd/palmas.c (revision b1a54551dd9ed5ef1763b97b35a0999ca002b95c)
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 const 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 const 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 
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 
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 
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;
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 struct palmas_driver_data {
467 	unsigned int features;
468 	const struct regmap_irq_chip *irq_chip;
469 };
470 
471 static const struct palmas_driver_data palmas_data = {
472 	.features = PALMAS_PMIC_FEATURE_SMPS10_BOOST,
473 	.irq_chip = &palmas_irq_chip,
474 };
475 
476 static const struct palmas_driver_data tps659038_data = {
477 	.irq_chip = &palmas_irq_chip,
478 };
479 
480 static const struct palmas_driver_data tps65917_data = {
481 	.irq_chip = &tps65917_irq_chip,
482 };
483 
484 static int palmas_i2c_probe(struct i2c_client *i2c)
485 {
486 	struct palmas *palmas;
487 	struct palmas_platform_data *pdata;
488 	const struct palmas_driver_data *driver_data;
489 	struct device_node *node = i2c->dev.of_node;
490 	int ret = 0, i;
491 	unsigned int reg, addr;
492 	int slave;
493 
494 	pdata = dev_get_platdata(&i2c->dev);
495 
496 	if (node && !pdata) {
497 		pdata = devm_kzalloc(&i2c->dev, sizeof(*pdata), GFP_KERNEL);
498 
499 		if (!pdata)
500 			return -ENOMEM;
501 
502 		palmas_dt_to_pdata(i2c, pdata);
503 	}
504 
505 	if (!pdata)
506 		return -EINVAL;
507 
508 	palmas = devm_kzalloc(&i2c->dev, sizeof(struct palmas), GFP_KERNEL);
509 	if (palmas == NULL)
510 		return -ENOMEM;
511 
512 	i2c_set_clientdata(i2c, palmas);
513 	palmas->dev = &i2c->dev;
514 	palmas->irq = i2c->irq;
515 
516 	driver_data = i2c_get_match_data(i2c);
517 	palmas->features = driver_data->features;
518 
519 	for (i = 0; i < PALMAS_NUM_CLIENTS; i++) {
520 		if (i == 0)
521 			palmas->i2c_clients[i] = i2c;
522 		else {
523 			palmas->i2c_clients[i] =
524 					i2c_new_dummy_device(i2c->adapter,
525 							i2c->addr + i);
526 			if (IS_ERR(palmas->i2c_clients[i])) {
527 				dev_err(palmas->dev,
528 					"can't attach client %d\n", i);
529 				ret = PTR_ERR(palmas->i2c_clients[i]);
530 				goto err_i2c;
531 			}
532 			palmas->i2c_clients[i]->dev.of_node = of_node_get(node);
533 		}
534 		palmas->regmap[i] = devm_regmap_init_i2c(palmas->i2c_clients[i],
535 				&palmas_regmap_config[i]);
536 		if (IS_ERR(palmas->regmap[i])) {
537 			ret = PTR_ERR(palmas->regmap[i]);
538 			dev_err(palmas->dev,
539 				"Failed to allocate regmap %d, err: %d\n",
540 				i, ret);
541 			goto err_i2c;
542 		}
543 	}
544 
545 	if (!palmas->irq) {
546 		dev_warn(palmas->dev, "IRQ missing: skipping irq request\n");
547 		goto no_irq;
548 	}
549 
550 	/* Change interrupt line output polarity */
551 	if (pdata->irq_flags & IRQ_TYPE_LEVEL_HIGH)
552 		reg = PALMAS_POLARITY_CTRL_INT_POLARITY;
553 	else
554 		reg = 0;
555 	ret = palmas_update_bits(palmas, PALMAS_PU_PD_OD_BASE,
556 			PALMAS_POLARITY_CTRL, PALMAS_POLARITY_CTRL_INT_POLARITY,
557 			reg);
558 	if (ret < 0) {
559 		dev_err(palmas->dev, "POLARITY_CTRL update failed: %d\n", ret);
560 		goto err_i2c;
561 	}
562 
563 	/* Change IRQ into clear on read mode for efficiency */
564 	slave = PALMAS_BASE_TO_SLAVE(PALMAS_INTERRUPT_BASE);
565 	addr = PALMAS_BASE_TO_REG(PALMAS_INTERRUPT_BASE, PALMAS_INT_CTRL);
566 	reg = PALMAS_INT_CTRL_INT_CLEAR;
567 
568 	regmap_write(palmas->regmap[slave], addr, reg);
569 
570 	ret = regmap_add_irq_chip(palmas->regmap[slave], palmas->irq,
571 				  IRQF_ONESHOT | pdata->irq_flags, 0,
572 				  driver_data->irq_chip, &palmas->irq_data);
573 	if (ret < 0)
574 		goto err_i2c;
575 
576 no_irq:
577 	slave = PALMAS_BASE_TO_SLAVE(PALMAS_PU_PD_OD_BASE);
578 	addr = PALMAS_BASE_TO_REG(PALMAS_PU_PD_OD_BASE,
579 			PALMAS_PRIMARY_SECONDARY_PAD1);
580 
581 	if (pdata->mux_from_pdata) {
582 		reg = pdata->pad1;
583 		ret = regmap_write(palmas->regmap[slave], addr, reg);
584 		if (ret)
585 			goto err_irq;
586 	} else {
587 		ret = regmap_read(palmas->regmap[slave], addr, &reg);
588 		if (ret)
589 			goto err_irq;
590 	}
591 
592 	if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_0))
593 		palmas->gpio_muxed |= PALMAS_GPIO_0_MUXED;
594 	if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_1_MASK))
595 		palmas->gpio_muxed |= PALMAS_GPIO_1_MUXED;
596 	else if ((reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_1_MASK) ==
597 			(2 << PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_1_SHIFT))
598 		palmas->led_muxed |= PALMAS_LED1_MUXED;
599 	else if ((reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_1_MASK) ==
600 			(3 << PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_1_SHIFT))
601 		palmas->pwm_muxed |= PALMAS_PWM1_MUXED;
602 	if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_2_MASK))
603 		palmas->gpio_muxed |= PALMAS_GPIO_2_MUXED;
604 	else if ((reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_2_MASK) ==
605 			(2 << PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_2_SHIFT))
606 		palmas->led_muxed |= PALMAS_LED2_MUXED;
607 	else if ((reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_2_MASK) ==
608 			(3 << PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_2_SHIFT))
609 		palmas->pwm_muxed |= PALMAS_PWM2_MUXED;
610 	if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_3))
611 		palmas->gpio_muxed |= PALMAS_GPIO_3_MUXED;
612 
613 	addr = PALMAS_BASE_TO_REG(PALMAS_PU_PD_OD_BASE,
614 			PALMAS_PRIMARY_SECONDARY_PAD2);
615 
616 	if (pdata->mux_from_pdata) {
617 		reg = pdata->pad2;
618 		ret = regmap_write(palmas->regmap[slave], addr, reg);
619 		if (ret)
620 			goto err_irq;
621 	} else {
622 		ret = regmap_read(palmas->regmap[slave], addr, &reg);
623 		if (ret)
624 			goto err_irq;
625 	}
626 
627 	if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD2_GPIO_4))
628 		palmas->gpio_muxed |= PALMAS_GPIO_4_MUXED;
629 	if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD2_GPIO_5_MASK))
630 		palmas->gpio_muxed |= PALMAS_GPIO_5_MUXED;
631 	if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD2_GPIO_6))
632 		palmas->gpio_muxed |= PALMAS_GPIO_6_MUXED;
633 	if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD2_GPIO_7_MASK))
634 		palmas->gpio_muxed |= PALMAS_GPIO_7_MUXED;
635 
636 	dev_info(palmas->dev, "Muxing GPIO %x, PWM %x, LED %x\n",
637 			palmas->gpio_muxed, palmas->pwm_muxed,
638 			palmas->led_muxed);
639 
640 	reg = pdata->power_ctrl;
641 
642 	slave = PALMAS_BASE_TO_SLAVE(PALMAS_PMU_CONTROL_BASE);
643 	addr = PALMAS_BASE_TO_REG(PALMAS_PMU_CONTROL_BASE, PALMAS_POWER_CTRL);
644 
645 	ret = regmap_write(palmas->regmap[slave], addr, reg);
646 	if (ret)
647 		goto err_irq;
648 
649 	/*
650 	 * If we are probing with DT do this the DT way and return here
651 	 * otherwise continue and add devices using mfd helpers.
652 	 */
653 	if (node) {
654 		ret = devm_of_platform_populate(&i2c->dev);
655 		if (ret < 0) {
656 			goto err_irq;
657 		} else if (pdata->pm_off && !pm_power_off) {
658 			palmas_dev = palmas;
659 			pm_power_off = palmas_power_off;
660 		}
661 	}
662 
663 	return ret;
664 
665 err_irq:
666 	regmap_del_irq_chip(palmas->irq, palmas->irq_data);
667 err_i2c:
668 	for (i = 1; i < PALMAS_NUM_CLIENTS; i++) {
669 		if (palmas->i2c_clients[i])
670 			i2c_unregister_device(palmas->i2c_clients[i]);
671 	}
672 	return ret;
673 }
674 
675 static void palmas_i2c_remove(struct i2c_client *i2c)
676 {
677 	struct palmas *palmas = i2c_get_clientdata(i2c);
678 	int i;
679 
680 	regmap_del_irq_chip(palmas->irq, palmas->irq_data);
681 
682 	for (i = 1; i < PALMAS_NUM_CLIENTS; i++) {
683 		if (palmas->i2c_clients[i])
684 			i2c_unregister_device(palmas->i2c_clients[i]);
685 	}
686 
687 	if (palmas == palmas_dev) {
688 		pm_power_off = NULL;
689 		palmas_dev = NULL;
690 	}
691 }
692 
693 static const struct of_device_id of_palmas_match_tbl[] = {
694 	{ .compatible = "ti,palmas", .data = &palmas_data },
695 	{ .compatible = "ti,tps659038", .data = &tps659038_data },
696 	{ .compatible = "ti,tps65917", .data = &tps65917_data },
697 	{ }
698 };
699 MODULE_DEVICE_TABLE(of, of_palmas_match_tbl);
700 
701 static const struct i2c_device_id palmas_i2c_id[] = {
702 	{ "palmas", (kernel_ulong_t)&palmas_data },
703 	{ "twl6035", (kernel_ulong_t)&palmas_data },
704 	{ "twl6037", (kernel_ulong_t)&palmas_data },
705 	{ "tps65913", (kernel_ulong_t)&palmas_data },
706 	{ /* end */ }
707 };
708 MODULE_DEVICE_TABLE(i2c, palmas_i2c_id);
709 
710 static struct i2c_driver palmas_i2c_driver = {
711 	.driver = {
712 		   .name = "palmas",
713 		   .of_match_table = of_palmas_match_tbl,
714 	},
715 	.probe = palmas_i2c_probe,
716 	.remove = palmas_i2c_remove,
717 	.id_table = palmas_i2c_id,
718 };
719 
720 static int __init palmas_i2c_init(void)
721 {
722 	return i2c_add_driver(&palmas_i2c_driver);
723 }
724 /* init early so consumer devices can complete system boot */
725 subsys_initcall(palmas_i2c_init);
726 
727 static void __exit palmas_i2c_exit(void)
728 {
729 	i2c_del_driver(&palmas_i2c_driver);
730 }
731 module_exit(palmas_i2c_exit);
732 
733 MODULE_AUTHOR("Graeme Gregory <gg@slimlogic.co.uk>");
734 MODULE_DESCRIPTION("Palmas chip family multi-function driver");
735 MODULE_LICENSE("GPL");
736