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