Linux Audio

Check our new training course

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