xref: /openbmc/linux/drivers/mfd/twl-core.c (revision 5d4e9bd7)
1 /*
2  * twl_core.c - driver for TWL4030/TWL5030/TWL60X0/TPS659x0 PM
3  * and audio CODEC devices
4  *
5  * Copyright (C) 2005-2006 Texas Instruments, Inc.
6  *
7  * Modifications to defer interrupt handling to a kernel thread:
8  * Copyright (C) 2006 MontaVista Software, Inc.
9  *
10  * Based on tlv320aic23.c:
11  * Copyright (c) by Kai Svahn <kai.svahn@nokia.com>
12  *
13  * Code cleanup and modifications to IRQ handler.
14  * by syed khasim <x0khasim@ti.com>
15  *
16  * This program is free software; you can redistribute it and/or modify
17  * it under the terms of the GNU General Public License as published by
18  * the Free Software Foundation; either version 2 of the License, or
19  * (at your option) any later version.
20  *
21  * This program is distributed in the hope that it will be useful,
22  * but WITHOUT ANY WARRANTY; without even the implied warranty of
23  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
24  * GNU General Public License for more details.
25  *
26  * You should have received a copy of the GNU General Public License
27  * along with this program; if not, write to the Free Software
28  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
29  */
30 
31 #include <linux/init.h>
32 #include <linux/mutex.h>
33 #include <linux/module.h>
34 #include <linux/platform_device.h>
35 #include <linux/regmap.h>
36 #include <linux/clk.h>
37 #include <linux/err.h>
38 #include <linux/device.h>
39 #include <linux/of.h>
40 #include <linux/of_irq.h>
41 #include <linux/of_platform.h>
42 #include <linux/irq.h>
43 #include <linux/irqdomain.h>
44 
45 #include <linux/regulator/machine.h>
46 
47 #include <linux/i2c.h>
48 #include <linux/i2c/twl.h>
49 
50 #include "twl-core.h"
51 
52 /*
53  * The TWL4030 "Triton 2" is one of a family of a multi-function "Power
54  * Management and System Companion Device" chips originally designed for
55  * use in OMAP2 and OMAP 3 based systems.  Its control interfaces use I2C,
56  * often at around 3 Mbit/sec, including for interrupt handling.
57  *
58  * This driver core provides genirq support for the interrupts emitted,
59  * by the various modules, and exports register access primitives.
60  *
61  * FIXME this driver currently requires use of the first interrupt line
62  * (and associated registers).
63  */
64 
65 #define DRIVER_NAME			"twl"
66 
67 /* Triton Core internal information (BEGIN) */
68 
69 #define TWL_NUM_SLAVES		4
70 
71 #define SUB_CHIP_ID0 0
72 #define SUB_CHIP_ID1 1
73 #define SUB_CHIP_ID2 2
74 #define SUB_CHIP_ID3 3
75 #define SUB_CHIP_ID_INVAL 0xff
76 
77 /* Base Address defns for twl4030_map[] */
78 
79 /* subchip/slave 0 - USB ID */
80 #define TWL4030_BASEADD_USB		0x0000
81 
82 /* subchip/slave 1 - AUD ID */
83 #define TWL4030_BASEADD_AUDIO_VOICE	0x0000
84 #define TWL4030_BASEADD_GPIO		0x0098
85 #define TWL4030_BASEADD_INTBR		0x0085
86 #define TWL4030_BASEADD_PIH		0x0080
87 #define TWL4030_BASEADD_TEST		0x004C
88 
89 /* subchip/slave 2 - AUX ID */
90 #define TWL4030_BASEADD_INTERRUPTS	0x00B9
91 #define TWL4030_BASEADD_LED		0x00EE
92 #define TWL4030_BASEADD_MADC		0x0000
93 #define TWL4030_BASEADD_MAIN_CHARGE	0x0074
94 #define TWL4030_BASEADD_PRECHARGE	0x00AA
95 #define TWL4030_BASEADD_PWM		0x00F8
96 #define TWL4030_BASEADD_KEYPAD		0x00D2
97 
98 #define TWL5031_BASEADD_ACCESSORY	0x0074 /* Replaces Main Charge */
99 #define TWL5031_BASEADD_INTERRUPTS	0x00B9 /* Different than TWL4030's
100 						  one */
101 
102 /* subchip/slave 3 - POWER ID */
103 #define TWL4030_BASEADD_BACKUP		0x0014
104 #define TWL4030_BASEADD_INT		0x002E
105 #define TWL4030_BASEADD_PM_MASTER	0x0036
106 #define TWL4030_BASEADD_PM_RECEIVER	0x005B
107 #define TWL4030_BASEADD_RTC		0x001C
108 #define TWL4030_BASEADD_SECURED_REG	0x0000
109 
110 /* Triton Core internal information (END) */
111 
112 
113 /* subchip/slave 0 0x48 - POWER */
114 #define TWL6030_BASEADD_RTC		0x0000
115 #define TWL6030_BASEADD_SECURED_REG	0x0017
116 #define TWL6030_BASEADD_PM_MASTER	0x001F
117 #define TWL6030_BASEADD_PM_SLAVE_MISC	0x0030 /* PM_RECEIVER */
118 #define TWL6030_BASEADD_PM_MISC		0x00E2
119 #define TWL6030_BASEADD_PM_PUPD		0x00F0
120 
121 /* subchip/slave 1 0x49 - FEATURE */
122 #define TWL6030_BASEADD_USB		0x0000
123 #define TWL6030_BASEADD_GPADC_CTRL	0x002E
124 #define TWL6030_BASEADD_AUX		0x0090
125 #define TWL6030_BASEADD_PWM		0x00BA
126 #define TWL6030_BASEADD_GASGAUGE	0x00C0
127 #define TWL6030_BASEADD_PIH		0x00D0
128 #define TWL6030_BASEADD_CHARGER		0x00E0
129 #define TWL6025_BASEADD_CHARGER		0x00DA
130 #define TWL6030_BASEADD_LED		0x00F4
131 
132 /* subchip/slave 2 0x4A - DFT */
133 #define TWL6030_BASEADD_DIEID		0x00C0
134 
135 /* subchip/slave 3 0x4B - AUDIO */
136 #define TWL6030_BASEADD_AUDIO		0x0000
137 #define TWL6030_BASEADD_RSV		0x0000
138 #define TWL6030_BASEADD_ZERO		0x0000
139 
140 /* Few power values */
141 #define R_CFG_BOOT			0x05
142 
143 /* some fields in R_CFG_BOOT */
144 #define HFCLK_FREQ_19p2_MHZ		(1 << 0)
145 #define HFCLK_FREQ_26_MHZ		(2 << 0)
146 #define HFCLK_FREQ_38p4_MHZ		(3 << 0)
147 #define HIGH_PERF_SQ			(1 << 3)
148 #define CK32K_LOWPWR_EN			(1 << 7)
149 
150 /*----------------------------------------------------------------------*/
151 
152 /* is driver active, bound to a chip? */
153 static bool inuse;
154 
155 /* TWL IDCODE Register value */
156 static u32 twl_idcode;
157 
158 static unsigned int twl_id;
159 unsigned int twl_rev(void)
160 {
161 	return twl_id;
162 }
163 EXPORT_SYMBOL(twl_rev);
164 
165 /* Structure for each TWL4030/TWL6030 Slave */
166 struct twl_client {
167 	struct i2c_client *client;
168 	struct regmap *regmap;
169 };
170 
171 static struct twl_client twl_modules[TWL_NUM_SLAVES];
172 
173 /* mapping the module id to slave id and base address */
174 struct twl_mapping {
175 	unsigned char sid;	/* Slave ID */
176 	unsigned char base;	/* base address */
177 };
178 static struct twl_mapping *twl_map;
179 
180 static struct twl_mapping twl4030_map[] = {
181 	/*
182 	 * NOTE:  don't change this table without updating the
183 	 * <linux/i2c/twl.h> defines for TWL4030_MODULE_*
184 	 * so they continue to match the order in this table.
185 	 */
186 
187 	/* Common IPs */
188 	{ 0, TWL4030_BASEADD_USB },
189 	{ 1, TWL4030_BASEADD_PIH },
190 	{ 2, TWL4030_BASEADD_MAIN_CHARGE },
191 	{ 3, TWL4030_BASEADD_PM_MASTER },
192 	{ 3, TWL4030_BASEADD_PM_RECEIVER },
193 
194 	{ 3, TWL4030_BASEADD_RTC },
195 	{ 2, TWL4030_BASEADD_PWM },
196 	{ 2, TWL4030_BASEADD_LED },
197 	{ 3, TWL4030_BASEADD_SECURED_REG },
198 
199 	/* TWL4030 specific IPs */
200 	{ 1, TWL4030_BASEADD_AUDIO_VOICE },
201 	{ 1, TWL4030_BASEADD_GPIO },
202 	{ 1, TWL4030_BASEADD_INTBR },
203 	{ 1, TWL4030_BASEADD_TEST },
204 	{ 2, TWL4030_BASEADD_KEYPAD },
205 
206 	{ 2, TWL4030_BASEADD_MADC },
207 	{ 2, TWL4030_BASEADD_INTERRUPTS },
208 	{ 2, TWL4030_BASEADD_PRECHARGE },
209 	{ 3, TWL4030_BASEADD_BACKUP },
210 	{ 3, TWL4030_BASEADD_INT },
211 
212 	{ 2, TWL5031_BASEADD_ACCESSORY },
213 	{ 2, TWL5031_BASEADD_INTERRUPTS },
214 };
215 
216 static struct regmap_config twl4030_regmap_config[4] = {
217 	{
218 		/* Address 0x48 */
219 		.reg_bits = 8,
220 		.val_bits = 8,
221 		.max_register = 0xff,
222 	},
223 	{
224 		/* Address 0x49 */
225 		.reg_bits = 8,
226 		.val_bits = 8,
227 		.max_register = 0xff,
228 	},
229 	{
230 		/* Address 0x4a */
231 		.reg_bits = 8,
232 		.val_bits = 8,
233 		.max_register = 0xff,
234 	},
235 	{
236 		/* Address 0x4b */
237 		.reg_bits = 8,
238 		.val_bits = 8,
239 		.max_register = 0xff,
240 	},
241 };
242 
243 static struct twl_mapping twl6030_map[] = {
244 	/*
245 	 * NOTE:  don't change this table without updating the
246 	 * <linux/i2c/twl.h> defines for TWL4030_MODULE_*
247 	 * so they continue to match the order in this table.
248 	 */
249 
250 	/* Common IPs */
251 	{ 1, TWL6030_BASEADD_USB },
252 	{ 1, TWL6030_BASEADD_PIH },
253 	{ 1, TWL6030_BASEADD_CHARGER },
254 	{ 0, TWL6030_BASEADD_PM_MASTER },
255 	{ 0, TWL6030_BASEADD_PM_SLAVE_MISC },
256 
257 	{ 0, TWL6030_BASEADD_RTC },
258 	{ 1, TWL6030_BASEADD_PWM },
259 	{ 1, TWL6030_BASEADD_LED },
260 	{ 0, TWL6030_BASEADD_SECURED_REG },
261 
262 	/* TWL6030 specific IPs */
263 	{ 0, TWL6030_BASEADD_ZERO },
264 	{ 1, TWL6030_BASEADD_ZERO },
265 	{ 2, TWL6030_BASEADD_ZERO },
266 	{ 1, TWL6030_BASEADD_GPADC_CTRL },
267 	{ 1, TWL6030_BASEADD_GASGAUGE },
268 };
269 
270 static struct regmap_config twl6030_regmap_config[3] = {
271 	{
272 		/* Address 0x48 */
273 		.reg_bits = 8,
274 		.val_bits = 8,
275 		.max_register = 0xff,
276 	},
277 	{
278 		/* Address 0x49 */
279 		.reg_bits = 8,
280 		.val_bits = 8,
281 		.max_register = 0xff,
282 	},
283 	{
284 		/* Address 0x4a */
285 		.reg_bits = 8,
286 		.val_bits = 8,
287 		.max_register = 0xff,
288 	},
289 };
290 
291 /*----------------------------------------------------------------------*/
292 
293 static inline int twl_get_last_module(void)
294 {
295 	if (twl_class_is_4030())
296 		return TWL4030_MODULE_LAST;
297 	else
298 		return TWL6030_MODULE_LAST;
299 }
300 
301 /* Exported Functions */
302 
303 /**
304  * twl_i2c_write - Writes a n bit register in TWL4030/TWL5030/TWL60X0
305  * @mod_no: module number
306  * @value: an array of num_bytes+1 containing data to write
307  * @reg: register address (just offset will do)
308  * @num_bytes: number of bytes to transfer
309  *
310  * IMPORTANT: for 'value' parameter: Allocate value num_bytes+1 and
311  * valid data starts at Offset 1.
312  *
313  * Returns the result of operation - 0 is success
314  */
315 int twl_i2c_write(u8 mod_no, u8 *value, u8 reg, unsigned num_bytes)
316 {
317 	int ret;
318 	int sid;
319 	struct twl_client *twl;
320 
321 	if (unlikely(mod_no >= twl_get_last_module())) {
322 		pr_err("%s: invalid module number %d\n", DRIVER_NAME, mod_no);
323 		return -EPERM;
324 	}
325 	if (unlikely(!inuse)) {
326 		pr_err("%s: not initialized\n", DRIVER_NAME);
327 		return -EPERM;
328 	}
329 	sid = twl_map[mod_no].sid;
330 	if (unlikely(sid == SUB_CHIP_ID_INVAL)) {
331 		pr_err("%s: module %d is not part of the pmic\n",
332 		       DRIVER_NAME, mod_no);
333 		return -EINVAL;
334 	}
335 	twl = &twl_modules[sid];
336 
337 	ret = regmap_bulk_write(twl->regmap, twl_map[mod_no].base + reg,
338 				value, num_bytes);
339 
340 	if (ret)
341 		pr_err("%s: Write failed (mod %d, reg 0x%02x count %d)\n",
342 		       DRIVER_NAME, mod_no, reg, num_bytes);
343 
344 	return ret;
345 }
346 EXPORT_SYMBOL(twl_i2c_write);
347 
348 /**
349  * twl_i2c_read - Reads a n bit register in TWL4030/TWL5030/TWL60X0
350  * @mod_no: module number
351  * @value: an array of num_bytes containing data to be read
352  * @reg: register address (just offset will do)
353  * @num_bytes: number of bytes to transfer
354  *
355  * Returns result of operation - num_bytes is success else failure.
356  */
357 int twl_i2c_read(u8 mod_no, u8 *value, u8 reg, unsigned num_bytes)
358 {
359 	int ret;
360 	int sid;
361 	struct twl_client *twl;
362 
363 	if (unlikely(mod_no >= twl_get_last_module())) {
364 		pr_err("%s: invalid module number %d\n", DRIVER_NAME, mod_no);
365 		return -EPERM;
366 	}
367 	if (unlikely(!inuse)) {
368 		pr_err("%s: not initialized\n", DRIVER_NAME);
369 		return -EPERM;
370 	}
371 	sid = twl_map[mod_no].sid;
372 	if (unlikely(sid == SUB_CHIP_ID_INVAL)) {
373 		pr_err("%s: module %d is not part of the pmic\n",
374 		       DRIVER_NAME, mod_no);
375 		return -EINVAL;
376 	}
377 	twl = &twl_modules[sid];
378 
379 	ret = regmap_bulk_read(twl->regmap, twl_map[mod_no].base + reg,
380 			       value, num_bytes);
381 
382 	if (ret)
383 		pr_err("%s: Read failed (mod %d, reg 0x%02x count %d)\n",
384 		       DRIVER_NAME, mod_no, reg, num_bytes);
385 
386 	return ret;
387 }
388 EXPORT_SYMBOL(twl_i2c_read);
389 
390 /**
391  * twl_i2c_write_u8 - Writes a 8 bit register in TWL4030/TWL5030/TWL60X0
392  * @mod_no: module number
393  * @value: the value to be written 8 bit
394  * @reg: register address (just offset will do)
395  *
396  * Returns result of operation - 0 is success
397  */
398 int twl_i2c_write_u8(u8 mod_no, u8 value, u8 reg)
399 {
400 	return twl_i2c_write(mod_no, &value, reg, 1);
401 }
402 EXPORT_SYMBOL(twl_i2c_write_u8);
403 
404 /**
405  * twl_i2c_read_u8 - Reads a 8 bit register from TWL4030/TWL5030/TWL60X0
406  * @mod_no: module number
407  * @value: the value read 8 bit
408  * @reg: register address (just offset will do)
409  *
410  * Returns result of operation - 0 is success
411  */
412 int twl_i2c_read_u8(u8 mod_no, u8 *value, u8 reg)
413 {
414 	return twl_i2c_read(mod_no, value, reg, 1);
415 }
416 EXPORT_SYMBOL(twl_i2c_read_u8);
417 
418 /*----------------------------------------------------------------------*/
419 
420 /**
421  * twl_read_idcode_register - API to read the IDCODE register.
422  *
423  * Unlocks the IDCODE register and read the 32 bit value.
424  */
425 static int twl_read_idcode_register(void)
426 {
427 	int err;
428 
429 	err = twl_i2c_write_u8(TWL4030_MODULE_INTBR, TWL_EEPROM_R_UNLOCK,
430 						REG_UNLOCK_TEST_REG);
431 	if (err) {
432 		pr_err("TWL4030 Unable to unlock IDCODE registers -%d\n", err);
433 		goto fail;
434 	}
435 
436 	err = twl_i2c_read(TWL4030_MODULE_INTBR, (u8 *)(&twl_idcode),
437 						REG_IDCODE_7_0, 4);
438 	if (err) {
439 		pr_err("TWL4030: unable to read IDCODE -%d\n", err);
440 		goto fail;
441 	}
442 
443 	err = twl_i2c_write_u8(TWL4030_MODULE_INTBR, 0x0, REG_UNLOCK_TEST_REG);
444 	if (err)
445 		pr_err("TWL4030 Unable to relock IDCODE registers -%d\n", err);
446 fail:
447 	return err;
448 }
449 
450 /**
451  * twl_get_type - API to get TWL Si type.
452  *
453  * Api to get the TWL Si type from IDCODE value.
454  */
455 int twl_get_type(void)
456 {
457 	return TWL_SIL_TYPE(twl_idcode);
458 }
459 EXPORT_SYMBOL_GPL(twl_get_type);
460 
461 /**
462  * twl_get_version - API to get TWL Si version.
463  *
464  * Api to get the TWL Si version from IDCODE value.
465  */
466 int twl_get_version(void)
467 {
468 	return TWL_SIL_REV(twl_idcode);
469 }
470 EXPORT_SYMBOL_GPL(twl_get_version);
471 
472 /**
473  * twl_get_hfclk_rate - API to get TWL external HFCLK clock rate.
474  *
475  * Api to get the TWL HFCLK rate based on BOOT_CFG register.
476  */
477 int twl_get_hfclk_rate(void)
478 {
479 	u8 ctrl;
480 	int rate;
481 
482 	twl_i2c_read_u8(TWL_MODULE_PM_MASTER, &ctrl, R_CFG_BOOT);
483 
484 	switch (ctrl & 0x3) {
485 	case HFCLK_FREQ_19p2_MHZ:
486 		rate = 19200000;
487 		break;
488 	case HFCLK_FREQ_26_MHZ:
489 		rate = 26000000;
490 		break;
491 	case HFCLK_FREQ_38p4_MHZ:
492 		rate = 38400000;
493 		break;
494 	default:
495 		pr_err("TWL4030: HFCLK is not configured\n");
496 		rate = -EINVAL;
497 		break;
498 	}
499 
500 	return rate;
501 }
502 EXPORT_SYMBOL_GPL(twl_get_hfclk_rate);
503 
504 static struct device *
505 add_numbered_child(unsigned chip, const char *name, int num,
506 		void *pdata, unsigned pdata_len,
507 		bool can_wakeup, int irq0, int irq1)
508 {
509 	struct platform_device	*pdev;
510 	struct twl_client	*twl = &twl_modules[chip];
511 	int			status;
512 
513 	pdev = platform_device_alloc(name, num);
514 	if (!pdev) {
515 		dev_dbg(&twl->client->dev, "can't alloc dev\n");
516 		status = -ENOMEM;
517 		goto err;
518 	}
519 
520 	pdev->dev.parent = &twl->client->dev;
521 
522 	if (pdata) {
523 		status = platform_device_add_data(pdev, pdata, pdata_len);
524 		if (status < 0) {
525 			dev_dbg(&pdev->dev, "can't add platform_data\n");
526 			goto err;
527 		}
528 	}
529 
530 	if (irq0) {
531 		struct resource r[2] = {
532 			{ .start = irq0, .flags = IORESOURCE_IRQ, },
533 			{ .start = irq1, .flags = IORESOURCE_IRQ, },
534 		};
535 
536 		status = platform_device_add_resources(pdev, r, irq1 ? 2 : 1);
537 		if (status < 0) {
538 			dev_dbg(&pdev->dev, "can't add irqs\n");
539 			goto err;
540 		}
541 	}
542 
543 	status = platform_device_add(pdev);
544 	if (status == 0)
545 		device_init_wakeup(&pdev->dev, can_wakeup);
546 
547 err:
548 	if (status < 0) {
549 		platform_device_put(pdev);
550 		dev_err(&twl->client->dev, "can't add %s dev\n", name);
551 		return ERR_PTR(status);
552 	}
553 	return &pdev->dev;
554 }
555 
556 static inline struct device *add_child(unsigned chip, const char *name,
557 		void *pdata, unsigned pdata_len,
558 		bool can_wakeup, int irq0, int irq1)
559 {
560 	return add_numbered_child(chip, name, -1, pdata, pdata_len,
561 		can_wakeup, irq0, irq1);
562 }
563 
564 static struct device *
565 add_regulator_linked(int num, struct regulator_init_data *pdata,
566 		struct regulator_consumer_supply *consumers,
567 		unsigned num_consumers, unsigned long features)
568 {
569 	unsigned sub_chip_id;
570 	struct twl_regulator_driver_data drv_data;
571 
572 	/* regulator framework demands init_data ... */
573 	if (!pdata)
574 		return NULL;
575 
576 	if (consumers) {
577 		pdata->consumer_supplies = consumers;
578 		pdata->num_consumer_supplies = num_consumers;
579 	}
580 
581 	if (pdata->driver_data) {
582 		/* If we have existing drv_data, just add the flags */
583 		struct twl_regulator_driver_data *tmp;
584 		tmp = pdata->driver_data;
585 		tmp->features |= features;
586 	} else {
587 		/* add new driver data struct, used only during init */
588 		drv_data.features = features;
589 		drv_data.set_voltage = NULL;
590 		drv_data.get_voltage = NULL;
591 		drv_data.data = NULL;
592 		pdata->driver_data = &drv_data;
593 	}
594 
595 	/* NOTE:  we currently ignore regulator IRQs, e.g. for short circuits */
596 	sub_chip_id = twl_map[TWL_MODULE_PM_MASTER].sid;
597 	return add_numbered_child(sub_chip_id, "twl_reg", num,
598 		pdata, sizeof(*pdata), false, 0, 0);
599 }
600 
601 static struct device *
602 add_regulator(int num, struct regulator_init_data *pdata,
603 		unsigned long features)
604 {
605 	return add_regulator_linked(num, pdata, NULL, 0, features);
606 }
607 
608 /*
609  * NOTE:  We know the first 8 IRQs after pdata->base_irq are
610  * for the PIH, and the next are for the PWR_INT SIH, since
611  * that's how twl_init_irq() sets things up.
612  */
613 
614 static int
615 add_children(struct twl4030_platform_data *pdata, unsigned irq_base,
616 		unsigned long features)
617 {
618 	struct device	*child;
619 	unsigned sub_chip_id;
620 
621 	if (IS_ENABLED(CONFIG_GPIO_TWL4030) && pdata->gpio) {
622 		child = add_child(SUB_CHIP_ID1, "twl4030_gpio",
623 				pdata->gpio, sizeof(*pdata->gpio),
624 				false, irq_base + GPIO_INTR_OFFSET, 0);
625 		if (IS_ERR(child))
626 			return PTR_ERR(child);
627 	}
628 
629 	if (IS_ENABLED(CONFIG_KEYBOARD_TWL4030) && pdata->keypad) {
630 		child = add_child(SUB_CHIP_ID2, "twl4030_keypad",
631 				pdata->keypad, sizeof(*pdata->keypad),
632 				true, irq_base + KEYPAD_INTR_OFFSET, 0);
633 		if (IS_ERR(child))
634 			return PTR_ERR(child);
635 	}
636 
637 	if (IS_ENABLED(CONFIG_TWL4030_MADC) && pdata->madc &&
638 	    twl_class_is_4030()) {
639 		child = add_child(SUB_CHIP_ID2, "twl4030_madc",
640 				pdata->madc, sizeof(*pdata->madc),
641 				true, irq_base + MADC_INTR_OFFSET, 0);
642 		if (IS_ERR(child))
643 			return PTR_ERR(child);
644 	}
645 
646 	if (IS_ENABLED(CONFIG_RTC_DRV_TWL4030)) {
647 		/*
648 		 * REVISIT platform_data here currently might expose the
649 		 * "msecure" line ... but for now we just expect board
650 		 * setup to tell the chip "it's always ok to SET_TIME".
651 		 * Eventually, Linux might become more aware of such
652 		 * HW security concerns, and "least privilege".
653 		 */
654 		sub_chip_id = twl_map[TWL_MODULE_RTC].sid;
655 		child = add_child(sub_chip_id, "twl_rtc", NULL, 0,
656 				true, irq_base + RTC_INTR_OFFSET, 0);
657 		if (IS_ERR(child))
658 			return PTR_ERR(child);
659 	}
660 
661 	if (IS_ENABLED(CONFIG_PWM_TWL)) {
662 		child = add_child(SUB_CHIP_ID1, "twl-pwm", NULL, 0,
663 				  false, 0, 0);
664 		if (IS_ERR(child))
665 			return PTR_ERR(child);
666 	}
667 
668 	if (IS_ENABLED(CONFIG_PWM_TWL_LED)) {
669 		child = add_child(SUB_CHIP_ID1, "twl-pwmled", NULL, 0,
670 				  false, 0, 0);
671 		if (IS_ERR(child))
672 			return PTR_ERR(child);
673 	}
674 
675 	if (IS_ENABLED(CONFIG_TWL4030_USB) && pdata->usb &&
676 	    twl_class_is_4030()) {
677 
678 		static struct regulator_consumer_supply usb1v5 = {
679 			.supply =	"usb1v5",
680 		};
681 		static struct regulator_consumer_supply usb1v8 = {
682 			.supply =	"usb1v8",
683 		};
684 		static struct regulator_consumer_supply usb3v1[] = {
685 			{ .supply =	"usb3v1" },
686 			{ .supply =	"bci3v1" },
687 		};
688 
689 	/* First add the regulators so that they can be used by transceiver */
690 		if (IS_ENABLED(CONFIG_REGULATOR_TWL4030)) {
691 			/* this is a template that gets copied */
692 			struct regulator_init_data usb_fixed = {
693 				.constraints.valid_modes_mask =
694 					REGULATOR_MODE_NORMAL
695 					| REGULATOR_MODE_STANDBY,
696 				.constraints.valid_ops_mask =
697 					REGULATOR_CHANGE_MODE
698 					| REGULATOR_CHANGE_STATUS,
699 			};
700 
701 			child = add_regulator_linked(TWL4030_REG_VUSB1V5,
702 						      &usb_fixed, &usb1v5, 1,
703 						      features);
704 			if (IS_ERR(child))
705 				return PTR_ERR(child);
706 
707 			child = add_regulator_linked(TWL4030_REG_VUSB1V8,
708 						      &usb_fixed, &usb1v8, 1,
709 						      features);
710 			if (IS_ERR(child))
711 				return PTR_ERR(child);
712 
713 			child = add_regulator_linked(TWL4030_REG_VUSB3V1,
714 						      &usb_fixed, usb3v1, 2,
715 						      features);
716 			if (IS_ERR(child))
717 				return PTR_ERR(child);
718 
719 		}
720 
721 		child = add_child(SUB_CHIP_ID0, "twl4030_usb",
722 				pdata->usb, sizeof(*pdata->usb), true,
723 				/* irq0 = USB_PRES, irq1 = USB */
724 				irq_base + USB_PRES_INTR_OFFSET,
725 				irq_base + USB_INTR_OFFSET);
726 
727 		if (IS_ERR(child))
728 			return PTR_ERR(child);
729 
730 		/* we need to connect regulators to this transceiver */
731 		if (IS_ENABLED(CONFIG_REGULATOR_TWL4030) && child) {
732 			usb1v5.dev_name = dev_name(child);
733 			usb1v8.dev_name = dev_name(child);
734 			usb3v1[0].dev_name = dev_name(child);
735 		}
736 	}
737 	if (IS_ENABLED(CONFIG_TWL6030_USB) && pdata->usb &&
738 	    twl_class_is_6030()) {
739 
740 		static struct regulator_consumer_supply usb3v3;
741 		int regulator;
742 
743 		if (IS_ENABLED(CONFIG_REGULATOR_TWL4030)) {
744 			/* this is a template that gets copied */
745 			struct regulator_init_data usb_fixed = {
746 				.constraints.valid_modes_mask =
747 					REGULATOR_MODE_NORMAL
748 					| REGULATOR_MODE_STANDBY,
749 				.constraints.valid_ops_mask =
750 					REGULATOR_CHANGE_MODE
751 					| REGULATOR_CHANGE_STATUS,
752 			};
753 
754 			if (features & TWL6025_SUBCLASS) {
755 				usb3v3.supply =	"ldousb";
756 				regulator = TWL6025_REG_LDOUSB;
757 			} else {
758 				usb3v3.supply = "vusb";
759 				regulator = TWL6030_REG_VUSB;
760 			}
761 			child = add_regulator_linked(regulator, &usb_fixed,
762 							&usb3v3, 1,
763 							features);
764 			if (IS_ERR(child))
765 				return PTR_ERR(child);
766 		}
767 
768 		pdata->usb->features = features;
769 
770 		child = add_child(SUB_CHIP_ID0, "twl6030_usb",
771 			pdata->usb, sizeof(*pdata->usb), true,
772 			/* irq1 = VBUS_PRES, irq0 = USB ID */
773 			irq_base + USBOTG_INTR_OFFSET,
774 			irq_base + USB_PRES_INTR_OFFSET);
775 
776 		if (IS_ERR(child))
777 			return PTR_ERR(child);
778 		/* we need to connect regulators to this transceiver */
779 		if (IS_ENABLED(CONFIG_REGULATOR_TWL4030) && child)
780 			usb3v3.dev_name = dev_name(child);
781 	} else if (IS_ENABLED(CONFIG_REGULATOR_TWL4030) &&
782 		   twl_class_is_6030()) {
783 		if (features & TWL6025_SUBCLASS)
784 			child = add_regulator(TWL6025_REG_LDOUSB,
785 						pdata->ldousb, features);
786 		else
787 			child = add_regulator(TWL6030_REG_VUSB,
788 						pdata->vusb, features);
789 
790 			if (IS_ERR(child))
791 					return PTR_ERR(child);
792 	}
793 
794 	if (IS_ENABLED(CONFIG_TWL4030_WATCHDOG) && twl_class_is_4030()) {
795 		child = add_child(SUB_CHIP_ID3, "twl4030_wdt", NULL, 0,
796 				  false, 0, 0);
797 		if (IS_ERR(child))
798 			return PTR_ERR(child);
799 	}
800 
801 	if (IS_ENABLED(CONFIG_INPUT_TWL4030_PWRBUTTON) && twl_class_is_4030()) {
802 		child = add_child(SUB_CHIP_ID3, "twl4030_pwrbutton", NULL, 0,
803 				  true, irq_base + 8 + 0, 0);
804 		if (IS_ERR(child))
805 			return PTR_ERR(child);
806 	}
807 
808 	if (IS_ENABLED(CONFIG_MFD_TWL4030_AUDIO) && pdata->audio &&
809 	    twl_class_is_4030()) {
810 		child = add_child(SUB_CHIP_ID1, "twl4030-audio",
811 				pdata->audio, sizeof(*pdata->audio),
812 				false, 0, 0);
813 		if (IS_ERR(child))
814 			return PTR_ERR(child);
815 	}
816 
817 	/* twl4030 regulators */
818 	if (IS_ENABLED(CONFIG_REGULATOR_TWL4030) && twl_class_is_4030()) {
819 		child = add_regulator(TWL4030_REG_VPLL1, pdata->vpll1,
820 					features);
821 		if (IS_ERR(child))
822 			return PTR_ERR(child);
823 
824 		child = add_regulator(TWL4030_REG_VIO, pdata->vio,
825 					features);
826 		if (IS_ERR(child))
827 			return PTR_ERR(child);
828 
829 		child = add_regulator(TWL4030_REG_VDD1, pdata->vdd1,
830 					features);
831 		if (IS_ERR(child))
832 			return PTR_ERR(child);
833 
834 		child = add_regulator(TWL4030_REG_VDD2, pdata->vdd2,
835 					features);
836 		if (IS_ERR(child))
837 			return PTR_ERR(child);
838 
839 		child = add_regulator(TWL4030_REG_VMMC1, pdata->vmmc1,
840 					features);
841 		if (IS_ERR(child))
842 			return PTR_ERR(child);
843 
844 		child = add_regulator(TWL4030_REG_VDAC, pdata->vdac,
845 					features);
846 		if (IS_ERR(child))
847 			return PTR_ERR(child);
848 
849 		child = add_regulator((features & TWL4030_VAUX2)
850 					? TWL4030_REG_VAUX2_4030
851 					: TWL4030_REG_VAUX2,
852 				pdata->vaux2, features);
853 		if (IS_ERR(child))
854 			return PTR_ERR(child);
855 
856 		child = add_regulator(TWL4030_REG_VINTANA1, pdata->vintana1,
857 					features);
858 		if (IS_ERR(child))
859 			return PTR_ERR(child);
860 
861 		child = add_regulator(TWL4030_REG_VINTANA2, pdata->vintana2,
862 					features);
863 		if (IS_ERR(child))
864 			return PTR_ERR(child);
865 
866 		child = add_regulator(TWL4030_REG_VINTDIG, pdata->vintdig,
867 					features);
868 		if (IS_ERR(child))
869 			return PTR_ERR(child);
870 	}
871 
872 	/* maybe add LDOs that are omitted on cost-reduced parts */
873 	if (IS_ENABLED(CONFIG_REGULATOR_TWL4030) && !(features & TPS_SUBSET)
874 	  && twl_class_is_4030()) {
875 		child = add_regulator(TWL4030_REG_VPLL2, pdata->vpll2,
876 					features);
877 		if (IS_ERR(child))
878 			return PTR_ERR(child);
879 
880 		child = add_regulator(TWL4030_REG_VMMC2, pdata->vmmc2,
881 					features);
882 		if (IS_ERR(child))
883 			return PTR_ERR(child);
884 
885 		child = add_regulator(TWL4030_REG_VSIM, pdata->vsim,
886 					features);
887 		if (IS_ERR(child))
888 			return PTR_ERR(child);
889 
890 		child = add_regulator(TWL4030_REG_VAUX1, pdata->vaux1,
891 					features);
892 		if (IS_ERR(child))
893 			return PTR_ERR(child);
894 
895 		child = add_regulator(TWL4030_REG_VAUX3, pdata->vaux3,
896 					features);
897 		if (IS_ERR(child))
898 			return PTR_ERR(child);
899 
900 		child = add_regulator(TWL4030_REG_VAUX4, pdata->vaux4,
901 					features);
902 		if (IS_ERR(child))
903 			return PTR_ERR(child);
904 	}
905 
906 	/* twl6030 regulators */
907 	if (IS_ENABLED(CONFIG_REGULATOR_TWL4030) && twl_class_is_6030() &&
908 			!(features & TWL6025_SUBCLASS)) {
909 		child = add_regulator(TWL6030_REG_VDD1, pdata->vdd1,
910 					features);
911 		if (IS_ERR(child))
912 			return PTR_ERR(child);
913 
914 		child = add_regulator(TWL6030_REG_VDD2, pdata->vdd2,
915 					features);
916 		if (IS_ERR(child))
917 			return PTR_ERR(child);
918 
919 		child = add_regulator(TWL6030_REG_VDD3, pdata->vdd3,
920 					features);
921 		if (IS_ERR(child))
922 			return PTR_ERR(child);
923 
924 		child = add_regulator(TWL6030_REG_V1V8, pdata->v1v8,
925 					features);
926 		if (IS_ERR(child))
927 			return PTR_ERR(child);
928 
929 		child = add_regulator(TWL6030_REG_V2V1, pdata->v2v1,
930 					features);
931 		if (IS_ERR(child))
932 			return PTR_ERR(child);
933 
934 		child = add_regulator(TWL6030_REG_VMMC, pdata->vmmc,
935 					features);
936 		if (IS_ERR(child))
937 			return PTR_ERR(child);
938 
939 		child = add_regulator(TWL6030_REG_VPP, pdata->vpp,
940 					features);
941 		if (IS_ERR(child))
942 			return PTR_ERR(child);
943 
944 		child = add_regulator(TWL6030_REG_VUSIM, pdata->vusim,
945 					features);
946 		if (IS_ERR(child))
947 			return PTR_ERR(child);
948 
949 		child = add_regulator(TWL6030_REG_VCXIO, pdata->vcxio,
950 					features);
951 		if (IS_ERR(child))
952 			return PTR_ERR(child);
953 
954 		child = add_regulator(TWL6030_REG_VDAC, pdata->vdac,
955 					features);
956 		if (IS_ERR(child))
957 			return PTR_ERR(child);
958 
959 		child = add_regulator(TWL6030_REG_VAUX1_6030, pdata->vaux1,
960 					features);
961 		if (IS_ERR(child))
962 			return PTR_ERR(child);
963 
964 		child = add_regulator(TWL6030_REG_VAUX2_6030, pdata->vaux2,
965 					features);
966 		if (IS_ERR(child))
967 			return PTR_ERR(child);
968 
969 		child = add_regulator(TWL6030_REG_VAUX3_6030, pdata->vaux3,
970 					features);
971 		if (IS_ERR(child))
972 			return PTR_ERR(child);
973 
974 		child = add_regulator(TWL6030_REG_CLK32KG, pdata->clk32kg,
975 					features);
976 		if (IS_ERR(child))
977 			return PTR_ERR(child);
978 	}
979 
980 	/* 6030 and 6025 share this regulator */
981 	if (IS_ENABLED(CONFIG_REGULATOR_TWL4030) && twl_class_is_6030()) {
982 		child = add_regulator(TWL6030_REG_VANA, pdata->vana,
983 					features);
984 		if (IS_ERR(child))
985 			return PTR_ERR(child);
986 	}
987 
988 	/* twl6025 regulators */
989 	if (IS_ENABLED(CONFIG_REGULATOR_TWL4030) && twl_class_is_6030() &&
990 			(features & TWL6025_SUBCLASS)) {
991 		child = add_regulator(TWL6025_REG_LDO5, pdata->ldo5,
992 					features);
993 		if (IS_ERR(child))
994 			return PTR_ERR(child);
995 
996 		child = add_regulator(TWL6025_REG_LDO1, pdata->ldo1,
997 					features);
998 		if (IS_ERR(child))
999 			return PTR_ERR(child);
1000 
1001 		child = add_regulator(TWL6025_REG_LDO7, pdata->ldo7,
1002 					features);
1003 		if (IS_ERR(child))
1004 			return PTR_ERR(child);
1005 
1006 		child = add_regulator(TWL6025_REG_LDO6, pdata->ldo6,
1007 					features);
1008 		if (IS_ERR(child))
1009 			return PTR_ERR(child);
1010 
1011 		child = add_regulator(TWL6025_REG_LDOLN, pdata->ldoln,
1012 					features);
1013 		if (IS_ERR(child))
1014 			return PTR_ERR(child);
1015 
1016 		child = add_regulator(TWL6025_REG_LDO2, pdata->ldo2,
1017 					features);
1018 		if (IS_ERR(child))
1019 			return PTR_ERR(child);
1020 
1021 		child = add_regulator(TWL6025_REG_LDO4, pdata->ldo4,
1022 					features);
1023 		if (IS_ERR(child))
1024 			return PTR_ERR(child);
1025 
1026 		child = add_regulator(TWL6025_REG_LDO3, pdata->ldo3,
1027 					features);
1028 		if (IS_ERR(child))
1029 			return PTR_ERR(child);
1030 
1031 		child = add_regulator(TWL6025_REG_SMPS3, pdata->smps3,
1032 					features);
1033 		if (IS_ERR(child))
1034 			return PTR_ERR(child);
1035 
1036 		child = add_regulator(TWL6025_REG_SMPS4, pdata->smps4,
1037 					features);
1038 		if (IS_ERR(child))
1039 			return PTR_ERR(child);
1040 
1041 		child = add_regulator(TWL6025_REG_VIO, pdata->vio6025,
1042 					features);
1043 		if (IS_ERR(child))
1044 			return PTR_ERR(child);
1045 
1046 	}
1047 
1048 	if (IS_ENABLED(CONFIG_CHARGER_TWL4030) && pdata->bci &&
1049 			!(features & (TPS_SUBSET | TWL5031))) {
1050 		child = add_child(SUB_CHIP_ID3, "twl4030_bci",
1051 				pdata->bci, sizeof(*pdata->bci), false,
1052 				/* irq0 = CHG_PRES, irq1 = BCI */
1053 				irq_base + BCI_PRES_INTR_OFFSET,
1054 				irq_base + BCI_INTR_OFFSET);
1055 		if (IS_ERR(child))
1056 			return PTR_ERR(child);
1057 	}
1058 
1059 	return 0;
1060 }
1061 
1062 /*----------------------------------------------------------------------*/
1063 
1064 /*
1065  * These three functions initialize the on-chip clock framework,
1066  * letting it generate the right frequencies for USB, MADC, and
1067  * other purposes.
1068  */
1069 static inline int __init protect_pm_master(void)
1070 {
1071 	int e = 0;
1072 
1073 	e = twl_i2c_write_u8(TWL_MODULE_PM_MASTER, 0,
1074 			     TWL4030_PM_MASTER_PROTECT_KEY);
1075 	return e;
1076 }
1077 
1078 static inline int __init unprotect_pm_master(void)
1079 {
1080 	int e = 0;
1081 
1082 	e |= twl_i2c_write_u8(TWL_MODULE_PM_MASTER, TWL4030_PM_MASTER_KEY_CFG1,
1083 			      TWL4030_PM_MASTER_PROTECT_KEY);
1084 	e |= twl_i2c_write_u8(TWL_MODULE_PM_MASTER, TWL4030_PM_MASTER_KEY_CFG2,
1085 			      TWL4030_PM_MASTER_PROTECT_KEY);
1086 
1087 	return e;
1088 }
1089 
1090 static void clocks_init(struct device *dev,
1091 			struct twl4030_clock_init_data *clock)
1092 {
1093 	int e = 0;
1094 	struct clk *osc;
1095 	u32 rate;
1096 	u8 ctrl = HFCLK_FREQ_26_MHZ;
1097 
1098 	osc = clk_get(dev, "fck");
1099 	if (IS_ERR(osc)) {
1100 		printk(KERN_WARNING "Skipping twl internal clock init and "
1101 				"using bootloader value (unknown osc rate)\n");
1102 		return;
1103 	}
1104 
1105 	rate = clk_get_rate(osc);
1106 	clk_put(osc);
1107 
1108 	switch (rate) {
1109 	case 19200000:
1110 		ctrl = HFCLK_FREQ_19p2_MHZ;
1111 		break;
1112 	case 26000000:
1113 		ctrl = HFCLK_FREQ_26_MHZ;
1114 		break;
1115 	case 38400000:
1116 		ctrl = HFCLK_FREQ_38p4_MHZ;
1117 		break;
1118 	}
1119 
1120 	ctrl |= HIGH_PERF_SQ;
1121 	if (clock && clock->ck32k_lowpwr_enable)
1122 		ctrl |= CK32K_LOWPWR_EN;
1123 
1124 	e |= unprotect_pm_master();
1125 	/* effect->MADC+USB ck en */
1126 	e |= twl_i2c_write_u8(TWL_MODULE_PM_MASTER, ctrl, R_CFG_BOOT);
1127 	e |= protect_pm_master();
1128 
1129 	if (e < 0)
1130 		pr_err("%s: clock init err [%d]\n", DRIVER_NAME, e);
1131 }
1132 
1133 /*----------------------------------------------------------------------*/
1134 
1135 
1136 static int twl_remove(struct i2c_client *client)
1137 {
1138 	unsigned i, num_slaves;
1139 	int status;
1140 
1141 	if (twl_class_is_4030()) {
1142 		status = twl4030_exit_irq();
1143 		num_slaves = TWL_NUM_SLAVES;
1144 	} else {
1145 		status = twl6030_exit_irq();
1146 		num_slaves = TWL_NUM_SLAVES - 1;
1147 	}
1148 
1149 	if (status < 0)
1150 		return status;
1151 
1152 	for (i = 0; i < num_slaves; i++) {
1153 		struct twl_client	*twl = &twl_modules[i];
1154 
1155 		if (twl->client && twl->client != client)
1156 			i2c_unregister_device(twl->client);
1157 		twl_modules[i].client = NULL;
1158 	}
1159 	inuse = false;
1160 	return 0;
1161 }
1162 
1163 /* NOTE: This driver only handles a single twl4030/tps659x0 chip */
1164 static int
1165 twl_probe(struct i2c_client *client, const struct i2c_device_id *id)
1166 {
1167 	struct twl4030_platform_data	*pdata = client->dev.platform_data;
1168 	struct device_node		*node = client->dev.of_node;
1169 	struct platform_device		*pdev;
1170 	struct regmap_config		*twl_regmap_config;
1171 	int				irq_base = 0;
1172 	int				status;
1173 	unsigned			i, num_slaves;
1174 
1175 	pdev = platform_device_alloc(DRIVER_NAME, -1);
1176 	if (!pdev) {
1177 		dev_err(&client->dev, "can't alloc pdev\n");
1178 		return -ENOMEM;
1179 	}
1180 
1181 	status = platform_device_add(pdev);
1182 	if (status) {
1183 		platform_device_put(pdev);
1184 		return status;
1185 	}
1186 
1187 	if (node && !pdata) {
1188 		/*
1189 		 * XXX: Temporary pdata until the information is correctly
1190 		 * retrieved by every TWL modules from DT.
1191 		 */
1192 		pdata = devm_kzalloc(&client->dev,
1193 				     sizeof(struct twl4030_platform_data),
1194 				     GFP_KERNEL);
1195 		if (!pdata) {
1196 			status = -ENOMEM;
1197 			goto free;
1198 		}
1199 	}
1200 
1201 	if (!pdata) {
1202 		dev_dbg(&client->dev, "no platform data?\n");
1203 		status = -EINVAL;
1204 		goto free;
1205 	}
1206 
1207 	platform_set_drvdata(pdev, pdata);
1208 
1209 	if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C) == 0) {
1210 		dev_dbg(&client->dev, "can't talk I2C?\n");
1211 		status = -EIO;
1212 		goto free;
1213 	}
1214 
1215 	if (inuse) {
1216 		dev_dbg(&client->dev, "driver is already in use\n");
1217 		status = -EBUSY;
1218 		goto free;
1219 	}
1220 
1221 	if ((id->driver_data) & TWL6030_CLASS) {
1222 		twl_id = TWL6030_CLASS_ID;
1223 		twl_map = &twl6030_map[0];
1224 		/* The charger base address is different in twl6025 */
1225 		if ((id->driver_data) & TWL6025_SUBCLASS)
1226 			twl_map[TWL_MODULE_MAIN_CHARGE].base =
1227 							TWL6025_BASEADD_CHARGER;
1228 		twl_regmap_config = twl6030_regmap_config;
1229 		num_slaves = TWL_NUM_SLAVES - 1;
1230 	} else {
1231 		twl_id = TWL4030_CLASS_ID;
1232 		twl_map = &twl4030_map[0];
1233 		twl_regmap_config = twl4030_regmap_config;
1234 		num_slaves = TWL_NUM_SLAVES;
1235 	}
1236 
1237 	for (i = 0; i < num_slaves; i++) {
1238 		struct twl_client *twl = &twl_modules[i];
1239 
1240 		if (i == 0) {
1241 			twl->client = client;
1242 		} else {
1243 			twl->client = i2c_new_dummy(client->adapter,
1244 						    client->addr + i);
1245 			if (!twl->client) {
1246 				dev_err(&client->dev,
1247 					"can't attach client %d\n", i);
1248 				status = -ENOMEM;
1249 				goto fail;
1250 			}
1251 		}
1252 
1253 		twl->regmap = devm_regmap_init_i2c(twl->client,
1254 						   &twl_regmap_config[i]);
1255 		if (IS_ERR(twl->regmap)) {
1256 			status = PTR_ERR(twl->regmap);
1257 			dev_err(&client->dev,
1258 				"Failed to allocate regmap %d, err: %d\n", i,
1259 				status);
1260 			goto fail;
1261 		}
1262 	}
1263 
1264 	inuse = true;
1265 
1266 	/* setup clock framework */
1267 	clocks_init(&pdev->dev, pdata->clock);
1268 
1269 	/* read TWL IDCODE Register */
1270 	if (twl_id == TWL4030_CLASS_ID) {
1271 		status = twl_read_idcode_register();
1272 		WARN(status < 0, "Error: reading twl_idcode register value\n");
1273 	}
1274 
1275 	/* load power event scripts */
1276 	if (IS_ENABLED(CONFIG_TWL4030_POWER) && pdata->power)
1277 		twl4030_power_init(pdata->power);
1278 
1279 	/* Maybe init the T2 Interrupt subsystem */
1280 	if (client->irq) {
1281 		if (twl_class_is_4030()) {
1282 			twl4030_init_chip_irq(id->name);
1283 			irq_base = twl4030_init_irq(&client->dev, client->irq);
1284 		} else {
1285 			irq_base = twl6030_init_irq(&client->dev, client->irq);
1286 		}
1287 
1288 		if (irq_base < 0) {
1289 			status = irq_base;
1290 			goto fail;
1291 		}
1292 	}
1293 
1294 	/*
1295 	 * Disable TWL4030/TWL5030 I2C Pull-up on I2C1 and I2C4(SR) interface.
1296 	 * Program I2C_SCL_CTRL_PU(bit 0)=0, I2C_SDA_CTRL_PU (bit 2)=0,
1297 	 * SR_I2C_SCL_CTRL_PU(bit 4)=0 and SR_I2C_SDA_CTRL_PU(bit 6)=0.
1298 	 */
1299 	if (twl_class_is_4030()) {
1300 		u8 temp;
1301 
1302 		twl_i2c_read_u8(TWL4030_MODULE_INTBR, &temp, REG_GPPUPDCTR1);
1303 		temp &= ~(SR_I2C_SDA_CTRL_PU | SR_I2C_SCL_CTRL_PU | \
1304 			I2C_SDA_CTRL_PU | I2C_SCL_CTRL_PU);
1305 		twl_i2c_write_u8(TWL4030_MODULE_INTBR, temp, REG_GPPUPDCTR1);
1306 	}
1307 
1308 	status = -ENODEV;
1309 	if (node)
1310 		status = of_platform_populate(node, NULL, NULL, &client->dev);
1311 	if (status)
1312 		status = add_children(pdata, irq_base, id->driver_data);
1313 
1314 fail:
1315 	if (status < 0)
1316 		twl_remove(client);
1317 free:
1318 	if (status < 0)
1319 		platform_device_unregister(pdev);
1320 
1321 	return status;
1322 }
1323 
1324 static const struct i2c_device_id twl_ids[] = {
1325 	{ "twl4030", TWL4030_VAUX2 },	/* "Triton 2" */
1326 	{ "twl5030", 0 },		/* T2 updated */
1327 	{ "twl5031", TWL5031 },		/* TWL5030 updated */
1328 	{ "tps65950", 0 },		/* catalog version of twl5030 */
1329 	{ "tps65930", TPS_SUBSET },	/* fewer LDOs and DACs; no charger */
1330 	{ "tps65920", TPS_SUBSET },	/* fewer LDOs; no codec or charger */
1331 	{ "tps65921", TPS_SUBSET },	/* fewer LDOs; no codec, no LED
1332 					   and vibrator. Charger in USB module*/
1333 	{ "twl6030", TWL6030_CLASS },	/* "Phoenix power chip" */
1334 	{ "twl6025", TWL6030_CLASS | TWL6025_SUBCLASS }, /* "Phoenix lite" */
1335 	{ /* end of list */ },
1336 };
1337 MODULE_DEVICE_TABLE(i2c, twl_ids);
1338 
1339 /* One Client Driver , 4 Clients */
1340 static struct i2c_driver twl_driver = {
1341 	.driver.name	= DRIVER_NAME,
1342 	.id_table	= twl_ids,
1343 	.probe		= twl_probe,
1344 	.remove		= twl_remove,
1345 };
1346 
1347 static int __init twl_init(void)
1348 {
1349 	return i2c_add_driver(&twl_driver);
1350 }
1351 subsys_initcall(twl_init);
1352 
1353 static void __exit twl_exit(void)
1354 {
1355 	i2c_del_driver(&twl_driver);
1356 }
1357 module_exit(twl_exit);
1358 
1359 MODULE_AUTHOR("Texas Instruments, Inc.");
1360 MODULE_DESCRIPTION("I2C Core interface for TWL");
1361 MODULE_LICENSE("GPL");
1362